/* $NetBSD: clk_trimtaip.c,v 1.1.1.1 2000/03/29 12:38:51 simonb Exp $ */ /* * /src/NTP/ntp-4/libparse/clk_trimtaip.c,v 4.7 1999/11/28 09:13:51 kardel RELEASE_19991128_A * * clk_trimtaip.c,v 4.7 1999/11/28 09:13:51 kardel RELEASE_19991128_A * * Trimble SV6 clock support - several collected codepieces */ #ifdef HAVE_CONFIG_H # include #endif #if defined(REFCLOCK) && defined(CLOCK_PARSE) && defined(CLOCK_TRIMTAIP) #include #include #include "ntp_fp.h" #include "ntp_unixtime.h" #include "ntp_calendar.h" #include "parse.h" #ifndef PARSESTREAM #include "ntp_stdlib.h" #include #else #include "sys/parsestreams.h" extern void printf P((const char *, ...)); #endif /* 0000000000111111111122222222223333333 / char * 0123456789012345678901234567890123456 \ posn * >RTMhhmmssdddDDMMYYYYoodnnvrrrrr;*xx< Actual * ----33445566600112222BB7__-_____--99- Parse * >RTM 1 ;* <", Check */ #define hexval(x) (('0' <= (x) && (x) <= '9') ? (x) - '0' : \ ('a' <= (x) && (x) <= 'f') ? (x) - 'a' + 10 : \ ('A' <= (x) && (x) <= 'F') ? (x) - 'A' + 10 : \ -1) #define O_USEC O_WDAY #define O_GPSFIX O_FLAGS #define O_CHKSUM O_UTCHOFFSET static struct format trimsv6_fmt = { { { 13, 2 }, {15, 2}, { 17, 4}, /* Day, Month, Year */ { 4, 2 }, { 6, 2}, { 8, 2}, /* Hour, Minute, Second */ { 10, 3 }, {23, 1}, { 0, 0}, /* uSec, FIXes (WeekDAY, FLAGS, ZONE) */ { 34, 2 }, { 0, 0}, { 21, 2}, /* cksum, -, utcS (UTC[HMS]OFFSET) */ }, (const unsigned char *)">RTM 1 ;* <", 0 }; static unsigned long cvt_trimtaip P((unsigned char *, int, struct format *, clocktime_t *, void *)); static unsigned long inp_trimtaip P((parse_t *, unsigned int, timestamp_t *)); clockformat_t clock_trimtaip = { inp_trimtaip, /* no input handling */ cvt_trimtaip, /* Trimble conversion */ pps_one, /* easy PPS monitoring */ (void *)&trimsv6_fmt, /* conversion configuration */ "Trimble TAIP", 37, /* string buffer */ 0 /* no private data */ }; static unsigned long cvt_trimtaip( unsigned char *buffer, int size, struct format *format, clocktime_t *clock_time, void *local ) { long gpsfix; u_char calc_csum = 0; long recv_csum; int i; if (!Strok(buffer, format->fixed_string)) return CVT_NONE; #define OFFS(x) format->field_offsets[(x)].offset #define STOI(x, y) \ Stoi(&buffer[OFFS(x)], y, \ format->field_offsets[(x)].length) if ( STOI(O_DAY, &clock_time->day) || STOI(O_MONTH, &clock_time->month) || STOI(O_YEAR, &clock_time->year) || STOI(O_HOUR, &clock_time->hour) || STOI(O_MIN, &clock_time->minute) || STOI(O_SEC, &clock_time->second) || STOI(O_USEC, &clock_time->usecond)|| STOI(O_GPSFIX, &gpsfix) ) return CVT_FAIL|CVT_BADFMT; clock_time->usecond *= 1000; /* Check that the checksum is right */ for (i=OFFS(O_CHKSUM)-1; i >= 0; i--) calc_csum ^= buffer[i]; recv_csum = (hexval(buffer[OFFS(O_CHKSUM)]) << 4) | hexval(buffer[OFFS(O_CHKSUM)+1]); if (recv_csum < 0) return CVT_FAIL|CVT_BADTIME; if (((u_char) recv_csum) != calc_csum) return CVT_FAIL|CVT_BADTIME; clock_time->utcoffset = 0; /* What should flags be set to ? */ clock_time->flags = PARSEB_UTC; /* if the current GPS fix is 9 (unknown), reject */ if (0 > gpsfix || gpsfix > 9) clock_time->flags |= PARSEB_POWERUP; return CVT_OK; } /* * inp_trimtaip * * grep data from input stream */ static u_long inp_trimtaip( parse_t *parseio, unsigned int ch, timestamp_t *tstamp ) { unsigned int rtc; parseprintf(DD_PARSE, ("inp_trimtaip(0x%x, 0x%x, ...)\n", (int)parseio, (int)ch)); switch (ch) { case '>': parseprintf(DD_PARSE, ("inp_trimptaip: START seen\n")); parseio->parse_index = 1; parseio->parse_data[0] = ch; parseio->parse_dtime.parse_stime = *tstamp; /* collect timestamp */ return PARSE_INP_SKIP; case '<': parseprintf(DD_PARSE, ("inp_trimtaip: END seen\n")); if ((rtc = parse_addchar(parseio, ch)) == PARSE_INP_SKIP) return parse_end(parseio); else return rtc; default: return parse_addchar(parseio, ch); } } #else /* not (REFCLOCK && CLOCK_PARSE && CLOCK_TRIMTAIP) */ int clk_trimtaip_bs; #endif /* not (REFCLOCK && CLOCK_PARSE && CLOCK_TRIMTAIP) */ /* * History: * * clk_trimtaip.c,v * Revision 4.7 1999/11/28 09:13:51 kardel * RECON_4_0_98F * * Revision 4.6 1998/08/16 18:46:27 kardel * (clock_trimtaip =): changed format name * * Revision 4.5 1998/06/14 21:09:38 kardel * Sun acc cleanup * * Revision 4.4 1998/06/13 12:06:57 kardel * fix SYSV clock name clash * * Revision 4.3 1998/06/12 15:22:29 kardel * fix prototypes * * Revision 4.2 1998/06/12 09:13:26 kardel * conditional compile macros fixed * printf prototype * * Revision 4.1 1998/05/24 09:39:54 kardel * implementation of the new IO handling model * * Revision 4.0 1998/04/10 19:45:31 kardel * Start 4.0 release version numbering * * from V3 1.4 log info deleted 1998/04/11 kardel */