1/* $NetBSD: clk_trimtaip.c,v 1.1.1.1 2009/12/13 16:55:22 kardel Exp $ */ 2 3/* 4 * /src/NTP/ntp4-dev/libparse/clk_trimtaip.c,v 4.11 2005/04/16 17:32:10 kardel RELEASE_20050508_A 5 * 6 * clk_trimtaip.c,v 4.11 2005/04/16 17:32:10 kardel RELEASE_20050508_A 7 * 8 * Trimble SV6 clock support - several collected codepieces 9 * 10 * Copyright (c) 1995-2005 by Frank Kardel <kardel <AT> ntp.org> 11 * Copyright (c) 1989-1994 by Frank Kardel, Friedrich-Alexander Universit�t Erlangen-N�rnberg, Germany 12 * 13 * Redistribution and use in source and binary forms, with or without 14 * modification, are permitted provided that the following conditions 15 * are met: 16 * 1. Redistributions of source code must retain the above copyright 17 * notice, this list of conditions and the following disclaimer. 18 * 2. Redistributions in binary form must reproduce the above copyright 19 * notice, this list of conditions and the following disclaimer in the 20 * documentation and/or other materials provided with the distribution. 21 * 3. Neither the name of the author nor the names of its contributors 22 * may be used to endorse or promote products derived from this software 23 * without specific prior written permission. 24 * 25 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 26 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 27 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 28 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 29 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 30 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 31 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 32 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 33 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 34 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 35 * SUCH DAMAGE. 36 * 37 */ 38 39#ifdef HAVE_CONFIG_H 40# include <config.h> 41#endif 42 43#if defined(REFCLOCK) && defined(CLOCK_PARSE) && defined(CLOCK_TRIMTAIP) 44 45#include "ntp_fp.h" 46#include "ntp_unixtime.h" 47#include "ntp_calendar.h" 48 49#include "parse.h" 50 51#ifndef PARSESTREAM 52#include "ntp_stdlib.h" 53#include <stdio.h> 54#else 55#include "sys/parsestreams.h" 56extern int printf (const char *, ...); 57#endif 58 59/* 0000000000111111111122222222223333333 / char 60 * 0123456789012345678901234567890123456 \ posn 61 * >RTMhhmmssdddDDMMYYYYoodnnvrrrrr;*xx< Actual 62 * ----33445566600112222BB7__-_____--99- Parse 63 * >RTM 1 ;* <", Check 64 */ 65 66#define hexval(x) (('0' <= (x) && (x) <= '9') ? (x) - '0' : \ 67 ('a' <= (x) && (x) <= 'f') ? (x) - 'a' + 10 : \ 68 ('A' <= (x) && (x) <= 'F') ? (x) - 'A' + 10 : \ 69 -1) 70#define O_USEC O_WDAY 71#define O_GPSFIX O_FLAGS 72#define O_CHKSUM O_UTCHOFFSET 73 static struct format trimsv6_fmt = 74{ { { 13, 2 }, {15, 2}, { 17, 4}, /* Day, Month, Year */ 75 { 4, 2 }, { 6, 2}, { 8, 2}, /* Hour, Minute, Second */ 76 { 10, 3 }, {23, 1}, { 0, 0}, /* uSec, FIXes (WeekDAY, FLAGS, ZONE) */ 77 { 34, 2 }, { 0, 0}, { 21, 2}, /* cksum, -, utcS (UTC[HMS]OFFSET) */ 78}, 79 (const unsigned char *)">RTM 1 ;* <", 80 0 81}; 82 83static unsigned long cvt_trimtaip (unsigned char *, int, struct format *, clocktime_t *, void *); 84static unsigned long inp_trimtaip (parse_t *, unsigned int, timestamp_t *); 85 86clockformat_t clock_trimtaip = 87{ 88 inp_trimtaip, /* no input handling */ 89 cvt_trimtaip, /* Trimble conversion */ 90 pps_one, /* easy PPS monitoring */ 91 (void *)&trimsv6_fmt, /* conversion configuration */ 92 "Trimble TAIP", 93 37, /* string buffer */ 94 0 /* no private data */ 95}; 96 97static unsigned long 98cvt_trimtaip( 99 unsigned char *buffer, 100 int size, 101 struct format *format, 102 clocktime_t *clock_time, 103 void *local 104 ) 105{ 106 long gpsfix; 107 u_char calc_csum = 0; 108 long recv_csum; 109 int i; 110 111 if (!Strok(buffer, format->fixed_string)) return CVT_NONE; 112#define OFFS(x) format->field_offsets[(x)].offset 113#define STOI(x, y) \ 114 Stoi(&buffer[OFFS(x)], y, \ 115 format->field_offsets[(x)].length) 116 if ( STOI(O_DAY, &clock_time->day) || 117 STOI(O_MONTH, &clock_time->month) || 118 STOI(O_YEAR, &clock_time->year) || 119 STOI(O_HOUR, &clock_time->hour) || 120 STOI(O_MIN, &clock_time->minute) || 121 STOI(O_SEC, &clock_time->second) || 122 STOI(O_USEC, &clock_time->usecond)|| 123 STOI(O_GPSFIX, &gpsfix) 124 ) return CVT_FAIL|CVT_BADFMT; 125 126 clock_time->usecond *= 1000; 127 /* Check that the checksum is right */ 128 for (i=OFFS(O_CHKSUM)-1; i >= 0; i--) calc_csum ^= buffer[i]; 129 recv_csum = (hexval(buffer[OFFS(O_CHKSUM)]) << 4) | 130 hexval(buffer[OFFS(O_CHKSUM)+1]); 131 if (recv_csum < 0) return CVT_FAIL|CVT_BADTIME; 132 if (((u_char) recv_csum) != calc_csum) return CVT_FAIL|CVT_BADTIME; 133 134 clock_time->utcoffset = 0; 135 136 /* What should flags be set to ? */ 137 clock_time->flags = PARSEB_UTC; 138 139 /* if the current GPS fix is 9 (unknown), reject */ 140 if (0 > gpsfix || gpsfix > 9) clock_time->flags |= PARSEB_POWERUP; 141 142 return CVT_OK; 143} 144 145/* 146 * inp_trimtaip 147 * 148 * grep data from input stream 149 */ 150static u_long 151inp_trimtaip( 152 parse_t *parseio, 153 unsigned int ch, 154 timestamp_t *tstamp 155 ) 156{ 157 unsigned int rtc; 158 159 parseprintf(DD_PARSE, ("inp_trimtaip(0x%lx, 0x%x, ...)\n", (long)parseio, ch)); 160 161 switch (ch) 162 { 163 case '>': 164 parseprintf(DD_PARSE, ("inp_trimptaip: START seen\n")); 165 166 parseio->parse_index = 1; 167 parseio->parse_data[0] = ch; 168 parseio->parse_dtime.parse_stime = *tstamp; /* collect timestamp */ 169 return PARSE_INP_SKIP; 170 171 case '<': 172 parseprintf(DD_PARSE, ("inp_trimtaip: END seen\n")); 173 if ((rtc = parse_addchar(parseio, ch)) == PARSE_INP_SKIP) 174 return parse_end(parseio); 175 else 176 return rtc; 177 178 179 default: 180 return parse_addchar(parseio, ch); 181 } 182} 183 184#else /* not (REFCLOCK && CLOCK_PARSE && CLOCK_TRIMTAIP) */ 185int clk_trimtaip_bs; 186#endif /* not (REFCLOCK && CLOCK_PARSE && CLOCK_TRIMTAIP) */ 187 188/* 189 * History: 190 * 191 * clk_trimtaip.c,v 192 * Revision 4.11 2005/04/16 17:32:10 kardel 193 * update copyright 194 * 195 * Revision 4.10 2004/11/14 15:29:41 kardel 196 * support PPSAPI, upgrade Copyright to Berkeley style 197 * 198 * Revision 4.7 1999/11/28 09:13:51 kardel 199 * RECON_4_0_98F 200 * 201 * Revision 4.6 1998/08/16 18:46:27 kardel 202 * (clock_trimtaip =): changed format name 203 * 204 * Revision 4.5 1998/06/14 21:09:38 kardel 205 * Sun acc cleanup 206 * 207 * Revision 4.4 1998/06/13 12:06:57 kardel 208 * fix SYSV clock name clash 209 * 210 * Revision 4.3 1998/06/12 15:22:29 kardel 211 * fix prototypes 212 * 213 * Revision 4.2 1998/06/12 09:13:26 kardel 214 * conditional compile macros fixed 215 * printf prototype 216 * 217 * Revision 4.1 1998/05/24 09:39:54 kardel 218 * implementation of the new IO handling model 219 * 220 * Revision 4.0 1998/04/10 19:45:31 kardel 221 * Start 4.0 release version numbering 222 * 223 * from V3 1.4 log info deleted 1998/04/11 kardel 224 */ 225 226