#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#if defined(REFCLOCK) && defined(CLOCK_GPSVME)
#include <stdio.h>
#include <syslog.h>
#include <ctype.h>
#include <string.h>
#include <strings.h>
#include <sys/time.h>
#include "gps.h"
#include "ntpd.h"
#include "ntp_io.h"
#include "ntp_refclock.h"
#include "ntp_unixtime.h"
#include "ntp_stdlib.h"
#include "/etc/conf/h/io.h"
#include <time.h>
#define PRIO 120
#define NREGS 7
extern int init_vme();
unsigned short *greg[NREGS];
void *gps_base;
extern caddr_t map_vme ();
extern void unmap_vme();
struct vmedate {
unsigned short year;
unsigned short doy;
unsigned short hr;
unsigned short mn;
unsigned short sec;
unsigned long frac;
unsigned short status;
};
struct vmedate *get_gpsvme_time();
#define MAXUNITS 2
#define BMAX 50
#define VMEPRECISION (-21)
#define USNOREFID "USNO\0"
#define VMEREFID "GPS"
#define VMEDESCRIPTION "GPS"
#define VMEHSREFID 0x7f7f1001
#define GMT 0
struct vmeunit {
struct peer *peer;
struct refclockio io;
struct vmedate vmedata;
l_fp lastrec;
l_fp lastref;
char lastcode[BMAX];
u_short lencode;
u_long lasttime;
u_short unit;
u_short status;
u_short lastevent;
u_short year;
u_short day;
u_short hour;
u_short minute;
u_short second;
u_long usec;
u_long yearstart;
u_short leap;
u_long polls;
u_long noreply;
u_long coderecv;
u_long badformat;
u_long baddata;
u_long timestarted;
};
static struct vmeunit *vmeunits[MAXUNITS];
static u_char unitinuse[MAXUNITS];
static l_fp fudgefactor[MAXUNITS];
static u_char stratumtouse[MAXUNITS];
static u_char sloppyclockflag[MAXUNITS];
static void vme_init (void);
static int vme_start (u_int, struct peer *);
static void vme_shutdown (int);
static void vme_report_event (struct vmeunit *, int);
static void vme_receive (struct recvbuf *);
static void vme_poll (int unit, struct peer *);
static void vme_control (u_int, struct refclockstat *, struct refclockstat *);
static void vme_buginfo (int, struct refclockbug *);
struct refclock refclock_gpsvme = {
vme_start, vme_shutdown, vme_poll,
vme_control, vme_init, vme_buginfo, NOFLAGS
};
int fd_vme;
int regvalue;
static void
vme_init(void)
{
register int i;
for (i = 0; i < MAXUNITS; i++) {
fudgefactor[i].l_ui = 0;
fudgefactor[i].l_uf = 0;
stratumtouse[i] = 0;
sloppyclockflag[i] = 0;
}
}
static int
vme_start(
u_int unit,
struct peer *peer
)
{
register struct vmeunit *vme;
register int i;
int dummy;
char vmedev[20];
if (unit >= MAXUNITS) {
msyslog(LOG_ERR, "vme_start: unit %d invalid", unit);
return (0);
}
if (unitinuse[unit]) {
msyslog(LOG_ERR, "vme_start: unit %d in use", unit);
return (0);
}
#ifdef DEBUG
printf("Opening VME DEVICE \n");
#endif
init_vme();
if (vmeunits[unit] != 0) {
vme = vmeunits[unit];
} else {
for (i = 0; i < MAXUNITS; i++) {
if (!unitinuse[i] && vmeunits[i] != 0)
break;
}
if (i < MAXUNITS) {
vme = vmeunits[i];
vmeunits[i] = 0;
} else {
vme = (struct vmeunit *)
emalloc(sizeof(struct vmeunit));
}
}
bzero((char *)vme, sizeof(struct vmeunit));
vmeunits[unit] = vme;
vme->peer = peer;
vme->unit = (u_short)unit;
vme->timestarted = current_time;
vme->io.clock_recv = vme_receive;
vme->io.srcclock = (caddr_t)vme;
vme->io.datalen = 0;
vme->io.fd = fd_vme;
peer->precision = VMEPRECISION;
peer->stratum = stratumtouse[unit];
memcpy( (char *)&peer->refid, USNOREFID,4);
unitinuse[unit] = 1;
return (1);
}
static void
vme_shutdown(
int unit
)
{
register struct vmeunit *vme;
if (unit >= MAXUNITS) {
msyslog(LOG_ERR, "vme_shutdown: unit %d invalid", unit);
return;
}
if (!unitinuse[unit]) {
msyslog(LOG_ERR, "vme_shutdown: unit %d not in use", unit);
return;
}
unmap_vme();
vme = vmeunits[unit];
io_closeclock(&vme->io);
unitinuse[unit] = 0;
}
static void
vme_report_event(
struct vmeunit *vme,
int code
)
{
struct peer *peer;
peer = vme->peer;
if (vme->status != (u_short)code) {
vme->status = (u_short)code;
if (code != CEVNT_NOMINAL)
vme->lastevent = (u_short)code;
msyslog(LOG_INFO,
"clock %s event %x", ntoa(&peer->srcadr), code);
}
}
static void
vme_receive(
struct recvbuf *rbufp
)
{
}
static void
vme_poll(
int unit,
struct peer *peer
)
{
struct vmedate *tptr;
struct vmeunit *vme;
l_fp tstmp;
time_t tloc;
struct tm *tadr;
vme = (struct vmeunit *)emalloc(sizeof(struct vmeunit *));
tptr = (struct vmedate *)emalloc(sizeof(struct vmedate *));
if (unit >= MAXUNITS) {
msyslog(LOG_ERR, "vme_poll: unit %d invalid", unit);
return;
}
if (!unitinuse[unit]) {
msyslog(LOG_ERR, "vme_poll: unit %d not in use", unit);
return;
}
vme = vmeunits[unit];
vme->polls++;
tptr = &vme->vmedata;
if ((tptr = get_gpsvme_time()) == NULL ) {
vme_report_event(vme, CEVNT_BADREPLY);
return;
}
get_systime(&vme->lastrec);
vme->lasttime = current_time;
sprintf(vme->lastcode,
"%3.3d %2.2d:%2.2d:%2.2d.%.6d %1d\0",
tptr->doy, tptr->hr, tptr->mn,
tptr->sec, tptr->frac, tptr->status);
record_clock_stats(&(vme->peer->srcadr), vme->lastcode);
vme->lencode = (u_short) strlen(vme->lastcode);
vme->day = tptr->doy;
vme->hour = tptr->hr;
vme->minute = tptr->mn;
vme->second = tptr->sec;
vme->usec = tptr->frac;
#ifdef DEBUG
if (debug)
printf("vme: %3d %02d:%02d:%02d.%06ld %1x\n",
vme->day, vme->hour, vme->minute, vme->second,
vme->usec, tptr->status);
#endif
if (tptr->status ) {
vme_report_event(vme, CEVNT_BADREPLY);
return;
}
if (!clocktime(vme->day, vme->hour, vme->minute,
vme->second, GMT, vme->lastrec.l_ui,
&vme->yearstart, &vme->lastref.l_ui)) {
vme->baddata++;
vme_report_event(vme, CEVNT_BADTIME);
msyslog(LOG_ERR, "refclock_gpsvme: bad data!!");
return;
}
TVUTOTSF(vme->usec, vme->lastref.l_uf);
tstmp = vme->lastref;
L_SUB(&tstmp, &vme->lastrec);
vme->coderecv++;
L_ADD(&tstmp, &(fudgefactor[vme->unit]));
refclock_receive(vme->peer);
}
static void
vme_control(
u_int unit,
struct refclockstat *in,
struct refclockstat *out
)
{
register struct vmeunit *vme;
if (unit >= MAXUNITS) {
msyslog(LOG_ERR, "vme_control: unit %d invalid)", unit);
return;
}
if (in != 0) {
if (in->haveflags & CLK_HAVETIME1)
fudgefactor[unit] = in->fudgetime1;
if (in->haveflags & CLK_HAVEVAL1) {
stratumtouse[unit] = (u_char)(in->fudgeval1 & 0xf);
if (unitinuse[unit]) {
struct peer *peer;
vme = vmeunits[unit];
peer = vme->peer;
peer->stratum = stratumtouse[unit];
if (stratumtouse[unit] <= 1)
memcpy( (char *)&peer->refid, USNOREFID,4);
else
peer->refid = htonl(VMEHSREFID);
}
}
if (in->haveflags & CLK_HAVEFLAG1) {
sloppyclockflag[unit] = in->flags & CLK_FLAG1;
}
}
if (out != 0) {
out->type = 16;
out->haveflags
= CLK_HAVETIME1|CLK_HAVEVAL1|CLK_HAVEVAL2|CLK_HAVEFLAG1;
out->clockdesc = VMEDESCRIPTION;
out->fudgetime1 = fudgefactor[unit];
out->fudgetime2.l_ui = 0;
out->fudgetime2.l_uf = 0;
out->fudgeval1 = (LONG)stratumtouse[unit];
out->fudgeval2 = 0;
out->flags = sloppyclockflag[unit];
if (unitinuse[unit]) {
vme = vmeunits[unit];
out->lencode = vme->lencode;
out->lastcode = vme->lastcode;
out->timereset = current_time - vme->timestarted;
out->polls = vme->polls;
out->noresponse = vme->noreply;
out->badformat = vme->badformat;
out->baddata = vme->baddata;
out->lastevent = vme->lastevent;
out->currentstatus = vme->status;
} else {
out->lencode = 0;
out->lastcode = "";
out->polls = out->noresponse = 0;
out->badformat = out->baddata = 0;
out->timereset = 0;
out->currentstatus = out->lastevent = CEVNT_NOMINAL;
}
}
}
static void
vme_buginfo(
int unit,
register struct refclockbug *bug
)
{
register struct vmeunit *vme;
if (unit >= MAXUNITS) {
msyslog(LOG_ERR, "vme_buginfo: unit %d invalid)", unit);
return;
}
if (!unitinuse[unit])
return;
vme = vmeunits[unit];
bug->nvalues = 11;
bug->ntimes = 5;
if (vme->lasttime != 0)
bug->values[0] = current_time - vme->lasttime;
else
bug->values[0] = 0;
bug->values[2] = (u_long)vme->year;
bug->values[3] = (u_long)vme->day;
bug->values[4] = (u_long)vme->hour;
bug->values[5] = (u_long)vme->minute;
bug->values[6] = (u_long)vme->second;
bug->values[7] = (u_long)vme->usec;
bug->values[9] = vme->yearstart;
bug->stimes = 0x1c;
bug->times[0] = vme->lastref;
bug->times[1] = vme->lastrec;
}
#include "gps.h"
#define PBIAS 193
struct vmedate *
get_gpsvme_time(void)
{
struct vmedate *time_vme;
unsigned short set, hr, min, sec, ums, hms, status;
int ret;
char ti[3];
long tloc ;
time_t mktime(),time();
struct tm *gmtime(), *gmt;
char *gpsmicro;
gpsmicro = (char *) malloc(7);
time_vme = (struct vmedate *)malloc(sizeof(struct vmedate ));
*greg = (unsigned short *)malloc(sizeof(short) * NREGS);
set = *greg[0];
time_vme->year = (unsigned short) *greg[6];
time_vme->doy = (unsigned short) (*greg[5] & MASKDAY);
time_vme->hr = (unsigned short) ((*greg[4] & MASKHI) >>8);
time_vme->mn = (unsigned short) (*greg[4] & MASKLO);
time_vme->sec = (unsigned short) (*greg[3] & MASKHI) >>8;
ums = *greg[2];
hms = *greg[3] & MASKLO;
time_vme->status = (unsigned short) *greg[5] >>13;
set = *greg[1];
sprintf(gpsmicro,"%2.2x%4.4x\0", hms, ums);
time_vme->frac = (u_long) gpsmicro;
if (!status) {
return ((void *)NULL);
}
else
return (time_vme);
}
#else
int refclock_gpsvme_bs;
#endif