Aren/NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
64657f857f
NetBSD/dist/ntp/ntpd/refclock_jupiter.c
drochner d5e6f1b80b resolve conflicts 
(in this case, throw away all local modifications; I'll start patching
from scratch)
2003-12-04 16:23:34 +00:00

1143 lines
30 KiB
C
Raw Blame History

/* $NetBSD: refclock_jupiter.c,v 1.2 2003/12/04 16:23:37 drochner Exp $ */
/*
* Copyright (c) 1997, 1998, 2003
* The Regents of the University of California. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the University of
* California, Lawrence Berkeley Laboratory.
* 4. The name of the University may not be used to endorse or promote
* products derived from this software without specific prior
* written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
#ifdef HAVE_CONFIG_H
# include <config.h>
#endif
#if defined(REFCLOCK) && defined(CLOCK_JUPITER) && defined(HAVE_PPSAPI)
#include "ntpd.h"
#include "ntp_io.h"
#include "ntp_refclock.h"
#include "ntp_unixtime.h"
#include "ntp_stdlib.h"
#include <stdio.h>
#include <ctype.h>
#include "jupiter.h"
#ifdef HAVE_PPSAPI
# ifdef HAVE_TIMEPPS_H
# include <timepps.h>
# else
# ifdef HAVE_SYS_TIMEPPS_H
# include <sys/timepps.h>
# endif
# endif
#endif
#ifdef XNTP_BIG_ENDIAN
#define getshort(s) ((((s) & 0xff) << 8) | (((s) >> 8) & 0xff))
#define putshort(s) ((((s) & 0xff) << 8) | (((s) >> 8) & 0xff))
#else
#define getshort(s) (s)
#define putshort(s) (s)
#endif
/* XXX */
#ifdef sun
char *strerror(int);
#endif
/*
* This driver supports the Rockwell Jupiter GPS Receiver board
* adapted to precision timing applications. It requires the
* ppsclock line discipline or streams module described in the
* Line Disciplines and Streams Drivers page. It also requires a
* gadget box and 1-PPS level converter, such as described in the
* Pulse-per-second (PPS) Signal Interfacing page.
*
* It may work (with minor modifications) with other Rockwell GPS
* receivers such as the CityTracker.
*/
/*
* GPS Definitions
*/
#define DEVICE "/dev/gps%d" /* device name and unit */
#define SPEED232 B9600 /* baud */
/*
* Radio interface parameters
*/
#define PRECISION (-18) /* precision assumed (about 4 us) */
#define REFID "GPS\0" /* reference id */
#define DESCRIPTION "Rockwell Jupiter GPS Receiver" /* who we are */
#define DEFFUDGETIME 0 /* default fudge time (ms) */
/* Unix timestamp for the GPS epoch: January 6, 1980 */
#define GPS_EPOCH 315964800
/* Double short to unsigned int */
#define DS2UI(p) ((getshort((p)[1]) << 16) | getshort((p)[0]))
/* Double short to signed int */
#define DS2I(p) ((getshort((p)[1]) << 16) | getshort((p)[0]))
/* One week's worth of seconds */
#define WEEKSECS (7 * 24 * 60 * 60)
/*
* Jupiter unit control structure.
*/
struct instance {
struct peer *peer; /* peer */
u_int pollcnt; /* poll message counter */
u_int polled; /* Hand in a time sample? */
#ifdef HAVE_PPSAPI
pps_params_t pps_params; /* pps parameters */
pps_info_t pps_info; /* last pps data */
pps_handle_t pps_handle; /* pps handle */
u_int assert; /* pps edge to use */
struct timespec ts; /* last timestamp */
#endif
l_fp limit;
u_int gpos_gweek; /* Current GPOS GPS week number */
u_int gpos_sweek; /* Current GPOS GPS seconds into week */
u_int gweek; /* current GPS week number */
u_int32 lastsweek; /* last seconds into GPS week */
time_t timecode; /* current ntp timecode */
u_int32 stime; /* used to detect firmware bug */
int wantid; /* don't reconfig on channel id msg */
u_int moving; /* mobile platform? */
u_char sloppyclockflag; /* fudge flags */
u_short sbuf[512]; /* local input buffer */
int ssize; /* space used in sbuf */
};
/*
* Function prototypes
*/
static void jupiter_canmsg P((struct instance *, u_int));
static u_short jupiter_cksum P((u_short *, u_int));
static int jupiter_config P((struct instance *));
static void jupiter_debug P((struct peer *, char *, char *, ...))
__attribute__ ((format (printf, 3, 4)));
static char * jupiter_parse_t P((struct instance *, u_short *));
static char * jupiter_parse_gpos P((struct instance *, u_short *));
static void jupiter_platform P((struct instance *, u_int));
static void jupiter_poll P((int, struct peer *));
static void jupiter_control P((int, struct refclockstat *, struct
refclockstat *, struct peer *));
#ifdef HAVE_PPSAPI
static int jupiter_ppsapi P((struct instance *, int, int));
static int jupiter_pps P((struct instance *));
#endif /* HAVE_PPSAPI */
static int jupiter_recv P((struct instance *));
static void jupiter_receive P((struct recvbuf *rbufp));
static void jupiter_reqmsg P((struct instance *, u_int, u_int));
static void jupiter_reqonemsg P((struct instance *, u_int));
static char * jupiter_send P((struct instance *, struct jheader *));
static void jupiter_shutdown P((int, struct peer *));
static int jupiter_start P((int, struct peer *));
/*
* Transfer vector
*/
struct refclock refclock_jupiter = {
jupiter_start, /* start up driver */
jupiter_shutdown, /* shut down driver */
jupiter_poll, /* transmit poll message */
jupiter_control, /* (clock control) */
noentry, /* (clock init) */
noentry, /* (clock buginfo) */
NOFLAGS /* not used */
};
/*
* jupiter_start - open the devices and initialize data for processing
*/
static int
jupiter_start(
int unit,
struct peer *peer
)
{
struct refclockproc *pp;
struct instance *instance;
int fd = -1;
char gpsdev[20];
/*
* Open serial port
*/
(void)sprintf(gpsdev, DEVICE, unit);
fd = refclock_open(gpsdev, SPEED232, LDISC_RAW);
if (fd == 0) {
jupiter_debug(peer, "jupiter_start", "open %s: %s",
gpsdev, strerror(errno));
return (0);
}
/* Allocate unit structure */
if ((instance = (struct instance *)
emalloc(sizeof(struct instance))) == NULL) {
(void) close(fd);
return (0);
}
memset((char *)instance, 0, sizeof(struct instance));
instance->peer = peer;
pp = peer->procptr;
pp->io.clock_recv = jupiter_receive;
pp->io.srcclock = (caddr_t)peer;
pp->io.datalen = 0;
pp->io.fd = fd;
if (!io_addclock(&pp->io)) {
(void) close(fd);
free(instance);
return (0);
}
pp->unitptr = (caddr_t)instance;
/*
* Initialize miscellaneous variables
*/
peer->precision = PRECISION;
pp->clockdesc = DESCRIPTION;
memcpy((char *)&pp->refid, REFID, 4);
#ifdef HAVE_PPSAPI
/*
* Start the PPSAPI interface if it is there. Default to use
* the assert edge and do not enable the kernel hardpps.
*/
if (time_pps_create(fd, &instance->pps_handle) < 0) {
instance->pps_handle = 0;
msyslog(LOG_ERR,
"refclock_jupiter: time_pps_create failed: %m");
}
else if (!jupiter_ppsapi(instance, 0, 0))
goto clean_up;
#endif /* HAVE_PPSAPI */
/* Ensure the receiver is properly configured */
if (!jupiter_config(instance))
goto clean_up;
return (1);
clean_up:
jupiter_shutdown(unit, peer);
pp->unitptr = 0;
return (0);
}
/*
* jupiter_shutdown - shut down the clock
*/
static void
jupiter_shutdown(int unit, struct peer *peer)
{
struct instance *instance;
struct refclockproc *pp;
pp = peer->procptr;
instance = (struct instance *)pp->unitptr;
if(!instance)
return;
#ifdef HAVE_PPSAPI
if (instance->pps_handle) {
time_pps_destroy(instance->pps_handle);
instance->pps_handle = 0;
}
#endif /* HAVE_PPSAPI */
io_closeclock(&pp->io);
free(instance);
}
/*
* jupiter_config - Configure the receiver
*/
static int
jupiter_config(struct instance *instance)
{
jupiter_debug(instance->peer, "jupiter_config", "init receiver");
/*
* Initialize the unit variables
*/
instance->sloppyclockflag = instance->peer->procptr->sloppyclockflag;
instance->moving = !!(instance->sloppyclockflag & CLK_FLAG2);
if (instance->moving)
jupiter_debug(instance->peer, "jupiter_config",
"mobile platform");
instance->pollcnt = 2;
instance->polled = 0;
instance->gpos_gweek = 0;
instance->gpos_sweek = 0;
instance->gweek = 0;
instance->lastsweek = 2 * WEEKSECS;
instance->timecode = 0;
instance->stime = 0;
instance->ssize = 0;
/* Stop outputting all messages */
jupiter_canmsg(instance, JUPITER_ALL);
/* Request the receiver id so we can syslog the firmware version */
jupiter_reqonemsg(instance, JUPITER_O_ID);
/* Flag that this the id was requested (so we don't get called again) */
instance->wantid = 1;
/* Request perodic time mark pulse messages */
jupiter_reqmsg(instance, JUPITER_O_PULSE, 1);
/* Request perodic geodetic position status */
jupiter_reqmsg(instance, JUPITER_O_GPOS, 1);
/* Set application platform type */
if (instance->moving)
jupiter_platform(instance, JUPITER_I_PLAT_MED);
else
jupiter_platform(instance, JUPITER_I_PLAT_LOW);
return (1);
}
#ifdef HAVE_PPSAPI
/*
* Initialize PPSAPI
*/
int
jupiter_ppsapi(
struct instance *instance, /* unit structure pointer */
int enb_clear, /* clear enable */
int enb_hardpps /* hardpps enable */
)
{
int capability;
if (time_pps_getcap(instance->pps_handle, &capability) < 0) {
msyslog(LOG_ERR,
"refclock_jupiter: time_pps_getcap failed: %m");
return (0);
}
memset(&instance->pps_params, 0, sizeof(pps_params_t));
if (enb_clear)
instance->pps_params.mode = capability & PPS_CAPTURECLEAR;
else
instance->pps_params.mode = capability & PPS_CAPTUREASSERT;
if (!(instance->pps_params.mode & (PPS_CAPTUREASSERT | PPS_CAPTURECLEAR))) {
msyslog(LOG_ERR,
"refclock_jupiter: invalid capture edge %d",
!enb_clear);
return (0);
}
instance->pps_params.mode |= PPS_TSFMT_TSPEC;
if (time_pps_setparams(instance->pps_handle, &instance->pps_params) < 0) {
msyslog(LOG_ERR,
"refclock_jupiter: time_pps_setparams failed: %m");
return (0);
}
if (enb_hardpps) {
if (time_pps_kcbind(instance->pps_handle, PPS_KC_HARDPPS,
instance->pps_params.mode & (PPS_CAPTUREASSERT | PPS_CAPTURECLEAR),
PPS_TSFMT_TSPEC) < 0) {
msyslog(LOG_ERR,
"refclock_jupiter: time_pps_kcbind failed: %m");
return (0);
}
pps_enable = 1;
}
/* instance->peer->precision = PPS_PRECISION; */
#if DEBUG
if (debug) {
time_pps_getparams(instance->pps_handle, &instance->pps_params);
jupiter_debug(instance->peer, "refclock_jupiter",
"pps capability 0x%x version %d mode 0x%x kern %d",
capability, instance->pps_params.api_version,
instance->pps_params.mode, enb_hardpps);
}
#endif
return (1);
}
/*
* Get PPSAPI timestamps.
*
* Return 0 on failure and 1 on success.
*/
static int
jupiter_pps(struct instance *instance)
{
pps_info_t pps_info;
struct timespec timeout, ts;
double dtemp;
l_fp tstmp;
/*
* Convert the timespec nanoseconds field to ntp l_fp units.
*/
if (instance->pps_handle == 0)
return 1;
timeout.tv_sec = 0;
timeout.tv_nsec = 0;
memcpy(&pps_info, &instance->pps_info, sizeof(pps_info_t));
if (time_pps_fetch(instance->pps_handle, PPS_TSFMT_TSPEC, &instance->pps_info,
&timeout) < 0)
return 1;
if (instance->pps_params.mode & PPS_CAPTUREASSERT) {
if (pps_info.assert_sequence ==
instance->pps_info.assert_sequence)
return 1;
ts = instance->pps_info.assert_timestamp;
} else if (instance->pps_params.mode & PPS_CAPTURECLEAR) {
if (pps_info.clear_sequence ==
instance->pps_info.clear_sequence)
return 1;
ts = instance->pps_info.clear_timestamp;
} else {
return 1;
}
if ((instance->ts.tv_sec == ts.tv_sec) && (instance->ts.tv_nsec == ts.tv_nsec))
return 1;
instance->ts = ts;
tstmp.l_ui = ts.tv_sec + JAN_1970;
dtemp = ts.tv_nsec * FRAC / 1e9;
tstmp.l_uf = (u_int32)dtemp;
instance->peer->procptr->lastrec = tstmp;
return 0;
}
#endif /* HAVE_PPSAPI */
/*
* jupiter_poll - jupiter watchdog routine
*/
static void
jupiter_poll(int unit, struct peer *peer)
{
struct instance *instance;
struct refclockproc *pp;
pp = peer->procptr;
instance = (struct instance *)pp->unitptr;
/*
* You don't need to poll this clock. It puts out timecodes
* once per second. If asked for a timestamp, take note.
* The next time a timecode comes in, it will be fed back.
*/
/*
* If we haven't had a response in a while, reset the receiver.
*/
if (instance->pollcnt > 0) {
instance->pollcnt--;
} else {
refclock_report(peer, CEVNT_TIMEOUT);
/* Request the receiver id to trigger a reconfig */
jupiter_reqonemsg(instance, JUPITER_O_ID);
instance->wantid = 0;
}
/*
* polled every 64 seconds. Ask jupiter_receive to hand in
* a timestamp.
*/
instance->polled = 1;
pp->polls++;
}
/*
* jupiter_control - fudge control
*/
static void
jupiter_control(
int unit, /* unit (not used) */
struct refclockstat *in, /* input parameters (not used) */
struct refclockstat *out, /* output parameters (not used) */
struct peer *peer /* peer structure pointer */
)
{
struct refclockproc *pp;
struct instance *instance;
u_char sloppyclockflag;
pp = peer->procptr;
instance = (struct instance *)pp->unitptr;
DTOLFP(pp->fudgetime2, &instance->limit);
/* Force positive value. */
if (L_ISNEG(&instance->limit))
L_NEG(&instance->limit);
#ifdef HAVE_PPSAPI
instance->assert = !(pp->sloppyclockflag & CLK_FLAG3);
jupiter_ppsapi(instance, !instance->assert, 0);
#endif /* HAVE_PPSAPI */
sloppyclockflag = instance->sloppyclockflag;
instance->sloppyclockflag = pp->sloppyclockflag;
if ((instance->sloppyclockflag & CLK_FLAG2) !=
(sloppyclockflag & CLK_FLAG2)) {
jupiter_debug(peer,
"jupiter_control",
"mode switch: reset receiver");
jupiter_config(instance);
return;
}
}
/*
* jupiter_receive - receive gps data
* Gag me!
*/
static void
jupiter_receive(struct recvbuf *rbufp)
{
int bpcnt, cc, size, ppsret;
time_t last_timecode;
u_int32 laststime;
char *cp;
u_char *bp;
u_short *sp;
struct jid *ip;
struct jheader *hp;
struct peer *peer;
struct refclockproc *pp;
struct instance *instance;
l_fp tstamp;
/* Initialize pointers and read the timecode and timestamp */
peer = (struct peer *)rbufp->recv_srcclock;
pp = peer->procptr;
instance = (struct instance *)pp->unitptr;
bp = (u_char *)rbufp->recv_buffer;
bpcnt = rbufp->recv_length;
/* This shouldn't happen */
if (bpcnt > sizeof(instance->sbuf) - instance->ssize)
bpcnt = sizeof(instance->sbuf) - instance->ssize;
/* Append to input buffer */
memcpy((u_char *)instance->sbuf + instance->ssize, bp, bpcnt);
instance->ssize += bpcnt;
/* While there's at least a header and we parse an intact message */
while (instance->ssize > sizeof(*hp) && (cc = jupiter_recv(instance)) > 0) {
instance->pollcnt = 2;
tstamp = rbufp->recv_time;
hp = (struct jheader *)instance->sbuf;
sp = (u_short *)(hp + 1);
size = cc - sizeof(*hp);
switch (getshort(hp->id)) {
case JUPITER_O_PULSE:
if (size != sizeof(struct jpulse)) {
jupiter_debug(peer,
"jupiter_receive", "pulse: len %d != %u",
size, (int)sizeof(struct jpulse));
refclock_report(peer, CEVNT_BADREPLY);
break;
}
/*
* There appears to be a firmware bug related
* to the pulse message; in addition to the one
* per second messages, we get an extra pulse
* message once an hour (on the anniversary of
* the cold start). It seems to come 200 ms
* after the one requested. So if we've seen a
* pulse message in the last 210 ms, we skip
* this one.
*/
laststime = instance->stime;
instance->stime = DS2UI(((struct jpulse *)sp)->stime);
if (laststime != 0 && instance->stime - laststime <= 21) {
jupiter_debug(peer, "jupiter_receive",
"avoided firmware bug (stime %.2f, laststime %.2f)",
(double)instance->stime * 0.01, (double)laststime * 0.01);
break;
}
/* Retrieve pps timestamp */
ppsret = jupiter_pps(instance);
/*
* Add one second if msg received early
* (i.e. before limit, a.k.a. fudgetime2) in
* the second.
*/
L_SUB(&tstamp, &pp->lastrec);
if (!L_ISGEQ(&tstamp, &instance->limit))
++pp->lastrec.l_ui;
/* Parse timecode (even when there's no pps) */
last_timecode = instance->timecode;
if ((cp = jupiter_parse_t(instance, sp)) != NULL) {
jupiter_debug(peer,
"jupiter_receive", "pulse: %s", cp);
break;
}
/* Bail if we didn't get a pps timestamp */
if (ppsret)
break;
/* Bail if we don't have the last timecode yet */
if (last_timecode == 0)
break;
/* Add the new sample to a median filter */
tstamp.l_ui = JAN_1970 + last_timecode;
tstamp.l_uf = 0;
refclock_process_offset(pp, tstamp, pp->lastrec, pp->fudgetime1);
/*
* The clock will blurt a timecode every second
* but we only want one when polled. If we
* havn't been polled, bail out.
*/
if (!instance->polled)
break;
instance->polled = 0;
/*
* It's a live one! Remember this time.
*/
pp->lastref = pp->lastrec;
refclock_receive(peer);
/*
* If we get here - what we got from the clock is
* OK, so say so
*/
refclock_report(peer, CEVNT_NOMINAL);
/*
* We have succeeded in answering the poll.
* Turn off the flag and return
*/
instance->polled = 0;
break;
case JUPITER_O_GPOS:
if (size != sizeof(struct jgpos)) {
jupiter_debug(peer,
"jupiter_receive", "gpos: len %d != %u",
size, (int)sizeof(struct jgpos));
refclock_report(peer, CEVNT_BADREPLY);
break;
}
if ((cp = jupiter_parse_gpos(instance, sp)) != NULL) {
jupiter_debug(peer,
"jupiter_receive", "gpos: %s", cp);
break;
}
break;
case JUPITER_O_ID:
if (size != sizeof(struct jid)) {
jupiter_debug(peer,
"jupiter_receive", "id: len %d != %u",
size, (int)sizeof(struct jid));
refclock_report(peer, CEVNT_BADREPLY);
break;
}
/*
* If we got this message because the Jupiter
* just powered instance, it needs to be reconfigured.
*/
ip = (struct jid *)sp;
jupiter_debug(peer,
"jupiter_receive", "%s chan ver %s, %s (%s)",
ip->chans, ip->vers, ip->date, ip->opts);
msyslog(LOG_DEBUG,
"jupiter_receive: %s chan ver %s, %s (%s)\n",
ip->chans, ip->vers, ip->date, ip->opts);
if (instance->wantid)
instance->wantid = 0;
else {
jupiter_debug(peer,
"jupiter_receive", "reset receiver");
jupiter_config(instance);
/*
* Restore since jupiter_config() just
* zeroed it
*/
instance->ssize = cc;
}
break;
default:
jupiter_debug(peer,
"jupiter_receive", "unknown message id %d",
getshort(hp->id));
break;
}
instance->ssize -= cc;
if (instance->ssize < 0) {
fprintf(stderr, "jupiter_recv: negative ssize!\n");
abort();
} else if (instance->ssize > 0)
memcpy(instance->sbuf, (u_char *)instance->sbuf + cc, instance->ssize);
}
}
static char *
jupiter_parse_t(struct instance *instance, u_short *sp)
{
struct tm *tm;
char *cp;
struct jpulse *jp;
u_int32 sweek;
time_t last_timecode;
u_short flags;
jp = (struct jpulse *)sp;
/* The timecode is presented as seconds into the current GPS week */
sweek = DS2UI(jp->sweek) % WEEKSECS;
/*
* If we don't know the current GPS week, calculate it from the
* current time. (It's too bad they didn't include this
* important value in the pulse message). We'd like to pick it
* up from one of the other messages like gpos or chan but they
* don't appear to be synchronous with time keeping and changes
* too soon (something like 10 seconds before the new GPS
* week).
*
* If we already know the current GPS week, increment it when
* we wrap into a new week.
*/
if (instance->gweek == 0) {
if (!instance->gpos_gweek) {
return ("jupiter_parse_t: Unknown gweek");
}
instance->gweek = instance->gpos_gweek;
/*
* Fix warps. GPOS has GPS time and PULSE has UTC.
* Plus, GPOS need not be completely in synch with
* the PPS signal.
*/
if (instance->gpos_sweek >= sweek) {
if ((instance->gpos_sweek - sweek) > WEEKSECS / 2)
++instance->gweek;
}
else {
if ((sweek - instance->gpos_sweek) > WEEKSECS / 2)
--instance->gweek;
}
}
else if (sweek == 0 && instance->lastsweek == WEEKSECS - 1) {
++instance->gweek;
jupiter_debug(instance->peer,
"jupiter_parse_t", "NEW gps week %u", instance->gweek);
}
/*
* See if the sweek stayed the same (this happens when there is
* no pps pulse).
*
* Otherwise, look for time warps:
*
* - we have stored at least one lastsweek and
* - the sweek didn't increase by one and
* - we didn't wrap to a new GPS week
*
* Then we warped.
*/
if (instance->lastsweek == sweek)
jupiter_debug(instance->peer,
"jupiter_parse_t", "gps sweek not incrementing (%d)",
sweek);
else if (instance->lastsweek != 2 * WEEKSECS &&
instance->lastsweek + 1 != sweek &&
!(sweek == 0 && instance->lastsweek == WEEKSECS - 1))
jupiter_debug(instance->peer,
"jupiter_parse_t", "gps sweek jumped (was %d, now %d)",
instance->lastsweek, sweek);
instance->lastsweek = sweek;
/* This timecode describes next pulse */
last_timecode = instance->timecode;
instance->timecode =
GPS_EPOCH + (instance->gweek * WEEKSECS) + sweek;
if (last_timecode == 0)
/* XXX debugging */
jupiter_debug(instance->peer,
"jupiter_parse_t", "UTC <none> (gweek/sweek %u/%u)",
instance->gweek, sweek);
else {
/* XXX debugging */
tm = gmtime(&last_timecode);
cp = asctime(tm);
jupiter_debug(instance->peer,
"jupiter_parse_t", "UTC %.24s (gweek/sweek %u/%u)",
cp, instance->gweek, sweek);
/* Billboard last_timecode (which is now the current time) */
instance->peer->procptr->year = tm->tm_year + 1900;
instance->peer->procptr->day = tm->tm_yday + 1;
instance->peer->procptr->hour = tm->tm_hour;
instance->peer->procptr->minute = tm->tm_min;
instance->peer->procptr->second = tm->tm_sec;
}
flags = getshort(jp->flags);
/* Toss if not designated "valid" by the gps */
if ((flags & JUPITER_O_PULSE_VALID) == 0) {
refclock_report(instance->peer, CEVNT_BADTIME);
return ("time mark not valid");
}
/* We better be sync'ed to UTC... */
if ((flags & JUPITER_O_PULSE_UTC) == 0) {
refclock_report(instance->peer, CEVNT_BADTIME);
return ("time mark not sync'ed to UTC");
}
return (NULL);
}
static char *
jupiter_parse_gpos(struct instance *instance, u_short *sp)
{
struct jgpos *jg;
time_t t;
struct tm *tm;
char *cp;
jg = (struct jgpos *)sp;
if (jg->navval != 0) {
/*
* Solution not valid. Use caution and refuse
* to determine GPS week from this message.
*/
instance->gpos_gweek = 0;
instance->gpos_sweek = 0;
return ("Navigation solution not valid");
}
instance->gpos_gweek = jg->gweek;
instance->gpos_sweek = DS2UI(jg->sweek);
while(instance->gpos_sweek >= WEEKSECS) {
instance->gpos_sweek -= WEEKSECS;
++instance->gpos_gweek;
}
instance->gweek = 0;
t = GPS_EPOCH + (instance->gpos_gweek * WEEKSECS) + instance->gpos_sweek;
tm = gmtime(&t);
cp = asctime(tm);
jupiter_debug(instance->peer,
"jupiter_parse_g", "GPS %.24s (gweek/sweek %u/%u)",
cp, instance->gpos_gweek, instance->gpos_sweek);
return (NULL);
}
/*
* jupiter_debug - print debug messages
*/
#if defined(__STDC__) || defined(SYS_WINNT)
static void
jupiter_debug(struct peer *peer, char *function, char *fmt, ...)
#else
static void
jupiter_debug(peer, function, fmt, va_alist)
struct peer *peer;
char *function;
char *fmt;
#endif /* __STDC__ */
{
char buffer[200];
va_list ap;
#if defined(__STDC__) || defined(SYS_WINNT)
va_start(ap, fmt);
#else
va_start(ap);
#endif /* __STDC__ */
/*
* Print debug message to stdout
* In the future, we may want to get get more creative...
*/
vsnprintf(buffer, sizeof(buffer), fmt, ap);
record_clock_stats(&(peer->srcadr), buffer);
if (debug) {
fprintf(stdout, "%s: ", function);
fprintf(stdout, buffer);
fprintf(stdout, "\n");
fflush(stdout);
}
va_end(ap);
}
/* Checksum and transmit a message to the Jupiter */
static char *
jupiter_send(struct instance *instance, struct jheader *hp)
{
u_int len, size;
int cc;
u_short *sp;
static char errstr[132];
size = sizeof(*hp);
hp->hsum = putshort(jupiter_cksum((u_short *)hp,
(size / sizeof(u_short)) - 1));
len = getshort(hp->len);
if (len > 0) {
sp = (u_short *)(hp + 1);
sp[len] = putshort(jupiter_cksum(sp, len));
size += (len + 1) * sizeof(u_short);
}
if ((cc = write(instance->peer->procptr->io.fd, (char *)hp, size)) < 0) {
(void)sprintf(errstr, "write: %s", strerror(errno));
return (errstr);
} else if (cc != size) {
(void)sprintf(errstr, "short write (%d != %d)", cc, size);
return (errstr);
}
return (NULL);
}
/* Request periodic message output */
static struct {
struct jheader jheader;
struct jrequest jrequest;
} reqmsg = {
{ putshort(JUPITER_SYNC), 0,
putshort((sizeof(struct jrequest) / sizeof(u_short)) - 1),
0, (u_char)putshort(JUPITER_FLAG_REQUEST | JUPITER_FLAG_NAK |
JUPITER_FLAG_CONN | JUPITER_FLAG_LOG), 0 },
{ 0, 0, 0, 0 }
};
/* An interval of zero means to output on trigger */
static void
jupiter_reqmsg(struct instance *instance, u_int id,
u_int interval)
{
struct jheader *hp;
struct jrequest *rp;
char *cp;
hp = &reqmsg.jheader;
hp->id = putshort(id);
rp = &reqmsg.jrequest;
rp->trigger = putshort(interval == 0);
rp->interval = putshort(interval);
if ((cp = jupiter_send(instance, hp)) != NULL)
jupiter_debug(instance->peer, "jupiter_reqmsg", "%u: %s", id, cp);
}
/* Cancel periodic message output */
static struct jheader canmsg = {
putshort(JUPITER_SYNC), 0, 0, 0,
(u_char)putshort(JUPITER_FLAG_REQUEST | JUPITER_FLAG_NAK | JUPITER_FLAG_DISC),
0
};
static void
jupiter_canmsg(struct instance *instance, u_int id)
{
struct jheader *hp;
char *cp;
hp = &canmsg;
hp->id = putshort(id);
if ((cp = jupiter_send(instance, hp)) != NULL)
jupiter_debug(instance->peer, "jupiter_canmsg", "%u: %s", id, cp);
}
/* Request a single message output */
static struct jheader reqonemsg = {
putshort(JUPITER_SYNC), 0, 0, 0,
(u_char)putshort(JUPITER_FLAG_REQUEST | JUPITER_FLAG_NAK | JUPITER_FLAG_QUERY),
0
};
static void
jupiter_reqonemsg(struct instance *instance, u_int id)
{
struct jheader *hp;
char *cp;
hp = &reqonemsg;
hp->id = putshort(id);
if ((cp = jupiter_send(instance, hp)) != NULL)
jupiter_debug(instance->peer, "jupiter_reqonemsg", "%u: %s", id, cp);
}
/* Set the platform dynamics */
static struct {
struct jheader jheader;
struct jplat jplat;
} platmsg = {
{ putshort(JUPITER_SYNC), putshort(JUPITER_I_PLAT),
putshort((sizeof(struct jplat) / sizeof(u_short)) - 1), 0,
(u_char)putshort(JUPITER_FLAG_REQUEST | JUPITER_FLAG_NAK), 0 },
{ 0, 0, 0 }
};
static void
jupiter_platform(struct instance *instance, u_int platform)
{
struct jheader *hp;
struct jplat *pp;
char *cp;
hp = &platmsg.jheader;
pp = &platmsg.jplat;
pp->platform = putshort(platform);
if ((cp = jupiter_send(instance, hp)) != NULL)
jupiter_debug(instance->peer, "jupiter_platform", "%u: %s", platform, cp);
}
/* Checksum "len" shorts */
static u_short
jupiter_cksum(u_short *sp, u_int len)
{
u_short sum, x;
sum = 0;
while (len-- > 0) {
x = *sp++;
sum += getshort(x);
}
return (~sum + 1);
}
/* Return the size of the next message (or zero if we don't have it all yet) */
static int
jupiter_recv(struct instance *instance)
{
int n, len, size, cc;
struct jheader *hp;
u_char *bp;
u_short *sp;
/* Must have at least a header's worth */
cc = sizeof(*hp);
size = instance->ssize;
if (size < cc)
return (0);
/* Search for the sync short if missing */
sp = instance->sbuf;
hp = (struct jheader *)sp;
if (getshort(hp->sync) != JUPITER_SYNC) {
/* Wasn't at the front, sync up */
jupiter_debug(instance->peer, "jupiter_recv", "syncing");
bp = (u_char *)sp;
n = size;
while (n >= 2) {
if (bp[0] != (JUPITER_SYNC & 0xff)) {
/*
jupiter_debug(instance->peer, "{0x%x}", bp[0]);
*/
++bp;
--n;
continue;
}
if (bp[1] == ((JUPITER_SYNC >> 8) & 0xff))
break;
/*
jupiter_debug(instance->peer, "{0x%x 0x%x}", bp[0], bp[1]);
*/
bp += 2;
n -= 2;
}
/*
jupiter_debug(instance->peer, "\n");
*/
/* Shuffle data to front of input buffer */
if (n > 0)
memcpy(sp, bp, n);
size = n;
instance->ssize = size;
if (size < cc || hp->sync != JUPITER_SYNC)
return (0);
}
if (jupiter_cksum(sp, (cc / sizeof(u_short) - 1)) !=
getshort(hp->hsum)) {
jupiter_debug(instance->peer, "jupiter_recv", "bad header checksum!");
/* This is drastic but checksum errors should be rare */
instance->ssize = 0;
return (0);
}
/* Check for a payload */
len = getshort(hp->len);
if (len > 0) {
n = (len + 1) * sizeof(u_short);
/* Not enough data yet */
if (size < cc + n)
return (0);
/* Check payload checksum */
sp = (u_short *)(hp + 1);
if (jupiter_cksum(sp, len) != getshort(sp[len])) {
jupiter_debug(instance->peer,
"jupiter_recv", "bad payload checksum!");
/* This is drastic but checksum errors should be rare */
instance->ssize = 0;
return (0);
}
cc += n;
}
return (cc);
}
#else /* not (REFCLOCK && CLOCK_JUPITER && HAVE_PPSAPI) */
int refclock_jupiter_bs;
#endif /* not (REFCLOCK && CLOCK_JUPITER && HAVE_PPSAPI) */
Reference in New Issue View Git Blame Copy Permalink