clk_rawdcf.c revision 1.9 1 1.8 christos /* $NetBSD: clk_rawdcf.c,v 1.9 2024/08/18 20:47:17 christos Exp $ */
2 1.1 kardel
3 1.1 kardel /*
4 1.1 kardel * /src/NTP/REPOSITORY/ntp4-dev/libparse/clk_rawdcf.c,v 4.18 2006/06/22 18:40:01 kardel RELEASE_20060622_A
5 1.5 christos *
6 1.1 kardel * clk_rawdcf.c,v 4.18 2006/06/22 18:40:01 kardel RELEASE_20060622_A
7 1.1 kardel *
8 1.1 kardel * Raw DCF77 pulse clock support
9 1.1 kardel *
10 1.6 christos * Copyright (c) 1995-2015 by Frank Kardel <kardel <AT> ntp.org>
11 1.5 christos * Copyright (c) 1989-1994 by Frank Kardel, Friedrich-Alexander Universitaet Erlangen-Nuernberg, Germany
12 1.1 kardel *
13 1.1 kardel * Redistribution and use in source and binary forms, with or without
14 1.1 kardel * modification, are permitted provided that the following conditions
15 1.1 kardel * are met:
16 1.1 kardel * 1. Redistributions of source code must retain the above copyright
17 1.1 kardel * notice, this list of conditions and the following disclaimer.
18 1.1 kardel * 2. Redistributions in binary form must reproduce the above copyright
19 1.1 kardel * notice, this list of conditions and the following disclaimer in the
20 1.1 kardel * documentation and/or other materials provided with the distribution.
21 1.1 kardel * 3. Neither the name of the author nor the names of its contributors
22 1.1 kardel * may be used to endorse or promote products derived from this software
23 1.1 kardel * without specific prior written permission.
24 1.1 kardel *
25 1.1 kardel * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
26 1.1 kardel * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
27 1.1 kardel * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
28 1.1 kardel * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
29 1.1 kardel * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
30 1.1 kardel * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
31 1.1 kardel * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
32 1.1 kardel * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
33 1.1 kardel * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
34 1.1 kardel * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
35 1.1 kardel * SUCH DAMAGE.
36 1.1 kardel *
37 1.1 kardel */
38 1.1 kardel
39 1.1 kardel #ifdef HAVE_CONFIG_H
40 1.1 kardel # include <config.h>
41 1.1 kardel #endif
42 1.1 kardel
43 1.1 kardel #if defined(REFCLOCK) && defined(CLOCK_PARSE) && defined(CLOCK_RAWDCF)
44 1.1 kardel
45 1.1 kardel #include "ntp_fp.h"
46 1.6 christos #include "timevalops.h"
47 1.1 kardel #include "ntp_unixtime.h"
48 1.1 kardel #include "ntp_calendar.h"
49 1.1 kardel
50 1.1 kardel #include "parse.h"
51 1.1 kardel #ifdef PARSESTREAM
52 1.1 kardel # include <sys/parsestreams.h>
53 1.1 kardel #endif
54 1.1 kardel
55 1.1 kardel #ifndef PARSEKERNEL
56 1.1 kardel # include "ntp_stdlib.h"
57 1.1 kardel #endif
58 1.1 kardel
59 1.1 kardel /*
60 1.1 kardel * DCF77 raw time code
61 1.1 kardel *
62 1.1 kardel * From "Zur Zeit", Physikalisch-Technische Bundesanstalt (PTB), Braunschweig
63 1.1 kardel * und Berlin, Maerz 1989
64 1.1 kardel *
65 1.1 kardel * Timecode transmission:
66 1.1 kardel * AM:
67 1.1 kardel * time marks are send every second except for the second before the
68 1.1 kardel * next minute mark
69 1.1 kardel * time marks consist of a reduction of transmitter power to 25%
70 1.1 kardel * of the nominal level
71 1.1 kardel * the falling edge is the time indication (on time)
72 1.1 kardel * time marks of a 100ms duration constitute a logical 0
73 1.1 kardel * time marks of a 200ms duration constitute a logical 1
74 1.1 kardel * FM:
75 1.1 kardel * see the spec. (basically a (non-)inverted psuedo random phase shift)
76 1.1 kardel *
77 1.1 kardel * Encoding:
78 1.1 kardel * Second Contents
79 1.1 kardel * 0 - 10 AM: free, FM: 0
80 1.1 kardel * 11 - 14 free
81 1.5 christos * 15 R - "call bit" used to signalize irregularities in the control facilities
82 1.5 christos * (until 2003 indicated transmission via alternate antenna)
83 1.1 kardel * 16 A1 - expect zone change (1 hour before)
84 1.1 kardel * 17 - 18 Z1,Z2 - time zone
85 1.1 kardel * 0 0 illegal
86 1.1 kardel * 0 1 MEZ (MET)
87 1.1 kardel * 1 0 MESZ (MED, MET DST)
88 1.1 kardel * 1 1 illegal
89 1.1 kardel * 19 A2 - expect leap insertion/deletion (1 hour before)
90 1.1 kardel * 20 S - start of time code (1)
91 1.1 kardel * 21 - 24 M1 - BCD (lsb first) Minutes
92 1.1 kardel * 25 - 27 M10 - BCD (lsb first) 10 Minutes
93 1.1 kardel * 28 P1 - Minute Parity (even)
94 1.1 kardel * 29 - 32 H1 - BCD (lsb first) Hours
95 1.1 kardel * 33 - 34 H10 - BCD (lsb first) 10 Hours
96 1.1 kardel * 35 P2 - Hour Parity (even)
97 1.1 kardel * 36 - 39 D1 - BCD (lsb first) Days
98 1.1 kardel * 40 - 41 D10 - BCD (lsb first) 10 Days
99 1.1 kardel * 42 - 44 DW - BCD (lsb first) day of week (1: Monday -> 7: Sunday)
100 1.1 kardel * 45 - 49 MO - BCD (lsb first) Month
101 1.1 kardel * 50 MO0 - 10 Months
102 1.1 kardel * 51 - 53 Y1 - BCD (lsb first) Years
103 1.1 kardel * 54 - 57 Y10 - BCD (lsb first) 10 Years
104 1.1 kardel * 58 P3 - Date Parity (even)
105 1.1 kardel * 59 - usually missing (minute indication), except for leap insertion
106 1.1 kardel */
107 1.1 kardel
108 1.5 christos static parse_pps_fnc_t pps_rawdcf;
109 1.5 christos static parse_cvt_fnc_t cvt_rawdcf;
110 1.5 christos static parse_inp_fnc_t inp_rawdcf;
111 1.1 kardel
112 1.1 kardel typedef struct last_tcode {
113 1.6 christos time_t tcode; /* last converted time code */
114 1.6 christos timestamp_t tminute; /* sample time for minute start */
115 1.6 christos timestamp_t timeout; /* last timeout timestamp */
116 1.1 kardel } last_tcode_t;
117 1.1 kardel
118 1.1 kardel #define BUFFER_MAX 61
119 1.1 kardel
120 1.1 kardel clockformat_t clock_rawdcf =
121 1.1 kardel {
122 1.1 kardel inp_rawdcf, /* DCF77 input handling */
123 1.1 kardel cvt_rawdcf, /* raw dcf input conversion */
124 1.1 kardel pps_rawdcf, /* examining PPS information */
125 1.1 kardel 0, /* no private configuration data */
126 1.1 kardel "RAW DCF77 Timecode", /* direct decoding / time synthesis */
127 1.1 kardel
128 1.1 kardel BUFFER_MAX, /* bit buffer */
129 1.1 kardel sizeof(last_tcode_t)
130 1.1 kardel };
131 1.1 kardel
132 1.1 kardel static struct dcfparam
133 1.1 kardel {
134 1.2 christos const unsigned char *onebits;
135 1.2 christos const unsigned char *zerobits;
136 1.5 christos } dcfparameter =
137 1.1 kardel {
138 1.2 christos (const unsigned char *)"###############RADMLS1248124P124812P1248121241248112481248P??", /* 'ONE' representation */
139 1.2 christos (const unsigned char *)"--------------------s-------p------p----------------------p__" /* 'ZERO' representation */
140 1.1 kardel };
141 1.1 kardel
142 1.5 christos static struct rawdcfcode
143 1.1 kardel {
144 1.1 kardel char offset; /* start bit */
145 1.1 kardel } rawdcfcode[] =
146 1.1 kardel {
147 1.1 kardel { 0 }, { 15 }, { 16 }, { 17 }, { 19 }, { 20 }, { 21 }, { 25 }, { 28 }, { 29 },
148 1.1 kardel { 33 }, { 35 }, { 36 }, { 40 }, { 42 }, { 45 }, { 49 }, { 50 }, { 54 }, { 58 }, { 59 }
149 1.1 kardel };
150 1.1 kardel
151 1.1 kardel #define DCF_M 0
152 1.1 kardel #define DCF_R 1
153 1.1 kardel #define DCF_A1 2
154 1.1 kardel #define DCF_Z 3
155 1.1 kardel #define DCF_A2 4
156 1.1 kardel #define DCF_S 5
157 1.1 kardel #define DCF_M1 6
158 1.1 kardel #define DCF_M10 7
159 1.1 kardel #define DCF_P1 8
160 1.1 kardel #define DCF_H1 9
161 1.1 kardel #define DCF_H10 10
162 1.1 kardel #define DCF_P2 11
163 1.1 kardel #define DCF_D1 12
164 1.1 kardel #define DCF_D10 13
165 1.1 kardel #define DCF_DW 14
166 1.1 kardel #define DCF_MO 15
167 1.1 kardel #define DCF_MO0 16
168 1.1 kardel #define DCF_Y1 17
169 1.1 kardel #define DCF_Y10 18
170 1.1 kardel #define DCF_P3 19
171 1.1 kardel
172 1.1 kardel static struct partab
173 1.1 kardel {
174 1.1 kardel char offset; /* start bit of parity field */
175 1.1 kardel } partab[] =
176 1.1 kardel {
177 1.1 kardel { 21 }, { 29 }, { 36 }, { 59 }
178 1.1 kardel };
179 1.1 kardel
180 1.1 kardel #define DCF_P_P1 0
181 1.1 kardel #define DCF_P_P2 1
182 1.1 kardel #define DCF_P_P3 2
183 1.1 kardel
184 1.1 kardel #define DCF_Z_MET 0x2
185 1.1 kardel #define DCF_Z_MED 0x1
186 1.1 kardel
187 1.1 kardel static u_long
188 1.1 kardel ext_bf(
189 1.1 kardel unsigned char *buf,
190 1.1 kardel int idx,
191 1.2 christos const unsigned char *zero
192 1.1 kardel )
193 1.1 kardel {
194 1.1 kardel u_long sum = 0;
195 1.1 kardel int i, first;
196 1.1 kardel
197 1.1 kardel first = rawdcfcode[idx].offset;
198 1.5 christos
199 1.1 kardel for (i = rawdcfcode[idx+1].offset - 1; i >= first; i--)
200 1.1 kardel {
201 1.1 kardel sum <<= 1;
202 1.1 kardel sum |= (buf[i] != zero[i]);
203 1.1 kardel }
204 1.1 kardel return sum;
205 1.1 kardel }
206 1.1 kardel
207 1.1 kardel static unsigned
208 1.1 kardel pcheck(
209 1.1 kardel unsigned char *buf,
210 1.1 kardel int idx,
211 1.2 christos const unsigned char *zero
212 1.1 kardel )
213 1.1 kardel {
214 1.1 kardel int i,last;
215 1.1 kardel unsigned psum = 1;
216 1.1 kardel
217 1.1 kardel last = partab[idx+1].offset;
218 1.1 kardel
219 1.1 kardel for (i = partab[idx].offset; i < last; i++)
220 1.1 kardel psum ^= (buf[i] != zero[i]);
221 1.1 kardel
222 1.1 kardel return psum;
223 1.1 kardel }
224 1.1 kardel
225 1.8 christos static int/*BOOL*/
226 1.8 christos zeller_expand(
227 1.8 christos clocktime_t *clock_time,
228 1.8 christos unsigned int wd
229 1.8 christos )
230 1.8 christos {
231 1.8 christos unsigned int y = (unsigned int)clock_time->year;
232 1.8 christos unsigned int m = (unsigned int)clock_time->month - 1u;
233 1.8 christos unsigned int d = (unsigned int)clock_time->day - 1u;
234 1.8 christos unsigned int c;
235 1.8 christos
236 1.8 christos /* Check basic constraints first. */
237 1.8 christos if ((y >= 100u) || (m >= 12u) || (d >= 31u) || (--wd >= 7u))
238 1.8 christos return FALSE;
239 1.8 christos
240 1.8 christos /* Get weekday of date in 1st century by a variation on Zeller's
241 1.8 christos * congruence. All operands are non-negative, and the month
242 1.8 christos * formula is adjusted to use a divider of 32, so we can do a
243 1.8 christos * shift instead of a 'true' division:
244 1.8 christos */
245 1.8 christos if ((m += 10u) >= 12u) /* shift base to 0000-03-01 */
246 1.8 christos m -= 12u;
247 1.8 christos else if (--y >= 100u)
248 1.8 christos y += 100;
249 1.8 christos d += y + (y >> 2) + 2u; /* year-related share */
250 1.8 christos d += (m * 83u + 16u) >> 5; /* month-related share */
251 1.8 christos
252 1.8 christos /* The next step combines the exact division by modular inverse
253 1.8 christos * with the (mod 7) step in such way that no true division and
254 1.8 christos * only one multiplication is needed. The multiplier is
255 1.8 christos * M <- ceil((3*8)/7 * 2**29)
256 1.8 christos * and combines multiplication by invmod(5, 7) -> 3 and modulus
257 1.8 christos * by 7 transformation to (mod 8) in one step.
258 1.8 christos * Note that 252 == 0 (mod 7) and that 'd' is less than 185,
259 1.8 christos * so the number to invert and reduce is strictly positive. In
260 1.8 christos * the end, 'c' is number of centuries since start of a great
261 1.8 christos * cycle and must be in [0..3] or we had bad input.
262 1.8 christos */
263 1.8 christos c = (((252u + wd - d) * 0x6db6db6eU) >> 29) & 7u;
264 1.8 christos if (c >= 4)
265 1.8 christos return FALSE;
266 1.8 christos /* undo calendar base shift now */
267 1.8 christos if ((m > 9u) && (++y >= 100u)) {
268 1.8 christos y -= 100u;
269 1.8 christos c = (c + 1u) & 3u;
270 1.8 christos }
271 1.8 christos /* combine year with centuries & map to [1970..2369] */
272 1.8 christos y += (c * 100u);
273 1.8 christos clock_time->year = (int)y + ((y < 370u) ? 2000 : 1600);
274 1.8 christos return TRUE;
275 1.8 christos }
276 1.8 christos
277 1.1 kardel static u_long
278 1.1 kardel convert_rawdcf(
279 1.1 kardel unsigned char *buffer,
280 1.1 kardel int size,
281 1.1 kardel struct dcfparam *dcfprm,
282 1.1 kardel clocktime_t *clock_time
283 1.1 kardel )
284 1.1 kardel {
285 1.1 kardel unsigned char *s = buffer;
286 1.2 christos const unsigned char *b = dcfprm->onebits;
287 1.2 christos const unsigned char *c = dcfprm->zerobits;
288 1.1 kardel int i;
289 1.1 kardel
290 1.6 christos parseprintf(DD_RAWDCF,("parse: convert_rawdcf: \"%.*s\"\n", size, buffer));
291 1.1 kardel
292 1.1 kardel if (size < 57)
293 1.1 kardel {
294 1.1 kardel #ifndef PARSEKERNEL
295 1.3 christos msyslog(LOG_ERR, "parse: convert_rawdcf: INCOMPLETE DATA - time code only has %d bits", size);
296 1.1 kardel #endif
297 1.6 christos return CVT_FAIL|CVT_BADFMT;
298 1.1 kardel }
299 1.5 christos
300 1.1 kardel for (i = 0; i < size; i++)
301 1.1 kardel {
302 1.1 kardel if ((*s != *b) && (*s != *c))
303 1.1 kardel {
304 1.1 kardel /*
305 1.1 kardel * we only have two types of bytes (ones and zeros)
306 1.1 kardel */
307 1.1 kardel #ifndef PARSEKERNEL
308 1.1 kardel msyslog(LOG_ERR, "parse: convert_rawdcf: BAD DATA - no conversion");
309 1.1 kardel #endif
310 1.6 christos return CVT_FAIL|CVT_BADFMT;
311 1.1 kardel }
312 1.1 kardel if (*b) b++;
313 1.1 kardel if (*c) c++;
314 1.1 kardel s++;
315 1.1 kardel }
316 1.1 kardel
317 1.1 kardel /*
318 1.1 kardel * check Start and Parity bits
319 1.1 kardel */
320 1.1 kardel if ((ext_bf(buffer, DCF_S, dcfprm->zerobits) == 1) &&
321 1.1 kardel pcheck(buffer, DCF_P_P1, dcfprm->zerobits) &&
322 1.1 kardel pcheck(buffer, DCF_P_P2, dcfprm->zerobits) &&
323 1.1 kardel pcheck(buffer, DCF_P_P3, dcfprm->zerobits))
324 1.1 kardel {
325 1.1 kardel /*
326 1.1 kardel * buffer OK
327 1.1 kardel */
328 1.1 kardel parseprintf(DD_RAWDCF,("parse: convert_rawdcf: parity check passed\n"));
329 1.1 kardel
330 1.6 christos clock_time->flags = PARSEB_S_CALLBIT|PARSEB_S_LEAP;
331 1.1 kardel clock_time->utctime= 0;
332 1.1 kardel clock_time->usecond= 0;
333 1.1 kardel clock_time->second = 0;
334 1.1 kardel clock_time->minute = ext_bf(buffer, DCF_M10, dcfprm->zerobits);
335 1.1 kardel clock_time->minute = TIMES10(clock_time->minute) + ext_bf(buffer, DCF_M1, dcfprm->zerobits);
336 1.1 kardel clock_time->hour = ext_bf(buffer, DCF_H10, dcfprm->zerobits);
337 1.1 kardel clock_time->hour = TIMES10(clock_time->hour) + ext_bf(buffer, DCF_H1, dcfprm->zerobits);
338 1.1 kardel clock_time->day = ext_bf(buffer, DCF_D10, dcfprm->zerobits);
339 1.1 kardel clock_time->day = TIMES10(clock_time->day) + ext_bf(buffer, DCF_D1, dcfprm->zerobits);
340 1.1 kardel clock_time->month = ext_bf(buffer, DCF_MO0, dcfprm->zerobits);
341 1.1 kardel clock_time->month = TIMES10(clock_time->month) + ext_bf(buffer, DCF_MO, dcfprm->zerobits);
342 1.1 kardel clock_time->year = ext_bf(buffer, DCF_Y10, dcfprm->zerobits);
343 1.1 kardel clock_time->year = TIMES10(clock_time->year) + ext_bf(buffer, DCF_Y1, dcfprm->zerobits);
344 1.1 kardel
345 1.8 christos if (!zeller_expand(clock_time, ext_bf(buffer, DCF_DW, dcfprm->zerobits)))
346 1.8 christos return CVT_FAIL|CVT_BADFMT;
347 1.8 christos
348 1.1 kardel switch (ext_bf(buffer, DCF_Z, dcfprm->zerobits))
349 1.1 kardel {
350 1.1 kardel case DCF_Z_MET:
351 1.1 kardel clock_time->utcoffset = -1*60*60;
352 1.1 kardel break;
353 1.1 kardel
354 1.1 kardel case DCF_Z_MED:
355 1.1 kardel clock_time->flags |= PARSEB_DST;
356 1.1 kardel clock_time->utcoffset = -2*60*60;
357 1.1 kardel break;
358 1.1 kardel
359 1.1 kardel default:
360 1.1 kardel parseprintf(DD_RAWDCF,("parse: convert_rawdcf: BAD TIME ZONE\n"));
361 1.1 kardel return CVT_FAIL|CVT_BADFMT;
362 1.1 kardel }
363 1.1 kardel
364 1.1 kardel if (ext_bf(buffer, DCF_A1, dcfprm->zerobits))
365 1.1 kardel clock_time->flags |= PARSEB_ANNOUNCE;
366 1.1 kardel
367 1.1 kardel if (ext_bf(buffer, DCF_A2, dcfprm->zerobits))
368 1.1 kardel clock_time->flags |= PARSEB_LEAPADD; /* default: DCF77 data format deficiency */
369 1.1 kardel
370 1.1 kardel if (ext_bf(buffer, DCF_R, dcfprm->zerobits))
371 1.5 christos clock_time->flags |= PARSEB_CALLBIT;
372 1.1 kardel
373 1.6 christos parseprintf(DD_RAWDCF,("parse: convert_rawdcf: TIME CODE OK: %02d:%02d, %02d.%02d.%02d, flags 0x%lx\n",
374 1.1 kardel (int)clock_time->hour, (int)clock_time->minute, (int)clock_time->day, (int)clock_time->month,(int) clock_time->year,
375 1.1 kardel (u_long)clock_time->flags));
376 1.1 kardel return CVT_OK;
377 1.1 kardel }
378 1.1 kardel else
379 1.1 kardel {
380 1.1 kardel /*
381 1.1 kardel * bad format - not for us
382 1.1 kardel */
383 1.1 kardel #ifndef PARSEKERNEL
384 1.6 christos msyslog(LOG_ERR, "parse: convert_rawdcf: start bit / parity check FAILED for \"%.*s\"", size, buffer);
385 1.1 kardel #endif
386 1.1 kardel return CVT_FAIL|CVT_BADFMT;
387 1.1 kardel }
388 1.1 kardel }
389 1.1 kardel
390 1.1 kardel /*
391 1.5 christos * parse_cvt_fnc_t cvt_rawdcf
392 1.1 kardel * raw dcf input routine - needs to fix up 50 baud
393 1.1 kardel * characters for 1/0 decision
394 1.1 kardel */
395 1.1 kardel static u_long
396 1.1 kardel cvt_rawdcf(
397 1.1 kardel unsigned char *buffer,
398 1.1 kardel int size,
399 1.1 kardel struct format *param,
400 1.1 kardel clocktime_t *clock_time,
401 1.1 kardel void *local
402 1.1 kardel )
403 1.1 kardel {
404 1.1 kardel last_tcode_t *t = (last_tcode_t *)local;
405 1.1 kardel unsigned char *s = (unsigned char *)buffer;
406 1.1 kardel unsigned char *e = s + size;
407 1.2 christos const unsigned char *b = dcfparameter.onebits;
408 1.2 christos const unsigned char *c = dcfparameter.zerobits;
409 1.1 kardel u_long rtc = CVT_NONE;
410 1.1 kardel unsigned int i, lowmax, highmax, cutoff, span;
411 1.1 kardel #define BITS 9
412 1.1 kardel unsigned char histbuf[BITS];
413 1.1 kardel /*
414 1.1 kardel * the input buffer contains characters with runs of consecutive
415 1.1 kardel * bits set. These set bits are an indication of the DCF77 pulse
416 1.1 kardel * length. We assume that we receive the pulse at 50 Baud. Thus
417 1.1 kardel * a 100ms pulse would generate a 4 bit train (20ms per bit and
418 1.1 kardel * start bit)
419 1.1 kardel * a 200ms pulse would create all zeroes (and probably a frame error)
420 1.1 kardel */
421 1.1 kardel
422 1.1 kardel for (i = 0; i < BITS; i++)
423 1.1 kardel {
424 1.1 kardel histbuf[i] = 0;
425 1.1 kardel }
426 1.1 kardel
427 1.1 kardel cutoff = 0;
428 1.1 kardel lowmax = 0;
429 1.1 kardel
430 1.1 kardel while (s < e)
431 1.1 kardel {
432 1.1 kardel unsigned int ch = *s ^ 0xFF;
433 1.1 kardel /*
434 1.1 kardel * these lines are left as an excercise to the reader 8-)
435 1.1 kardel */
436 1.1 kardel if (!((ch+1) & ch) || !*s)
437 1.1 kardel {
438 1.1 kardel
439 1.1 kardel for (i = 0; ch; i++)
440 1.1 kardel {
441 1.1 kardel ch >>= 1;
442 1.1 kardel }
443 1.1 kardel
444 1.5 christos *s = (unsigned char) i;
445 1.1 kardel histbuf[i]++;
446 1.1 kardel cutoff += i;
447 1.1 kardel lowmax++;
448 1.1 kardel }
449 1.1 kardel else
450 1.1 kardel {
451 1.1 kardel parseprintf(DD_RAWDCF,("parse: cvt_rawdcf: character check for 0x%x@%d FAILED\n", *s, (int)(s - (unsigned char *)buffer)));
452 1.1 kardel *s = (unsigned char)~0;
453 1.1 kardel rtc = CVT_FAIL|CVT_BADFMT;
454 1.1 kardel }
455 1.1 kardel s++;
456 1.1 kardel }
457 1.1 kardel
458 1.1 kardel if (lowmax)
459 1.1 kardel {
460 1.1 kardel cutoff /= lowmax;
461 1.1 kardel }
462 1.1 kardel else
463 1.1 kardel {
464 1.1 kardel cutoff = 4; /* doesn't really matter - it'll fail anyway, but gives error output */
465 1.1 kardel }
466 1.1 kardel
467 1.1 kardel parseprintf(DD_RAWDCF,("parse: cvt_rawdcf: average bit count: %d\n", cutoff));
468 1.1 kardel
469 1.1 kardel lowmax = 0;
470 1.1 kardel highmax = 0;
471 1.1 kardel
472 1.1 kardel parseprintf(DD_RAWDCF,("parse: cvt_rawdcf: histogram:"));
473 1.1 kardel for (i = 0; i <= cutoff; i++)
474 1.1 kardel {
475 1.1 kardel lowmax+=histbuf[i] * i;
476 1.1 kardel highmax += histbuf[i];
477 1.1 kardel parseprintf(DD_RAWDCF,(" %d", histbuf[i]));
478 1.1 kardel }
479 1.1 kardel parseprintf(DD_RAWDCF, (" <M>"));
480 1.1 kardel
481 1.1 kardel lowmax += highmax / 2;
482 1.1 kardel
483 1.1 kardel if (highmax)
484 1.1 kardel {
485 1.1 kardel lowmax /= highmax;
486 1.1 kardel }
487 1.1 kardel else
488 1.1 kardel {
489 1.1 kardel lowmax = 0;
490 1.1 kardel }
491 1.1 kardel
492 1.1 kardel highmax = 0;
493 1.1 kardel cutoff = 0;
494 1.1 kardel
495 1.1 kardel for (; i < BITS; i++)
496 1.1 kardel {
497 1.1 kardel highmax+=histbuf[i] * i;
498 1.1 kardel cutoff +=histbuf[i];
499 1.1 kardel parseprintf(DD_RAWDCF,(" %d", histbuf[i]));
500 1.1 kardel }
501 1.1 kardel parseprintf(DD_RAWDCF,("\n"));
502 1.1 kardel
503 1.1 kardel if (cutoff)
504 1.1 kardel {
505 1.1 kardel highmax /= cutoff;
506 1.1 kardel }
507 1.1 kardel else
508 1.1 kardel {
509 1.1 kardel highmax = BITS-1;
510 1.1 kardel }
511 1.1 kardel
512 1.1 kardel span = cutoff = lowmax;
513 1.1 kardel for (i = lowmax; i <= highmax; i++)
514 1.1 kardel {
515 1.1 kardel if (histbuf[cutoff] > histbuf[i])
516 1.1 kardel {
517 1.1 kardel cutoff = i;
518 1.1 kardel span = i;
519 1.1 kardel }
520 1.1 kardel else
521 1.1 kardel if (histbuf[cutoff] == histbuf[i])
522 1.1 kardel {
523 1.1 kardel span = i;
524 1.1 kardel }
525 1.1 kardel }
526 1.1 kardel
527 1.1 kardel cutoff = (cutoff + span) / 2;
528 1.1 kardel
529 1.1 kardel parseprintf(DD_RAWDCF,("parse: cvt_rawdcf: lower maximum %d, higher maximum %d, cutoff %d\n", lowmax, highmax, cutoff));
530 1.1 kardel
531 1.1 kardel s = (unsigned char *)buffer;
532 1.1 kardel while (s < e)
533 1.1 kardel {
534 1.1 kardel if (*s == (unsigned char)~0)
535 1.1 kardel {
536 1.1 kardel *s = '?';
537 1.1 kardel }
538 1.1 kardel else
539 1.1 kardel {
540 1.1 kardel *s = (*s >= cutoff) ? *b : *c;
541 1.1 kardel }
542 1.1 kardel s++;
543 1.1 kardel if (*b) b++;
544 1.1 kardel if (*c) c++;
545 1.1 kardel }
546 1.1 kardel
547 1.6 christos *s = '\0';
548 1.6 christos
549 1.1 kardel if (rtc == CVT_NONE)
550 1.1 kardel {
551 1.1 kardel rtc = convert_rawdcf(buffer, size, &dcfparameter, clock_time);
552 1.1 kardel if (rtc == CVT_OK)
553 1.1 kardel {
554 1.1 kardel time_t newtime;
555 1.1 kardel
556 1.1 kardel newtime = parse_to_unixtime(clock_time, &rtc);
557 1.1 kardel if ((rtc == CVT_OK) && t)
558 1.1 kardel {
559 1.6 christos if ((newtime - t->tcode) <= 600) /* require a successful telegram within last 10 minutes */
560 1.1 kardel {
561 1.6 christos parseprintf(DD_RAWDCF,("parse: cvt_rawdcf: recent timestamp check OK\n"));
562 1.1 kardel clock_time->utctime = newtime;
563 1.1 kardel }
564 1.1 kardel else
565 1.1 kardel {
566 1.6 christos parseprintf(DD_RAWDCF,("parse: cvt_rawdcf: recent timestamp check FAIL - ignore timestamp\n"));
567 1.6 christos rtc = CVT_SKIP;
568 1.1 kardel }
569 1.1 kardel t->tcode = newtime;
570 1.1 kardel }
571 1.1 kardel }
572 1.1 kardel }
573 1.5 christos
574 1.1 kardel return rtc;
575 1.1 kardel }
576 1.1 kardel
577 1.1 kardel /*
578 1.5 christos * parse_pps_fnc_t pps_rawdcf
579 1.1 kardel *
580 1.1 kardel * currently a very stupid version - should be extended to decode
581 1.1 kardel * also ones and zeros (which is easy)
582 1.1 kardel */
583 1.1 kardel /*ARGSUSED*/
584 1.1 kardel static u_long
585 1.1 kardel pps_rawdcf(
586 1.1 kardel parse_t *parseio,
587 1.1 kardel int status,
588 1.1 kardel timestamp_t *ptime
589 1.1 kardel )
590 1.1 kardel {
591 1.1 kardel if (!status) /* negative edge for simpler wiring (Rx->DCD) */
592 1.1 kardel {
593 1.1 kardel parseio->parse_dtime.parse_ptime = *ptime;
594 1.1 kardel parseio->parse_dtime.parse_state |= PARSEB_PPS|PARSEB_S_PPS;
595 1.1 kardel }
596 1.1 kardel
597 1.1 kardel return CVT_NONE;
598 1.1 kardel }
599 1.1 kardel
600 1.6 christos static long
601 1.6 christos calc_usecdiff(
602 1.6 christos timestamp_t *ref,
603 1.6 christos timestamp_t *base,
604 1.6 christos long offset
605 1.6 christos )
606 1.6 christos {
607 1.6 christos struct timeval delta;
608 1.6 christos long delta_usec = 0;
609 1.6 christos
610 1.6 christos #ifdef PARSEKERNEL
611 1.6 christos delta.tv_sec = ref->tv.tv_sec - offset - base->tv.tv_sec;
612 1.6 christos delta.tv_usec = ref->tv.tv_usec - base->tv.tv_usec;
613 1.6 christos if (delta.tv_usec < 0)
614 1.6 christos {
615 1.6 christos delta.tv_sec -= 1;
616 1.6 christos delta.tv_usec += 1000000;
617 1.6 christos }
618 1.6 christos #else
619 1.6 christos l_fp delt;
620 1.6 christos
621 1.6 christos delt = ref->fp;
622 1.6 christos delt.l_i -= offset;
623 1.6 christos L_SUB(&delt, &base->fp);
624 1.6 christos TSTOTV(&delt, &delta);
625 1.6 christos #endif
626 1.6 christos
627 1.6 christos delta_usec = 1000000 * (int32_t)delta.tv_sec + delta.tv_usec;
628 1.6 christos return delta_usec;
629 1.6 christos }
630 1.6 christos
631 1.1 kardel static u_long
632 1.1 kardel snt_rawdcf(
633 1.1 kardel parse_t *parseio,
634 1.1 kardel timestamp_t *ptime
635 1.1 kardel )
636 1.1 kardel {
637 1.6 christos /*
638 1.6 christos * only synthesize if all of following conditions are met:
639 1.6 christos * - CVT_OK parse_status (we have a time stamp base)
640 1.6 christos * - ABS(ptime - tminute - (parse_index - 1) sec) < 500ms (spaced by 1 sec +- 500ms)
641 1.6 christos * - minute marker is available (confirms minute raster as base)
642 1.6 christos */
643 1.6 christos last_tcode_t *t = (last_tcode_t *)parseio->parse_pdata;
644 1.6 christos long delta_usec = -1;
645 1.6 christos
646 1.6 christos if (t != NULL && t->tminute.tv.tv_sec != 0) {
647 1.6 christos delta_usec = calc_usecdiff(ptime, &t->tminute, parseio->parse_index - 1);
648 1.6 christos if (delta_usec < 0)
649 1.6 christos delta_usec = -delta_usec;
650 1.6 christos }
651 1.6 christos
652 1.6 christos parseprintf(DD_RAWDCF,("parse: snt_rawdcf: synth for offset %d seconds - absolute usec error %ld\n",
653 1.6 christos parseio->parse_index - 1, delta_usec));
654 1.6 christos
655 1.6 christos if (((parseio->parse_dtime.parse_status & CVT_MASK) == CVT_OK) &&
656 1.6 christos (delta_usec < 500000 && delta_usec >= 0)) /* only if minute marker is available */
657 1.1 kardel {
658 1.1 kardel parseio->parse_dtime.parse_stime = *ptime;
659 1.1 kardel
660 1.1 kardel #ifdef PARSEKERNEL
661 1.1 kardel parseio->parse_dtime.parse_time.tv.tv_sec++;
662 1.1 kardel #else
663 1.1 kardel parseio->parse_dtime.parse_time.fp.l_ui++;
664 1.1 kardel #endif
665 1.5 christos
666 1.1 kardel parseprintf(DD_RAWDCF,("parse: snt_rawdcf: time stamp synthesized offset %d seconds\n", parseio->parse_index - 1));
667 1.5 christos
668 1.1 kardel return updatetimeinfo(parseio, parseio->parse_lstate);
669 1.1 kardel }
670 1.1 kardel return CVT_NONE;
671 1.1 kardel }
672 1.1 kardel
673 1.1 kardel /*
674 1.5 christos * parse_inp_fnc_t inp_rawdcf
675 1.1 kardel *
676 1.1 kardel * grab DCF77 data from input stream
677 1.1 kardel */
678 1.1 kardel static u_long
679 1.1 kardel inp_rawdcf(
680 1.1 kardel parse_t *parseio,
681 1.5 christos char ch,
682 1.1 kardel timestamp_t *tstamp
683 1.1 kardel )
684 1.1 kardel {
685 1.1 kardel static struct timeval timeout = { 1, 500000 }; /* 1.5 secongs denote second #60 */
686 1.5 christos
687 1.7 christos parseprintf(DD_PARSE, ("inp_rawdcf(0x%p, 0x%x, ...)\n", (void*)parseio, ch));
688 1.5 christos
689 1.1 kardel parseio->parse_dtime.parse_stime = *tstamp; /* collect timestamp */
690 1.1 kardel
691 1.1 kardel if (parse_timedout(parseio, tstamp, &timeout))
692 1.1 kardel {
693 1.6 christos last_tcode_t *t = (last_tcode_t *)parseio->parse_pdata;
694 1.6 christos long delta_usec;
695 1.6 christos
696 1.6 christos parseprintf(DD_RAWDCF, ("inp_rawdcf: time out seen\n"));
697 1.6 christos /* finish collection */
698 1.6 christos (void) parse_end(parseio);
699 1.6 christos
700 1.6 christos if (t != NULL)
701 1.6 christos {
702 1.6 christos /* remember minute start sample time if timeouts occur in minute raster */
703 1.6 christos if (t->timeout.tv.tv_sec != 0)
704 1.6 christos {
705 1.6 christos delta_usec = calc_usecdiff(tstamp, &t->timeout, 60);
706 1.6 christos if (delta_usec < 0)
707 1.6 christos delta_usec = -delta_usec;
708 1.6 christos }
709 1.6 christos else
710 1.6 christos {
711 1.6 christos delta_usec = -1;
712 1.6 christos }
713 1.1 kardel
714 1.6 christos if (delta_usec < 500000 && delta_usec >= 0)
715 1.6 christos {
716 1.6 christos parseprintf(DD_RAWDCF, ("inp_rawdcf: timeout time difference %ld usec - minute marker set\n", delta_usec));
717 1.6 christos /* collect minute markers only if spaced by 60 seconds */
718 1.6 christos t->tminute = *tstamp;
719 1.6 christos }
720 1.6 christos else
721 1.6 christos {
722 1.6 christos parseprintf(DD_RAWDCF, ("inp_rawdcf: timeout time difference %ld usec - minute marker cleared\n", delta_usec));
723 1.6 christos memset((char *)&t->tminute, 0, sizeof(t->tminute));
724 1.6 christos }
725 1.6 christos t->timeout = *tstamp;
726 1.6 christos }
727 1.1 kardel (void) parse_addchar(parseio, ch);
728 1.6 christos
729 1.6 christos /* pass up to higher layers */
730 1.1 kardel return PARSE_INP_TIME;
731 1.1 kardel }
732 1.1 kardel else
733 1.1 kardel {
734 1.1 kardel unsigned int rtc;
735 1.5 christos
736 1.1 kardel rtc = parse_addchar(parseio, ch);
737 1.1 kardel if (rtc == PARSE_INP_SKIP)
738 1.1 kardel {
739 1.1 kardel if (snt_rawdcf(parseio, tstamp) == CVT_OK)
740 1.1 kardel return PARSE_INP_SYNTH;
741 1.1 kardel }
742 1.1 kardel return rtc;
743 1.1 kardel }
744 1.1 kardel }
745 1.1 kardel
746 1.1 kardel #else /* not (REFCLOCK && CLOCK_PARSE && CLOCK_RAWDCF) */
747 1.9 christos NONEMPTY_TRANSLATION_UNIT
748 1.1 kardel #endif /* not (REFCLOCK && CLOCK_PARSE && CLOCK_RAWDCF) */
749 1.1 kardel
750 1.1 kardel /*
751 1.1 kardel * History:
752 1.1 kardel *
753 1.1 kardel * clk_rawdcf.c,v
754 1.1 kardel * Revision 4.18 2006/06/22 18:40:01 kardel
755 1.1 kardel * clean up signedness (gcc 4)
756 1.1 kardel *
757 1.1 kardel * Revision 4.17 2006/01/22 16:01:55 kardel
758 1.1 kardel * update version information
759 1.1 kardel *
760 1.1 kardel * Revision 4.16 2006/01/22 15:51:22 kardel
761 1.1 kardel * generate reasonable timecode output on invalid input
762 1.1 kardel *
763 1.1 kardel * Revision 4.15 2005/08/06 19:17:06 kardel
764 1.1 kardel * clean log output
765 1.1 kardel *
766 1.1 kardel * Revision 4.14 2005/08/06 17:39:40 kardel
767 1.1 kardel * cleanup size handling wrt/ to buffer boundaries
768 1.1 kardel *
769 1.1 kardel * Revision 4.13 2005/04/16 17:32:10 kardel
770 1.1 kardel * update copyright
771 1.1 kardel *
772 1.1 kardel * Revision 4.12 2004/11/14 15:29:41 kardel
773 1.1 kardel * support PPSAPI, upgrade Copyright to Berkeley style
774 1.1 kardel *
775 1.1 kardel * Revision 4.9 1999/12/06 13:42:23 kardel
776 1.1 kardel * transfer correctly converted time codes always into tcode
777 1.1 kardel *
778 1.1 kardel * Revision 4.8 1999/11/28 09:13:50 kardel
779 1.1 kardel * RECON_4_0_98F
780 1.1 kardel *
781 1.1 kardel * Revision 4.7 1999/04/01 20:07:20 kardel
782 1.1 kardel * added checking for minutie increment of timestamps in clk_rawdcf.c
783 1.1 kardel *
784 1.1 kardel * Revision 4.6 1998/06/14 21:09:37 kardel
785 1.1 kardel * Sun acc cleanup
786 1.1 kardel *
787 1.1 kardel * Revision 4.5 1998/06/13 12:04:16 kardel
788 1.1 kardel * fix SYSV clock name clash
789 1.1 kardel *
790 1.1 kardel * Revision 4.4 1998/06/12 15:22:28 kardel
791 1.1 kardel * fix prototypes
792 1.1 kardel *
793 1.1 kardel * Revision 4.3 1998/06/06 18:33:36 kardel
794 1.1 kardel * simplified condidional compile expression
795 1.1 kardel *
796 1.1 kardel * Revision 4.2 1998/05/24 11:04:18 kardel
797 1.1 kardel * triggering PPS on negative edge for simpler wiring (Rx->DCD)
798 1.1 kardel *
799 1.1 kardel * Revision 4.1 1998/05/24 09:39:53 kardel
800 1.1 kardel * implementation of the new IO handling model
801 1.1 kardel *
802 1.1 kardel * Revision 4.0 1998/04/10 19:45:30 kardel
803 1.1 kardel * Start 4.0 release version numbering
804 1.1 kardel *
805 1.1 kardel * from V3 3.24 log info deleted 1998/04/11 kardel
806 1.1 kardel *
807 1.1 kardel */
808