Annotation of embedaddon/ntp/ntpd/refclock_tpro.c, revision 1.1
1.1 ! misho 1: /*
! 2: * refclock_tpro - clock driver for the KSI/Odetics TPRO-S IRIG-B reader
! 3: */
! 4:
! 5: #ifdef HAVE_CONFIG_H
! 6: #include <config.h>
! 7: #endif
! 8:
! 9: #if defined(REFCLOCK) && defined(CLOCK_TPRO)
! 10:
! 11: #include "ntpd.h"
! 12: #include "ntp_io.h"
! 13: #include "ntp_refclock.h"
! 14: #include "ntp_unixtime.h"
! 15: #include "sys/tpro.h"
! 16: #include "ntp_stdlib.h"
! 17:
! 18: #include <stdio.h>
! 19: #include <ctype.h>
! 20:
! 21: /*
! 22: * This driver supports the KSI/Odetecs TPRO-S IRIG-B reader and TPRO-
! 23: * SAT GPS receiver for the Sun Microsystems SBus. It requires that the
! 24: * tpro.o device driver be installed and loaded.
! 25: */
! 26:
! 27: /*
! 28: * TPRO interface definitions
! 29: */
! 30: #define DEVICE "/dev/tpro%d" /* device name and unit */
! 31: #define PRECISION (-20) /* precision assumed (1 us) */
! 32: #define REFID "IRIG" /* reference ID */
! 33: #define DESCRIPTION "KSI/Odetics TPRO/S IRIG Interface" /* WRU */
! 34:
! 35: /*
! 36: * Unit control structure
! 37: */
! 38: struct tprounit {
! 39: struct tproval tprodata; /* data returned from tpro read */
! 40: };
! 41:
! 42: /*
! 43: * Function prototypes
! 44: */
! 45: static int tpro_start (int, struct peer *);
! 46: static void tpro_shutdown (int, struct peer *);
! 47: static void tpro_poll (int unit, struct peer *);
! 48:
! 49: /*
! 50: * Transfer vector
! 51: */
! 52: struct refclock refclock_tpro = {
! 53: tpro_start, /* start up driver */
! 54: tpro_shutdown, /* shut down driver */
! 55: tpro_poll, /* transmit poll message */
! 56: noentry, /* not used (old tpro_control) */
! 57: noentry, /* initialize driver (not used) */
! 58: noentry, /* not used (old tpro_buginfo) */
! 59: NOFLAGS /* not used */
! 60: };
! 61:
! 62:
! 63: /*
! 64: * tpro_start - open the TPRO device and initialize data for processing
! 65: */
! 66: static int
! 67: tpro_start(
! 68: int unit,
! 69: struct peer *peer
! 70: )
! 71: {
! 72: register struct tprounit *up;
! 73: struct refclockproc *pp;
! 74: char device[20];
! 75: int fd;
! 76:
! 77: /*
! 78: * Open TPRO device
! 79: */
! 80: snprintf(device, sizeof(device), DEVICE, unit);
! 81: fd = open(device, O_RDONLY | O_NDELAY, 0777);
! 82: if (fd == -1) {
! 83: msyslog(LOG_ERR, "tpro_start: open of %s: %m", device);
! 84: return (0);
! 85: }
! 86:
! 87: /*
! 88: * Allocate and initialize unit structure
! 89: */
! 90: up = emalloc(sizeof(*up));
! 91: memset(up, 0, sizeof(*up));
! 92: pp = peer->procptr;
! 93: pp->io.clock_recv = noentry;
! 94: pp->io.srcclock = (caddr_t)peer;
! 95: pp->io.datalen = 0;
! 96: pp->io.fd = fd;
! 97: pp->unitptr = (caddr_t)up;
! 98:
! 99: /*
! 100: * Initialize miscellaneous peer variables
! 101: */
! 102: peer->precision = PRECISION;
! 103: peer->burst = NSTAGE;
! 104: pp->clockdesc = DESCRIPTION;
! 105: memcpy((char *)&pp->refid, REFID, 4);
! 106: return (1);
! 107: }
! 108:
! 109:
! 110: /*
! 111: * tpro_shutdown - shut down the clock
! 112: */
! 113: static void
! 114: tpro_shutdown(
! 115: int unit,
! 116: struct peer *peer
! 117: )
! 118: {
! 119: register struct tprounit *up;
! 120: struct refclockproc *pp;
! 121:
! 122: pp = peer->procptr;
! 123: up = (struct tprounit *)pp->unitptr;
! 124: io_closeclock(&pp->io);
! 125: if (NULL != up)
! 126: free(up);
! 127: }
! 128:
! 129:
! 130: /*
! 131: * tpro_poll - called by the transmit procedure
! 132: */
! 133: static void
! 134: tpro_poll(
! 135: int unit,
! 136: struct peer *peer
! 137: )
! 138: {
! 139: register struct tprounit *up;
! 140: struct refclockproc *pp;
! 141: struct tproval *tp;
! 142:
! 143: /*
! 144: * This is the main routine. It snatches the time from the TPRO
! 145: * board and tacks on a local timestamp.
! 146: */
! 147: pp = peer->procptr;
! 148: up = (struct tprounit *)pp->unitptr;
! 149:
! 150: tp = &up->tprodata;
! 151: if (read(pp->io.fd, (char *)tp, sizeof(struct tproval)) < 0) {
! 152: refclock_report(peer, CEVNT_FAULT);
! 153: return;
! 154: }
! 155: get_systime(&pp->lastrec);
! 156: pp->polls++;
! 157:
! 158: /*
! 159: * We get down to business, check the timecode format and decode
! 160: * its contents. If the timecode has invalid length or is not in
! 161: * proper format, we declare bad format and exit. Note: we
! 162: * can't use the sec/usec conversion produced by the driver,
! 163: * since the year may be suspect. All format error checking is
! 164: * done by the sprintf() and sscanf() routines.
! 165: *
! 166: * Note that the refclockproc usec member has now become nsec.
! 167: * We could either multiply the read-in usec value by 1000 or
! 168: * we could pad the written string appropriately and read the
! 169: * resulting value in already scaled.
! 170: */
! 171: snprintf(pp->a_lastcode, sizeof(pp->a_lastcode),
! 172: "%1x%1x%1x %1x%1x:%1x%1x:%1x%1x.%1x%1x%1x%1x%1x%1x %1x",
! 173: tp->day100, tp->day10, tp->day1, tp->hour10, tp->hour1,
! 174: tp->min10, tp->min1, tp->sec10, tp->sec1, tp->ms100,
! 175: tp->ms10, tp->ms1, tp->usec100, tp->usec10, tp->usec1,
! 176: tp->status);
! 177: pp->lencode = strlen(pp->a_lastcode);
! 178: #ifdef DEBUG
! 179: if (debug)
! 180: printf("tpro: time %s timecode %d %s\n",
! 181: ulfptoa(&pp->lastrec, 6), pp->lencode,
! 182: pp->a_lastcode);
! 183: #endif
! 184: if (sscanf(pp->a_lastcode, "%3d %2d:%2d:%2d.%6ld", &pp->day,
! 185: &pp->hour, &pp->minute, &pp->second, &pp->nsec)
! 186: != 5) {
! 187: refclock_report(peer, CEVNT_BADTIME);
! 188: return;
! 189: }
! 190: pp->nsec *= 1000; /* Convert usec to nsec */
! 191: if (!tp->status & 0x3)
! 192: pp->leap = LEAP_NOTINSYNC;
! 193: else
! 194: pp->leap = LEAP_NOWARNING;
! 195: if (!refclock_process(pp)) {
! 196: refclock_report(peer, CEVNT_BADTIME);
! 197: return;
! 198: }
! 199: if (peer->burst > 0)
! 200: return;
! 201: if (pp->coderecv == pp->codeproc) {
! 202: refclock_report(peer, CEVNT_TIMEOUT);
! 203: return;
! 204: }
! 205: pp->lastref = pp->lastrec;
! 206: record_clock_stats(&peer->srcadr, pp->a_lastcode);
! 207: refclock_receive(peer);
! 208: peer->burst = NSTAGE;
! 209: }
! 210:
! 211: #else
! 212: int refclock_tpro_bs;
! 213: #endif /* REFCLOCK */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to refclock_tpro.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / ntp / ntpd