Annotation of embedaddon/ntp/ntpd/refclock_gpsvme.c, revision 1.1.1.1
1.1 misho 1: /* refclock_psc.c: clock driver for Brandywine PCI-SyncClock32/HP-UX 11.X */
2:
3: #ifdef HAVE_CONFIG_H
4: #include <config.h>
5: #endif /* HAVE_CONFIG_H */
6:
7: #if defined(REFCLOCK) && defined(CLOCK_GPSVME)
8:
9: #include "ntpd.h"
10: #include "ntp_io.h"
11: #include "ntp_refclock.h"
12: #include "ntp_unixtime.h"
13: #include "ntp_stdlib.h"
14:
15: #ifdef __hpux
16: #include <sys/rtprio.h> /* may already be included above */
17: #include <sys/lock.h> /* NEEDED for PROCLOCK */
18: #endif /* __hpux */
19:
20: #ifdef __linux__
21: #include <sys/ioctl.h> /* for _IOR, ioctl */
22: #endif /* __linux__ */
23:
24: enum { /* constants */
25: BUFSIZE = 32,
26: PSC_SYNC_OK = 0x40, /* Sync status bit */
27: DP_LEAPSEC_DAY10DAY1 = 0x82, /* DP RAM address */
28: DP_LEAPSEC_DAY1000DAY100 = 0x83,
29: DELAY = 1,
30: NUNIT = 2 /* max UNITS */
31: };
32:
33: /* clock card registers */
34: struct psc_regs {
35: uint32_t low_time; /* card base + 0x00 */
36: uint32_t high_time; /* card base + 0x04 */
37: uint32_t ext_low_time; /* card base + 0x08 */
38: uint32_t ext_high_time; /* card base + 0x0C */
39: uint8_t device_status; /* card base + 0x10 */
40: uint8_t device_control; /* card base + 0x11 */
41: uint8_t reserved0; /* card base + 0x12 */
42: uint8_t ext_100ns; /* card base + 0x13 */
43: uint8_t match_usec; /* card base + 0x14 */
44: uint8_t match_msec; /* card base + 0x15 */
45: uint8_t reserved1; /* card base + 0x16 */
46: uint8_t reserved2; /* card base + 0x17 */
47: uint8_t reserved3; /* card base + 0x18 */
48: uint8_t reserved4; /* card base + 0x19 */
49: uint8_t dp_ram_addr; /* card base + 0x1A */
50: uint8_t reserved5; /* card base + 0x1B */
51: uint8_t reserved6; /* card base + 0x1C */
52: uint8_t reserved7; /* card base + 0x1D */
53: uint8_t dp_ram_data; /* card base + 0x1E */
54: uint8_t reserved8; /* card base + 0x1F */
55: } *volatile regp[NUNIT];
56:
57: #define PSC_REGS _IOR('K', 0, long) /* ioctl argument */
58:
59: /* Macros to swap byte order and convert BCD to binary */
60: #define SWAP(val) ( ((val) >> 24) | (((val) & 0x00ff0000) >> 8) | \
61: (((val) & 0x0000ff00) << 8) | (((val) & 0x000000ff) << 24) )
62: #define BCD2INT2(val) ( ((val) >> 4 & 0x0f)*10 + ((val) & 0x0f) )
63: #define BCD2INT3(val) ( ((val) >> 8 & 0x0f)*100 + ((val) >> 4 & 0x0f)*10 + \
64: ((val) & 0x0f) )
65:
66: /* PSC interface definitions */
67: #define PRECISION (-20) /* precision assumed (1 us) */
68: #define REFID "USNO" /* reference ID */
69: #define DESCRIPTION "Brandywine PCI-SyncClock32"
70: #define DEVICE "/dev/refclock%1d" /* device file */
71:
72: /* clock unit control structure */
73: struct psc_unit {
74: short unit; /* NTP refclock unit number */
75: short last_hour; /* last hour (monitor leap sec) */
76: int msg_flag[2]; /* count error messages */
77: };
78: int fd[NUNIT]; /* file descriptor */
79:
80: /* Local function prototypes */
81: static int psc_start(int, struct peer *);
82: static void psc_shutdown(int, struct peer *);
83: static void psc_poll(int, struct peer *);
84: static void check_leap_sec(struct refclockproc *, int);
85:
86: /* Transfer vector */
87: struct refclock refclock_gpsvme = {
88: psc_start, psc_shutdown, psc_poll, noentry, noentry, noentry, NOFLAGS
89: };
90:
91: /* psc_start: open device and initialize data for processing */
92: static int
93: psc_start(
94: int unit,
95: struct peer *peer
96: )
97: {
98: char buf[BUFSIZE];
99: struct refclockproc *pp;
100: struct psc_unit *up = emalloc(sizeof *up);
101:
102: if (unit < 0 || unit > 1) { /* support units 0 and 1 */
103: msyslog(LOG_ERR, "psc_start: bad unit: %d", unit);
104: return 0;
105: }
106:
107: memset(up, '\0', sizeof *up);
108:
109: snprintf(buf, sizeof(buf), DEVICE, unit); /* dev file name */
110: fd[unit] = open(buf, O_RDONLY); /* open device file */
111: if (fd[unit] < 0) {
112: msyslog(LOG_ERR, "psc_start: unit: %d, open failed. %m", unit);
113: return 0;
114: }
115:
116: /* get the address of the mapped regs */
117: if (ioctl(fd[unit], PSC_REGS, ®p[unit]) < 0) {
118: msyslog(LOG_ERR, "psc_start: unit: %d, ioctl failed. %m", unit);
119: return 0;
120: }
121:
122: /* initialize peer variables */
123: pp = peer->procptr;
124: pp->io.clock_recv = noentry;
125: pp->io.srcclock = (caddr_t) peer;
126: pp->io.datalen = 0;
127: pp->io.fd = -1;
128: pp->unitptr = (caddr_t) up;
129: get_systime(&pp->lastrec);
130: memcpy(&pp->refid, REFID, 4);
131: peer->precision = PRECISION;
132: pp->clockdesc = DESCRIPTION;
133: up->unit = unit;
134: #ifdef __hpux
135: rtprio(0,120); /* set real time priority */
136: plock(PROCLOCK); /* lock process in memory */
137: #endif /* __hpux */
138: return 1;
139: }
140:
141: /* psc_shutdown: shut down the clock */
142: static void
143: psc_shutdown(
144: int unit,
145: struct peer *peer
146: )
147: {
148: if (NULL != peer->procptr->unitptr)
149: free(peer->procptr->unitptr);
150: if (fd[unit] > 0)
151: close(fd[unit]);
152: }
153:
154: /* psc_poll: read, decode, and record device time */
155: static void
156: psc_poll(
157: int unit,
158: struct peer *peer
159: )
160: {
161: struct refclockproc *pp = peer->procptr;
162: struct psc_unit *up;
163: unsigned tlo, thi;
164: unsigned char status;
165:
166: up = (struct psc_unit *) pp->unitptr;
167: tlo = regp[unit]->low_time; /* latch and read first 4 bytes */
168: thi = regp[unit]->high_time; /* read 4 higher order bytes */
169: status = regp[unit]->device_status; /* read device status byte */
170:
171: if (!(status & PSC_SYNC_OK)) {
172: refclock_report(peer, CEVNT_BADTIME);
173: if (!up->msg_flag[unit]) { /* write once to system log */
174: msyslog(LOG_WARNING,
175: "SYNCHRONIZATION LOST on unit %1d, status %02x\n",
176: status, unit);
177: up->msg_flag[unit] = 1;
178: }
179: return;
180: }
181:
182: get_systime(&pp->lastrec);
183: pp->polls++;
184:
185: tlo = SWAP(tlo); /* little to big endian swap on */
186: thi = SWAP(thi); /* copy of data */
187: /* convert the BCD time to broken down time used by refclockproc */
188: pp->day = BCD2INT3((thi & 0x0FFF0000) >> 16);
189: pp->hour = BCD2INT2((thi & 0x0000FF00) >> 8);
190: pp->minute = BCD2INT2(thi & 0x000000FF);
191: pp->second = BCD2INT2(tlo >> 24);
192: /* ntp_process() in ntp_refclock.c appears to use usec as fraction of
193: second in microseconds if usec is nonzero. */
194: pp->nsec = 1000000*BCD2INT3((tlo & 0x00FFF000) >> 12) +
195: BCD2INT3(tlo & 0x00000FFF);
196:
197: snprintf(pp->a_lastcode, sizeof(pp->a_lastcode),
198: "%3.3d %2.2d:%2.2d:%2.2d.%09ld %02x %08x %08x", pp->day,
199: pp->hour, pp->minute, pp->second, pp->nsec, status, thi,
200: tlo);
201: pp->lencode = strlen(pp->a_lastcode);
202:
203: /* compute the timecode timestamp */
204: if (!refclock_process(pp)) {
205: refclock_report(peer, CEVNT_BADTIME);
206: return;
207: }
208: /* simulate the NTP receive and packet procedures */
209: refclock_receive(peer);
210: /* write clock statistics to file */
211: record_clock_stats(&peer->srcadr, pp->a_lastcode);
212:
213: /* With the first timecode beginning the day, check for a GPS
214: leap second notification. */
215: if (pp->hour < up->last_hour) {
216: check_leap_sec(pp, unit);
217: up->msg_flag[0] = up->msg_flag[1] = 0; /* reset flags */
218: }
219: up->last_hour = pp->hour;
220: }
221:
222: /* check_leap_sec: read the Dual Port RAM leap second day registers. The
223: onboard GPS receiver should write the hundreds digit of day of year in
224: DP_LeapSec_Day1000Day100 and the tens and ones digits in
225: DP_LeapSec_Day10Day1. If these values are nonzero and today, we have
226: a leap second pending, so we set the pp->leap flag to LEAP_ADDSECOND.
227: If the BCD data are zero or a date other than today, set pp->leap to
228: LEAP_NOWARNING. */
229: static void
230: check_leap_sec(struct refclockproc *pp, int unit)
231: {
232: unsigned char dhi, dlo;
233: int leap_day;
234:
235: regp[unit]->dp_ram_addr = DP_LEAPSEC_DAY10DAY1;
236: usleep(DELAY);
237: dlo = regp[unit]->dp_ram_data;
238: regp[unit]->dp_ram_addr = DP_LEAPSEC_DAY1000DAY100;
239: usleep(DELAY);
240: dhi = regp[unit]->dp_ram_data;
241: leap_day = BCD2INT2(dlo) + 100*(dhi & 0x0F);
242:
243: pp->leap = LEAP_NOWARNING; /* default */
244: if (leap_day && leap_day == pp->day) {
245: pp->leap = LEAP_ADDSECOND; /* leap second today */
246: msyslog(LOG_ERR, "LEAP_ADDSECOND flag set, day %d (%x %x).",
247: leap_day, dhi, dlo);
248: }
249: }
250:
251: #else
252: int refclock_gpsvme_bs;
253: #endif /* REFCLOCK */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to refclock_gpsvme.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