freebsd-dev/contrib/ntp/ntpd/refclock_arbiter.c
Cy Schubert 2b15cb3d09 MFV ntp 4.2.8p1 (r258945, r275970, r276091, r276092, r276093, r278284)
Thanks to roberto for providing pointers to wedge this into HEAD.

Approved by:	roberto
2015-03-30 13:30:15 +00:00

480 lines
12 KiB
C

/*
* refclock_arbiter - clock driver for Arbiter 1088A/B Satellite
* Controlled Clock
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#if defined(REFCLOCK) && defined(CLOCK_ARBITER)
#include "ntpd.h"
#include "ntp_io.h"
#include "ntp_refclock.h"
#include "ntp_stdlib.h"
#include <stdio.h>
#include <ctype.h>
#ifdef SYS_WINNT
extern int async_write(int, const void *, unsigned int);
#undef write
#define write(fd, data, octets) async_write(fd, data, octets)
#endif
/*
* This driver supports the Arbiter 1088A/B Satellite Controlled Clock.
* The claimed accuracy of this clock is 100 ns relative to the PPS
* output when receiving four or more satellites.
*
* The receiver should be configured before starting the NTP daemon, in
* order to establish reliable position and operating conditions. It
* does not initiate surveying or hold mode. For use with NTP, the
* daylight savings time feature should be disables (D0 command) and the
* broadcast mode set to operate in UTC (BU command).
*
* The timecode format supported by this driver is selected by the poll
* sequence "B5", which initiates a line in the following format to be
* repeated once per second until turned off by the "B0" poll sequence.
*
* Format B5 (24 ASCII printing characters):
*
* <cr><lf>i yy ddd hh:mm:ss.000bbb
*
* on-time = <cr>
* i = synchronization flag (' ' = locked, '?' = unlocked)
* yy = year of century
* ddd = day of year
* hh:mm:ss = hours, minutes, seconds
* .000 = fraction of second (not used)
* bbb = tailing spaces for fill
*
* The alarm condition is indicated by a '?' at i, which indicates the
* receiver is not synchronized. In normal operation, a line consisting
* of the timecode followed by the time quality character (TQ) followed
* by the receiver status string (SR) is written to the clockstats file.
* The time quality character is encoded in IEEE P1344 standard:
*
* Format TQ (IEEE P1344 estimated worst-case time quality)
*
* 0 clock locked, maximum accuracy
* F clock failure, time not reliable
* 4 clock unlocked, accuracy < 1 us
* 5 clock unlocked, accuracy < 10 us
* 6 clock unlocked, accuracy < 100 us
* 7 clock unlocked, accuracy < 1 ms
* 8 clock unlocked, accuracy < 10 ms
* 9 clock unlocked, accuracy < 100 ms
* A clock unlocked, accuracy < 1 s
* B clock unlocked, accuracy < 10 s
*
* The status string is encoded as follows:
*
* Format SR (25 ASCII printing characters)
*
* V=vv S=ss T=t P=pdop E=ee
*
* vv = satellites visible
* ss = relative signal strength
* t = satellites tracked
* pdop = position dilution of precision (meters)
* ee = hardware errors
*
* If flag4 is set, an additional line consisting of the receiver
* latitude (LA), longitude (LO), elevation (LH) (meters), and data
* buffer (DB) is written to this file. If channel B is enabled for
* deviation mode and connected to a 1-PPS signal, the last two numbers
* on the line are the deviation and standard deviation averaged over
* the last 15 seconds.
*
* PPS calibration fudge time1 .001240
*/
/*
* Interface definitions
*/
#define DEVICE "/dev/gps%d" /* device name and unit */
#define SPEED232 B9600 /* uart speed (9600 baud) */
#define PRECISION (-20) /* precision assumed (about 1 us) */
#define REFID "GPS " /* reference ID */
#define DESCRIPTION "Arbiter 1088A/B GPS Receiver" /* WRU */
#define LENARB 24 /* format B5 timecode length */
#define MAXSTA 40 /* max length of status string */
#define MAXPOS 80 /* max length of position string */
#ifdef PRE_NTP420
#define MODE ttlmax
#else
#define MODE ttl
#endif
#define COMMAND_HALT_BCAST ( (peer->MODE % 2) ? "O0" : "B0" )
#define COMMAND_START_BCAST ( (peer->MODE % 2) ? "O5" : "B5" )
/*
* ARB unit control structure
*/
struct arbunit {
l_fp laststamp; /* last receive timestamp */
int tcswitch; /* timecode switch/counter */
char qualchar; /* IEEE P1344 quality (TQ command) */
char status[MAXSTA]; /* receiver status (SR command) */
char latlon[MAXPOS]; /* receiver position (lat/lon/alt) */
};
/*
* Function prototypes
*/
static int arb_start (int, struct peer *);
static void arb_shutdown (int, struct peer *);
static void arb_receive (struct recvbuf *);
static void arb_poll (int, struct peer *);
/*
* Transfer vector
*/
struct refclock refclock_arbiter = {
arb_start, /* start up driver */
arb_shutdown, /* shut down driver */
arb_poll, /* transmit poll message */
noentry, /* not used (old arb_control) */
noentry, /* initialize driver (not used) */
noentry, /* not used (old arb_buginfo) */
NOFLAGS /* not used */
};
/*
* arb_start - open the devices and initialize data for processing
*/
static int
arb_start(
int unit,
struct peer *peer
)
{
register struct arbunit *up;
struct refclockproc *pp;
int fd;
char device[20];
/*
* Open serial port. Use CLK line discipline, if available.
*/
snprintf(device, sizeof(device), DEVICE, unit);
fd = refclock_open(device, SPEED232, LDISC_CLK);
if (fd <= 0)
return (0);
/*
* Allocate and initialize unit structure
*/
up = emalloc_zero(sizeof(*up));
pp = peer->procptr;
pp->io.clock_recv = arb_receive;
pp->io.srcclock = peer;
pp->io.datalen = 0;
pp->io.fd = fd;
if (!io_addclock(&pp->io)) {
close(fd);
pp->io.fd = -1;
free(up);
return (0);
}
pp->unitptr = up;
/*
* Initialize miscellaneous variables
*/
peer->precision = PRECISION;
pp->clockdesc = DESCRIPTION;
memcpy((char *)&pp->refid, REFID, 4);
if (peer->MODE > 1) {
msyslog(LOG_NOTICE, "ARBITER: Invalid mode %d", peer->MODE);
close(fd);
pp->io.fd = -1;
free(up);
return (0);
}
#ifdef DEBUG
if(debug) { printf("arbiter: mode = %d.\n", peer->MODE); }
#endif
write(pp->io.fd, COMMAND_HALT_BCAST, 2);
return (1);
}
/*
* arb_shutdown - shut down the clock
*/
static void
arb_shutdown(
int unit,
struct peer *peer
)
{
register struct arbunit *up;
struct refclockproc *pp;
pp = peer->procptr;
up = pp->unitptr;
if (-1 != pp->io.fd)
io_closeclock(&pp->io);
if (NULL != up)
free(up);
}
/*
* arb_receive - receive data from the serial interface
*/
static void
arb_receive(
struct recvbuf *rbufp
)
{
register struct arbunit *up;
struct refclockproc *pp;
struct peer *peer;
l_fp trtmp;
int temp;
u_char syncchar; /* synch indicator */
char tbuf[BMAX]; /* temp buffer */
/*
* Initialize pointers and read the timecode and timestamp
*/
peer = rbufp->recv_peer;
pp = peer->procptr;
up = pp->unitptr;
temp = refclock_gtlin(rbufp, tbuf, sizeof(tbuf), &trtmp);
/*
* Note we get a buffer and timestamp for both a <cr> and <lf>,
* but only the <cr> timestamp is retained. The program first
* sends a TQ and expects the echo followed by the time quality
* character. It then sends a B5 starting the timecode broadcast
* and expects the echo followed some time later by the on-time
* character <cr> and then the <lf> beginning the timecode
* itself. Finally, at the <cr> beginning the next timecode at
* the next second, the program sends a B0 shutting down the
* timecode broadcast.
*
* If flag4 is set, the program snatches the latitude, longitude
* and elevation and writes it to the clockstats file.
*/
if (temp == 0)
return;
pp->lastrec = up->laststamp;
up->laststamp = trtmp;
if (temp < 3)
return;
if (up->tcswitch == 0) {
/*
* Collect statistics. If nothing is recogized, just
* ignore; sometimes the clock doesn't stop spewing
* timecodes for awhile after the B0 command.
*
* If flag4 is not set, send TQ, SR, B5. If flag4 is
* sset, send TQ, SR, LA, LO, LH, DB, B5. When the
* median filter is full, send B0.
*/
if (!strncmp(tbuf, "TQ", 2)) {
up->qualchar = tbuf[2];
write(pp->io.fd, "SR", 2);
return;
} else if (!strncmp(tbuf, "SR", 2)) {
strlcpy(up->status, tbuf + 2,
sizeof(up->status));
if (pp->sloppyclockflag & CLK_FLAG4)
write(pp->io.fd, "LA", 2);
else
write(pp->io.fd, COMMAND_START_BCAST, 2);
return;
} else if (!strncmp(tbuf, "LA", 2)) {
strlcpy(up->latlon, tbuf + 2, sizeof(up->latlon));
write(pp->io.fd, "LO", 2);
return;
} else if (!strncmp(tbuf, "LO", 2)) {
strlcat(up->latlon, " ", sizeof(up->latlon));
strlcat(up->latlon, tbuf + 2, sizeof(up->latlon));
write(pp->io.fd, "LH", 2);
return;
} else if (!strncmp(tbuf, "LH", 2)) {
strlcat(up->latlon, " ", sizeof(up->latlon));
strlcat(up->latlon, tbuf + 2, sizeof(up->latlon));
write(pp->io.fd, "DB", 2);
return;
} else if (!strncmp(tbuf, "DB", 2)) {
strlcat(up->latlon, " ", sizeof(up->latlon));
strlcat(up->latlon, tbuf + 2, sizeof(up->latlon));
record_clock_stats(&peer->srcadr, up->latlon);
#ifdef DEBUG
if (debug)
printf("arbiter: %s\n", up->latlon);
#endif
write(pp->io.fd, COMMAND_START_BCAST, 2);
}
}
/*
* We get down to business, check the timecode format and decode
* its contents. If the timecode has valid length, but not in
* proper format, we declare bad format and exit. If the
* timecode has invalid length, which sometimes occurs when the
* B0 amputates the broadcast, we just quietly steal away. Note
* that the time quality character and receiver status string is
* tacked on the end for clockstats display.
*/
up->tcswitch++;
if (up->tcswitch <= 1 || temp < LENARB)
return;
/*
* Timecode format B5: "i yy ddd hh:mm:ss.000 "
*/
strlcpy(pp->a_lastcode, tbuf, sizeof(pp->a_lastcode));
pp->a_lastcode[LENARB - 2] = up->qualchar;
strlcat(pp->a_lastcode, up->status, sizeof(pp->a_lastcode));
pp->lencode = strlen(pp->a_lastcode);
syncchar = ' ';
if (sscanf(pp->a_lastcode, "%c%2d %3d %2d:%2d:%2d",
&syncchar, &pp->year, &pp->day, &pp->hour,
&pp->minute, &pp->second) != 6) {
refclock_report(peer, CEVNT_BADREPLY);
write(pp->io.fd, COMMAND_HALT_BCAST, 2);
return;
}
/*
* We decode the clock dispersion from the time quality
* character.
*/
switch (up->qualchar) {
case '0': /* locked, max accuracy */
pp->disp = 1e-7;
pp->lastref = pp->lastrec;
break;
case '4': /* unlock accuracy < 1 us */
pp->disp = 1e-6;
break;
case '5': /* unlock accuracy < 10 us */
pp->disp = 1e-5;
break;
case '6': /* unlock accuracy < 100 us */
pp->disp = 1e-4;
break;
case '7': /* unlock accuracy < 1 ms */
pp->disp = .001;
break;
case '8': /* unlock accuracy < 10 ms */
pp->disp = .01;
break;
case '9': /* unlock accuracy < 100 ms */
pp->disp = .1;
break;
case 'A': /* unlock accuracy < 1 s */
pp->disp = 1;
break;
case 'B': /* unlock accuracy < 10 s */
pp->disp = 10;
break;
case 'F': /* clock failure */
pp->disp = MAXDISPERSE;
refclock_report(peer, CEVNT_FAULT);
write(pp->io.fd, COMMAND_HALT_BCAST, 2);
return;
default:
pp->disp = MAXDISPERSE;
refclock_report(peer, CEVNT_BADREPLY);
write(pp->io.fd, COMMAND_HALT_BCAST, 2);
return;
}
if (syncchar != ' ')
pp->leap = LEAP_NOTINSYNC;
else
pp->leap = LEAP_NOWARNING;
/*
* Process the new sample in the median filter and determine the
* timecode timestamp.
*/
if (!refclock_process(pp))
refclock_report(peer, CEVNT_BADTIME);
else if (peer->disp > MAXDISTANCE)
refclock_receive(peer);
/* if (up->tcswitch >= MAXSTAGE) { */
write(pp->io.fd, COMMAND_HALT_BCAST, 2);
/* } */
}
/*
* arb_poll - called by the transmit procedure
*/
static void
arb_poll(
int unit,
struct peer *peer
)
{
register struct arbunit *up;
struct refclockproc *pp;
/*
* Time to poll the clock. The Arbiter clock responds to a "B5"
* by returning a timecode in the format specified above.
* Transmission occurs once per second, unless turned off by a
* "B0". Note there is no checking on state, since this may not
* be the only customer reading the clock. Only one customer
* need poll the clock; all others just listen in.
*/
pp = peer->procptr;
up = pp->unitptr;
pp->polls++;
up->tcswitch = 0;
if (write(pp->io.fd, "TQ", 2) != 2)
refclock_report(peer, CEVNT_FAULT);
/*
* Process median filter samples. If none received, declare a
* timeout and keep going.
*/
if (pp->coderecv == pp->codeproc) {
refclock_report(peer, CEVNT_TIMEOUT);
return;
}
refclock_receive(peer);
record_clock_stats(&peer->srcadr, pp->a_lastcode);
#ifdef DEBUG
if (debug)
printf("arbiter: timecode %d %s\n",
pp->lencode, pp->a_lastcode);
#endif
}
#else
int refclock_arbiter_bs;
#endif /* REFCLOCK */