1 ////////////////////////////////////////////////////////////////////////////// 2 // Copyright (c) 2009,2012 - 3 // Schweitzer Engineering Laboratories, Inc. <opensource@selinc.com> 4 ////////////////////////////////////////////////////////////////////////////// 5 6 // Need to have _XOPEN_SOURCE defined for time.h to give the 7 // correct strptime signature. As per feature_test_macros(7), 8 // define this before including any header files. 9 10 // #ifndef _XOPEN_SOURCE 11 // #define _XOPEN_SOURCE 12 // #endif 13 14 #ifdef HAVE_CONFIG_H 15 # include <config.h> 16 #endif 17 18 #if defined(REFCLOCK) && defined(CLOCK_PARSE) && defined(CLOCK_SEL240X) 19 20 #include "ntp_syslog.h" 21 #include "ntp_types.h" 22 #include "ntp_fp.h" 23 #include "ntp_unixtime.h" 24 #include "ntp_calendar.h" 25 #include "ntp_machine.h" 26 #include "ntp_stdlib.h" 27 28 #include "parse.h" 29 30 #ifndef PARSESTREAM 31 # include <stdio.h> 32 #else 33 # include "sys/parsestreams.h" 34 #endif 35 36 #include <time.h> 37 38 ////////////////////////////////////////////////////////////////////////////// 39 // The B8 output has the following format B8 = '\x01YYYY:ddd:hh:mm:ssq\r\n' 40 // where q = ' ' locked 41 // '.' <1 us 42 // '*' <10 us 43 // '#' <100 us 44 // '?' >100 us 45 // 46 // Based on this we need to recored the stime when we receive the <SOH> 47 // character and end it when we see the \n. 48 // 49 // The q or quality character indicates satellite lock and sync. For the 50 // purposes of NTP we are going to call it valid when we receive anything but 51 // a '?'. But we are only going to call it synced when we receive a ' ' 52 ////////////////////////////////////////////////////////////////////////////// 53 54 static unsigned long inp_sel240x( parse_t *parseio, 55 unsigned int ch, 56 timestamp_t *tstamp); 57 static unsigned long cvt_sel240x( unsigned char *buffer, 58 int size, 59 struct format *format, 60 clocktime_t *clock_time, 61 void *local ); 62 63 // Parse clock format structure describing the message above 64 static struct format sel240x_fmt = 65 { { { 6, 3 }, 66 { 0, 0 }, 67 { 1, 4 }, 68 { 10, 2 }, 69 { 13, 2 }, 70 { 16, 2 }, 71 { 0, 0 }, 72 { 0, 0 }, 73 { 0, 0 }, 74 { 0, 0 }, 75 { 0, 0 }, 76 { 0, 0 } 77 }, 78 (const unsigned char *)"\x01 : : : : \x0d\x0a", 79 0 80 }; 81 82 // Structure desctibing the parser 83 clockformat_t clock_sel240x = 84 { 85 inp_sel240x, 86 cvt_sel240x, 87 pps_one, 88 (void*)&sel240x_fmt, 89 "SEL B8", 90 25, 91 0 92 }; 93 94 ////////////////////////////////////////////////////////////////////////////// 95 static unsigned long 96 inp_sel240x( parse_t *parseio, 97 unsigned int ch, 98 timestamp_t *tstamp 99 ) 100 { 101 unsigned long rc; 102 103 parseprintf( DD_PARSE, 104 ("inp_sel240x(0x%lx, 0x%x, ...)\n",(long)parseio, ch)); 105 106 switch( ch ) 107 { 108 case '\x01': 109 parseio->parse_index = 1; 110 parseio->parse_data[0] = ch; 111 parseio->parse_dtime.parse_stime = *tstamp; 112 rc = PARSE_INP_SKIP; 113 break; 114 case '\n': 115 if( (rc = parse_addchar(parseio, ch)) == PARSE_INP_SKIP ) 116 { 117 rc = parse_end( parseio ); 118 } 119 break; 120 default: 121 rc = parse_addchar( parseio, ch ); 122 } 123 124 return rc; 125 } 126 127 ////////////////////////////////////////////////////////////////////////////// 128 static unsigned long 129 cvt_sel240x( unsigned char *buffer, 130 int size, 131 struct format *format, 132 clocktime_t *clock_time, 133 void *local 134 ) 135 { 136 unsigned long rc = CVT_NONE; 137 138 if( Strok(buffer, format->fixed_string) ) 139 { 140 struct tm ptime; 141 buffer++; 142 buffer = (unsigned char *) strptime( 143 (const char *)buffer, "%Y:%j:%H:%M:%S", &ptime ); 144 if( *(buffer+1) != '\x0d' ) 145 { 146 rc = CVT_FAIL | CVT_BADFMT; 147 } 148 else 149 { 150 clock_time->day = ptime.tm_mday; 151 clock_time->month = ptime.tm_mon + 1; 152 clock_time->year = ptime.tm_year + 1900; 153 clock_time->hour = ptime.tm_hour; 154 clock_time->minute = ptime.tm_min; 155 clock_time->second = ptime.tm_sec; 156 clock_time->usecond = 0; 157 clock_time->utcoffset = 0; 158 clock_time->flags = PARSEB_UTC; 159 160 if( *buffer == '?' ) 161 { 162 clock_time->flags |= PARSEB_POWERUP; 163 } 164 else if( *buffer != ' ' ) 165 { 166 clock_time->flags |= PARSEB_NOSYNC; 167 } 168 169 rc = CVT_OK; 170 } 171 } 172 173 return rc; 174 } 175 176 #else /* not (REFCLOCK && CLOCK_PARSE && CLOCK_SEL240X) */ 177 int clk_sel240x_bs; 178 #endif /* not (REFCLOCK && CLOCK_PARSE && CLOCK_SEL240X) */ 179