1906 lines
45 KiB
C
1906 lines
45 KiB
C
/* $NetBSD: dcfd.c,v 1.4 2007/01/06 19:45:29 kardel Exp $ */
|
|
|
|
/*
|
|
* /src/NTP/REPOSITORY/ntp4-dev/parseutil/dcfd.c,v 4.18 2005/10/07 22:08:18 kardel RELEASE_20051008_A
|
|
*
|
|
* dcfd.c,v 4.18 2005/10/07 22:08:18 kardel RELEASE_20051008_A
|
|
*
|
|
* DCF77 100/200ms pulse synchronisation daemon program (via 50Baud serial line)
|
|
*
|
|
* Features:
|
|
* DCF77 decoding
|
|
* simple NTP loopfilter logic for local clock
|
|
* interactive display for debugging
|
|
*
|
|
* Lacks:
|
|
* Leap second handling (at that level you should switch to NTP Version 4 - really!)
|
|
*
|
|
* Copyright (c) 1995-2005 by Frank Kardel <kardel <AT> ntp.org>
|
|
* Copyright (c) 1989-1994 by Frank Kardel, Friedrich-Alexander Universität Erlangen-Nürnberg, Germany
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. Neither the name of the author nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
# include <config.h>
|
|
#endif
|
|
|
|
#include <sys/ioctl.h>
|
|
#include <unistd.h>
|
|
#include <stdio.h>
|
|
#include <fcntl.h>
|
|
#include <sys/types.h>
|
|
#include <sys/time.h>
|
|
#include <signal.h>
|
|
#include <syslog.h>
|
|
#include <time.h>
|
|
|
|
/*
|
|
* NTP compilation environment
|
|
*/
|
|
#include "ntp_stdlib.h"
|
|
#include "ntpd.h" /* indirectly include ntp.h to get YEAR_PIVOT Y2KFixes */
|
|
|
|
/*
|
|
* select which terminal handling to use (currently only SysV variants)
|
|
*/
|
|
#if defined(HAVE_TERMIOS_H) || defined(STREAM)
|
|
#include <termios.h>
|
|
#define TTY_GETATTR(_FD_, _ARG_) tcgetattr((_FD_), (_ARG_))
|
|
#define TTY_SETATTR(_FD_, _ARG_) tcsetattr((_FD_), TCSANOW, (_ARG_))
|
|
#else /* not HAVE_TERMIOS_H || STREAM */
|
|
# if defined(HAVE_TERMIO_H) || defined(HAVE_SYSV_TTYS)
|
|
# include <termio.h>
|
|
# define TTY_GETATTR(_FD_, _ARG_) ioctl((_FD_), TCGETA, (_ARG_))
|
|
# define TTY_SETATTR(_FD_, _ARG_) ioctl((_FD_), TCSETAW, (_ARG_))
|
|
# endif/* HAVE_TERMIO_H || HAVE_SYSV_TTYS */
|
|
#endif /* not HAVE_TERMIOS_H || STREAM */
|
|
|
|
|
|
#ifndef TTY_GETATTR
|
|
#include "Bletch: MUST DEFINE ONE OF 'HAVE_TERMIOS_H' or 'HAVE_TERMIO_H'"
|
|
#endif
|
|
|
|
#ifndef days_per_year
|
|
#define days_per_year(_x_) (((_x_) % 4) ? 365 : (((_x_) % 400) ? 365 : 366))
|
|
#endif
|
|
|
|
#define timernormalize(_a_) \
|
|
if ((_a_)->tv_usec >= 1000000) \
|
|
{ \
|
|
(_a_)->tv_sec += (_a_)->tv_usec / 1000000; \
|
|
(_a_)->tv_usec = (_a_)->tv_usec % 1000000; \
|
|
} \
|
|
if ((_a_)->tv_usec < 0) \
|
|
{ \
|
|
(_a_)->tv_sec -= 1 + (-(_a_)->tv_usec / 1000000); \
|
|
(_a_)->tv_usec = 999999 - (-(_a_)->tv_usec - 1); \
|
|
}
|
|
|
|
#ifdef timeradd
|
|
#undef timeradd
|
|
#endif
|
|
#define timeradd(_a_, _b_) \
|
|
(_a_)->tv_sec += (_b_)->tv_sec; \
|
|
(_a_)->tv_usec += (_b_)->tv_usec; \
|
|
timernormalize((_a_))
|
|
|
|
#ifdef timersub
|
|
#undef timersub
|
|
#endif
|
|
#define timersub(_a_, _b_) \
|
|
(_a_)->tv_sec -= (_b_)->tv_sec; \
|
|
(_a_)->tv_usec -= (_b_)->tv_usec; \
|
|
timernormalize((_a_))
|
|
|
|
/*
|
|
* debug macros
|
|
*/
|
|
#define PRINTF if (interactive) printf
|
|
#define LPRINTF if (interactive && loop_filter_debug) printf
|
|
|
|
#ifdef DEBUG
|
|
#define dprintf(_x_) LPRINTF _x_
|
|
#else
|
|
#define dprintf(_x_)
|
|
#endif
|
|
|
|
#ifdef DECL_ERRNO
|
|
extern int errno;
|
|
#endif
|
|
|
|
static char *revision = "4.18";
|
|
|
|
/*
|
|
* display received data (avoids also detaching from tty)
|
|
*/
|
|
static int interactive = 0;
|
|
|
|
/*
|
|
* display loopfilter (clock control) variables
|
|
*/
|
|
static int loop_filter_debug = 0;
|
|
|
|
/*
|
|
* do not set/adjust system time
|
|
*/
|
|
static int no_set = 0;
|
|
|
|
/*
|
|
* time that passes between start of DCF impulse and time stamping (fine
|
|
* adjustment) in microseconds (receiver/OS dependent)
|
|
*/
|
|
#define DEFAULT_DELAY 230000 /* rough estimate */
|
|
|
|
/*
|
|
* The two states we can be in - eithe we receive nothing
|
|
* usable or we have the correct time
|
|
*/
|
|
#define NO_SYNC 0x01
|
|
#define SYNC 0x02
|
|
|
|
static int sync_state = NO_SYNC;
|
|
static time_t last_sync;
|
|
|
|
static unsigned long ticks = 0;
|
|
|
|
static char pat[] = "-\\|/";
|
|
|
|
#define LINES (24-2) /* error lines after which the two headlines are repeated */
|
|
|
|
#define MAX_UNSYNC (10*60) /* allow synchronisation loss for 10 minutes */
|
|
#define NOTICE_INTERVAL (20*60) /* mention missing synchronisation every 20 minutes */
|
|
|
|
/*
|
|
* clock adjustment PLL - see NTP protocol spec (RFC1305) for details
|
|
*/
|
|
|
|
#define USECSCALE 10
|
|
#define TIMECONSTANT 2
|
|
#define ADJINTERVAL 0
|
|
#define FREQ_WEIGHT 18
|
|
#define PHASE_WEIGHT 7
|
|
#define MAX_DRIFT 0x3FFFFFFF
|
|
|
|
#define R_SHIFT(_X_, _Y_) (((_X_) < 0) ? -(-(_X_) >> (_Y_)) : ((_X_) >> (_Y_)))
|
|
|
|
static struct timeval max_adj_offset = { 0, 128000 };
|
|
|
|
static long clock_adjust = 0; /* current adjustment value (usec * 2^USECSCALE) */
|
|
static long accum_drift = 0; /* accumulated drift value (usec / ADJINTERVAL) */
|
|
static long adjustments = 0;
|
|
static char skip_adjust = 1; /* discard first adjustment (bad samples) */
|
|
|
|
/*
|
|
* DCF77 state flags
|
|
*/
|
|
#define DCFB_ANNOUNCE 0x0001 /* switch time zone warning (DST switch) */
|
|
#define DCFB_DST 0x0002 /* DST in effect */
|
|
#define DCFB_LEAP 0x0004 /* LEAP warning (1 hour prior to occurrence) */
|
|
#define DCFB_ALTERNATE 0x0008 /* alternate antenna used */
|
|
|
|
struct clocktime /* clock time broken up from time code */
|
|
{
|
|
long wday; /* Day of week: 1: Monday - 7: Sunday */
|
|
long day;
|
|
long month;
|
|
long year;
|
|
long hour;
|
|
long minute;
|
|
long second;
|
|
long usecond;
|
|
long utcoffset; /* in minutes */
|
|
long flags; /* current clock status (DCF77 state flags) */
|
|
};
|
|
|
|
typedef struct clocktime clocktime_t;
|
|
|
|
/*
|
|
* (usually) quick constant multiplications
|
|
*/
|
|
#define TIMES10(_X_) (((_X_) << 3) + ((_X_) << 1)) /* *8 + *2 */
|
|
#define TIMES24(_X_) (((_X_) << 4) + ((_X_) << 3)) /* *16 + *8 */
|
|
#define TIMES60(_X_) ((((_X_) << 4) - (_X_)) << 2) /* *(16 - 1) *4 */
|
|
/*
|
|
* generic l_abs() function
|
|
*/
|
|
#define l_abs(_x_) (((_x_) < 0) ? -(_x_) : (_x_))
|
|
|
|
/*
|
|
* conversion related return/error codes
|
|
*/
|
|
#define CVT_MASK 0x0000000F /* conversion exit code */
|
|
#define CVT_NONE 0x00000001 /* format not applicable */
|
|
#define CVT_FAIL 0x00000002 /* conversion failed - error code returned */
|
|
#define CVT_OK 0x00000004 /* conversion succeeded */
|
|
#define CVT_BADFMT 0x00000010 /* general format error - (unparsable) */
|
|
#define CVT_BADDATE 0x00000020 /* invalid date */
|
|
#define CVT_BADTIME 0x00000040 /* invalid time */
|
|
|
|
/*
|
|
* DCF77 raw time code
|
|
*
|
|
* From "Zur Zeit", Physikalisch-Technische Bundesanstalt (PTB), Braunschweig
|
|
* und Berlin, Maerz 1989
|
|
*
|
|
* Timecode transmission:
|
|
* AM:
|
|
* time marks are send every second except for the second before the
|
|
* next minute mark
|
|
* time marks consist of a reduction of transmitter power to 25%
|
|
* of the nominal level
|
|
* the falling edge is the time indication (on time)
|
|
* time marks of a 100ms duration constitute a logical 0
|
|
* time marks of a 200ms duration constitute a logical 1
|
|
* FM:
|
|
* see the spec. (basically a (non-)inverted psuedo random phase shift)
|
|
*
|
|
* Encoding:
|
|
* Second Contents
|
|
* 0 - 10 AM: free, FM: 0
|
|
* 11 - 14 free
|
|
* 15 R - alternate antenna
|
|
* 16 A1 - expect zone change (1 hour before)
|
|
* 17 - 18 Z1,Z2 - time zone
|
|
* 0 0 illegal
|
|
* 0 1 MEZ (MET)
|
|
* 1 0 MESZ (MED, MET DST)
|
|
* 1 1 illegal
|
|
* 19 A2 - expect leap insertion/deletion (1 hour before)
|
|
* 20 S - start of time code (1)
|
|
* 21 - 24 M1 - BCD (lsb first) Minutes
|
|
* 25 - 27 M10 - BCD (lsb first) 10 Minutes
|
|
* 28 P1 - Minute Parity (even)
|
|
* 29 - 32 H1 - BCD (lsb first) Hours
|
|
* 33 - 34 H10 - BCD (lsb first) 10 Hours
|
|
* 35 P2 - Hour Parity (even)
|
|
* 36 - 39 D1 - BCD (lsb first) Days
|
|
* 40 - 41 D10 - BCD (lsb first) 10 Days
|
|
* 42 - 44 DW - BCD (lsb first) day of week (1: Monday -> 7: Sunday)
|
|
* 45 - 49 MO - BCD (lsb first) Month
|
|
* 50 MO0 - 10 Months
|
|
* 51 - 53 Y1 - BCD (lsb first) Years
|
|
* 54 - 57 Y10 - BCD (lsb first) 10 Years
|
|
* 58 P3 - Date Parity (even)
|
|
* 59 - usually missing (minute indication), except for leap insertion
|
|
*/
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* conversion table to map DCF77 bit stream into data fields.
|
|
* Encoding:
|
|
* Each field of the DCF77 code is described with two adjacent entries in
|
|
* this table. The first entry specifies the offset into the DCF77 data stream
|
|
* while the length is given as the difference between the start index and
|
|
* the start index of the following field.
|
|
*/
|
|
static struct rawdcfcode
|
|
{
|
|
char offset; /* start bit */
|
|
} rawdcfcode[] =
|
|
{
|
|
{ 0 }, { 15 }, { 16 }, { 17 }, { 19 }, { 20 }, { 21 }, { 25 }, { 28 }, { 29 },
|
|
{ 33 }, { 35 }, { 36 }, { 40 }, { 42 }, { 45 }, { 49 }, { 50 }, { 54 }, { 58 }, { 59 }
|
|
};
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* symbolic names for the fields of DCF77 describes in "rawdcfcode".
|
|
* see comment above for the structure of the DCF77 data
|
|
*/
|
|
#define DCF_M 0
|
|
#define DCF_R 1
|
|
#define DCF_A1 2
|
|
#define DCF_Z 3
|
|
#define DCF_A2 4
|
|
#define DCF_S 5
|
|
#define DCF_M1 6
|
|
#define DCF_M10 7
|
|
#define DCF_P1 8
|
|
#define DCF_H1 9
|
|
#define DCF_H10 10
|
|
#define DCF_P2 11
|
|
#define DCF_D1 12
|
|
#define DCF_D10 13
|
|
#define DCF_DW 14
|
|
#define DCF_MO 15
|
|
#define DCF_MO0 16
|
|
#define DCF_Y1 17
|
|
#define DCF_Y10 18
|
|
#define DCF_P3 19
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* parity field table (same encoding as rawdcfcode)
|
|
* This table describes the sections of the DCF77 code that are
|
|
* parity protected
|
|
*/
|
|
static struct partab
|
|
{
|
|
char offset; /* start bit of parity field */
|
|
} partab[] =
|
|
{
|
|
{ 21 }, { 29 }, { 36 }, { 59 }
|
|
};
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* offsets for parity field descriptions
|
|
*/
|
|
#define DCF_P_P1 0
|
|
#define DCF_P_P2 1
|
|
#define DCF_P_P3 2
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* legal values for time zone information
|
|
*/
|
|
#define DCF_Z_MET 0x2
|
|
#define DCF_Z_MED 0x1
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* symbolic representation if the DCF77 data stream
|
|
*/
|
|
static struct dcfparam
|
|
{
|
|
unsigned char onebits[60];
|
|
unsigned char zerobits[60];
|
|
} dcfparam =
|
|
{
|
|
"###############RADMLS1248124P124812P1248121241248112481248P", /* 'ONE' representation */
|
|
"--------------------s-------p------p----------------------p" /* 'ZERO' representation */
|
|
};
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* extract a bitfield from DCF77 datastream
|
|
* All numeric fields are LSB first.
|
|
* buf holds a pointer to a DCF77 data buffer in symbolic
|
|
* representation
|
|
* idx holds the index to the field description in rawdcfcode
|
|
*/
|
|
static unsigned long
|
|
ext_bf(
|
|
register unsigned char *buf,
|
|
register int idx
|
|
)
|
|
{
|
|
register unsigned long sum = 0;
|
|
register int i, first;
|
|
|
|
first = rawdcfcode[idx].offset;
|
|
|
|
for (i = rawdcfcode[idx+1].offset - 1; i >= first; i--)
|
|
{
|
|
sum <<= 1;
|
|
sum |= (buf[i] != dcfparam.zerobits[i]);
|
|
}
|
|
return sum;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* check even parity integrity for a bitfield
|
|
*
|
|
* buf holds a pointer to a DCF77 data buffer in symbolic
|
|
* representation
|
|
* idx holds the index to the field description in partab
|
|
*/
|
|
static unsigned
|
|
pcheck(
|
|
register unsigned char *buf,
|
|
register int idx
|
|
)
|
|
{
|
|
register int i,last;
|
|
register unsigned psum = 1;
|
|
|
|
last = partab[idx+1].offset;
|
|
|
|
for (i = partab[idx].offset; i < last; i++)
|
|
psum ^= (buf[i] != dcfparam.zerobits[i]);
|
|
|
|
return psum;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* convert a DCF77 data buffer into wall clock time + flags
|
|
*
|
|
* buffer holds a pointer to a DCF77 data buffer in symbolic
|
|
* representation
|
|
* size describes the length of DCF77 information in bits (represented
|
|
* as chars in symbolic notation
|
|
* clock points to a wall clock time description of the DCF77 data (result)
|
|
*/
|
|
static unsigned long
|
|
convert_rawdcf(
|
|
unsigned char *buffer,
|
|
int size,
|
|
clocktime_t *clock_time
|
|
)
|
|
{
|
|
if (size < 57)
|
|
{
|
|
PRINTF("%-30s", "*** INCOMPLETE");
|
|
return CVT_NONE;
|
|
}
|
|
|
|
/*
|
|
* check Start and Parity bits
|
|
*/
|
|
if ((ext_bf(buffer, DCF_S) == 1) &&
|
|
pcheck(buffer, DCF_P_P1) &&
|
|
pcheck(buffer, DCF_P_P2) &&
|
|
pcheck(buffer, DCF_P_P3))
|
|
{
|
|
/*
|
|
* buffer OK - extract all fields and build wall clock time from them
|
|
*/
|
|
|
|
clock_time->flags = 0;
|
|
clock_time->usecond= 0;
|
|
clock_time->second = 0;
|
|
clock_time->minute = ext_bf(buffer, DCF_M10);
|
|
clock_time->minute = TIMES10(clock_time->minute) + ext_bf(buffer, DCF_M1);
|
|
clock_time->hour = ext_bf(buffer, DCF_H10);
|
|
clock_time->hour = TIMES10(clock_time->hour) + ext_bf(buffer, DCF_H1);
|
|
clock_time->day = ext_bf(buffer, DCF_D10);
|
|
clock_time->day = TIMES10(clock_time->day) + ext_bf(buffer, DCF_D1);
|
|
clock_time->month = ext_bf(buffer, DCF_MO0);
|
|
clock_time->month = TIMES10(clock_time->month) + ext_bf(buffer, DCF_MO);
|
|
clock_time->year = ext_bf(buffer, DCF_Y10);
|
|
clock_time->year = TIMES10(clock_time->year) + ext_bf(buffer, DCF_Y1);
|
|
clock_time->wday = ext_bf(buffer, DCF_DW);
|
|
|
|
/*
|
|
* determine offset to UTC by examining the time zone
|
|
*/
|
|
switch (ext_bf(buffer, DCF_Z))
|
|
{
|
|
case DCF_Z_MET:
|
|
clock_time->utcoffset = -60;
|
|
break;
|
|
|
|
case DCF_Z_MED:
|
|
clock_time->flags |= DCFB_DST;
|
|
clock_time->utcoffset = -120;
|
|
break;
|
|
|
|
default:
|
|
PRINTF("%-30s", "*** BAD TIME ZONE");
|
|
return CVT_FAIL|CVT_BADFMT;
|
|
}
|
|
|
|
/*
|
|
* extract various warnings from DCF77
|
|
*/
|
|
if (ext_bf(buffer, DCF_A1))
|
|
clock_time->flags |= DCFB_ANNOUNCE;
|
|
|
|
if (ext_bf(buffer, DCF_A2))
|
|
clock_time->flags |= DCFB_LEAP;
|
|
|
|
if (ext_bf(buffer, DCF_R))
|
|
clock_time->flags |= DCFB_ALTERNATE;
|
|
|
|
return CVT_OK;
|
|
}
|
|
else
|
|
{
|
|
/*
|
|
* bad format - not for us
|
|
*/
|
|
PRINTF("%-30s", "*** BAD FORMAT (invalid/parity)");
|
|
return CVT_FAIL|CVT_BADFMT;
|
|
}
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* raw dcf input routine - fix up 50 baud
|
|
* characters for 1/0 decision
|
|
*/
|
|
static unsigned long
|
|
cvt_rawdcf(
|
|
unsigned char *buffer,
|
|
int size,
|
|
clocktime_t *clock_time
|
|
)
|
|
{
|
|
register unsigned char *s = buffer;
|
|
register unsigned char *e = buffer + size;
|
|
register unsigned char *b = dcfparam.onebits;
|
|
register unsigned char *c = dcfparam.zerobits;
|
|
register unsigned rtc = CVT_NONE;
|
|
register unsigned int i, lowmax, highmax, cutoff, span;
|
|
#define BITS 9
|
|
unsigned char histbuf[BITS];
|
|
/*
|
|
* the input buffer contains characters with runs of consecutive
|
|
* bits set. These set bits are an indication of the DCF77 pulse
|
|
* length. We assume that we receive the pulse at 50 Baud. Thus
|
|
* a 100ms pulse would generate a 4 bit train (20ms per bit and
|
|
* start bit)
|
|
* a 200ms pulse would create all zeroes (and probably a frame error)
|
|
*
|
|
* The basic idea is that on corret reception we must have two
|
|
* maxima in the pulse length distribution histogram. (one for
|
|
* the zero representing pulses and one for the one representing
|
|
* pulses)
|
|
* There will always be ones in the datastream, thus we have to see
|
|
* two maxima.
|
|
* The best point to cut for a 1/0 decision is the minimum between those
|
|
* between the maxima. The following code tries to find this cutoff point.
|
|
*/
|
|
|
|
/*
|
|
* clear histogram buffer
|
|
*/
|
|
for (i = 0; i < BITS; i++)
|
|
{
|
|
histbuf[i] = 0;
|
|
}
|
|
|
|
cutoff = 0;
|
|
lowmax = 0;
|
|
|
|
/*
|
|
* convert sequences of set bits into bits counts updating
|
|
* the histogram alongway
|
|
*/
|
|
while (s < e)
|
|
{
|
|
register unsigned int ch = *s ^ 0xFF;
|
|
/*
|
|
* check integrity and update histogramm
|
|
*/
|
|
if (!((ch+1) & ch) || !*s)
|
|
{
|
|
/*
|
|
* character ok
|
|
*/
|
|
for (i = 0; ch; i++)
|
|
{
|
|
ch >>= 1;
|
|
}
|
|
|
|
*s = i;
|
|
histbuf[i]++;
|
|
cutoff += i;
|
|
lowmax++;
|
|
}
|
|
else
|
|
{
|
|
/*
|
|
* invalid character (no consecutive bit sequence)
|
|
*/
|
|
dprintf(("parse: cvt_rawdcf: character check for 0x%x@%d FAILED\n", *s, s - buffer));
|
|
*s = (unsigned char)~0;
|
|
rtc = CVT_FAIL|CVT_BADFMT;
|
|
}
|
|
s++;
|
|
}
|
|
|
|
/*
|
|
* first cutoff estimate (average bit count - must be between both
|
|
* maxima)
|
|
*/
|
|
if (lowmax)
|
|
{
|
|
cutoff /= lowmax;
|
|
}
|
|
else
|
|
{
|
|
cutoff = 4; /* doesn't really matter - it'll fail anyway, but gives error output */
|
|
}
|
|
|
|
dprintf(("parse: cvt_rawdcf: average bit count: %d\n", cutoff));
|
|
|
|
lowmax = 0; /* weighted sum */
|
|
highmax = 0; /* bitcount */
|
|
|
|
/*
|
|
* collect weighted sum of lower bits (left of initial guess)
|
|
*/
|
|
dprintf(("parse: cvt_rawdcf: histogram:"));
|
|
for (i = 0; i <= cutoff; i++)
|
|
{
|
|
lowmax += histbuf[i] * i;
|
|
highmax += histbuf[i];
|
|
dprintf((" %d", histbuf[i]));
|
|
}
|
|
dprintf((" <M>"));
|
|
|
|
/*
|
|
* round up
|
|
*/
|
|
lowmax += highmax / 2;
|
|
|
|
/*
|
|
* calculate lower bit maximum (weighted sum / bit count)
|
|
*
|
|
* avoid divide by zero
|
|
*/
|
|
if (highmax)
|
|
{
|
|
lowmax /= highmax;
|
|
}
|
|
else
|
|
{
|
|
lowmax = 0;
|
|
}
|
|
|
|
highmax = 0; /* weighted sum of upper bits counts */
|
|
cutoff = 0; /* bitcount */
|
|
|
|
/*
|
|
* collect weighted sum of lower bits (right of initial guess)
|
|
*/
|
|
for (; i < BITS; i++)
|
|
{
|
|
highmax+=histbuf[i] * i;
|
|
cutoff +=histbuf[i];
|
|
dprintf((" %d", histbuf[i]));
|
|
}
|
|
dprintf(("\n"));
|
|
|
|
/*
|
|
* determine upper maximum (weighted sum / bit count)
|
|
*/
|
|
if (cutoff)
|
|
{
|
|
highmax /= cutoff;
|
|
}
|
|
else
|
|
{
|
|
highmax = BITS-1;
|
|
}
|
|
|
|
/*
|
|
* following now holds:
|
|
* lowmax <= cutoff(initial guess) <= highmax
|
|
* best cutoff is the minimum nearest to higher bits
|
|
*/
|
|
|
|
/*
|
|
* find the minimum between lowmax and highmax (detecting
|
|
* possibly a minimum span)
|
|
*/
|
|
span = cutoff = lowmax;
|
|
for (i = lowmax; i <= highmax; i++)
|
|
{
|
|
if (histbuf[cutoff] > histbuf[i])
|
|
{
|
|
/*
|
|
* got a new minimum move beginning of minimum (cutoff) and
|
|
* end of minimum (span) there
|
|
*/
|
|
cutoff = span = i;
|
|
}
|
|
else
|
|
if (histbuf[cutoff] == histbuf[i])
|
|
{
|
|
/*
|
|
* minimum not better yet - but it spans more than
|
|
* one bit value - follow it
|
|
*/
|
|
span = i;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* cutoff point for 1/0 decision is the middle of the minimum section
|
|
* in the histogram
|
|
*/
|
|
cutoff = (cutoff + span) / 2;
|
|
|
|
dprintf(("parse: cvt_rawdcf: lower maximum %d, higher maximum %d, cutoff %d\n", lowmax, highmax, cutoff));
|
|
|
|
/*
|
|
* convert the bit counts to symbolic 1/0 information for data conversion
|
|
*/
|
|
s = buffer;
|
|
while ((s < e) && *c && *b)
|
|
{
|
|
if (*s == (unsigned char)~0)
|
|
{
|
|
/*
|
|
* invalid character
|
|
*/
|
|
*s = '?';
|
|
}
|
|
else
|
|
{
|
|
/*
|
|
* symbolic 1/0 representation
|
|
*/
|
|
*s = (*s >= cutoff) ? *b : *c;
|
|
}
|
|
s++;
|
|
b++;
|
|
c++;
|
|
}
|
|
|
|
/*
|
|
* if everything went well so far return the result of the symbolic
|
|
* conversion routine else just the accumulated errors
|
|
*/
|
|
if (rtc != CVT_NONE)
|
|
{
|
|
PRINTF("%-30s", "*** BAD DATA");
|
|
}
|
|
|
|
return (rtc == CVT_NONE) ? convert_rawdcf(buffer, size, clock_time) : rtc;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* convert a wall clock time description of DCF77 to a Unix time (seconds
|
|
* since 1.1. 1970 UTC)
|
|
*/
|
|
static time_t
|
|
dcf_to_unixtime(
|
|
clocktime_t *clock_time,
|
|
unsigned *cvtrtc
|
|
)
|
|
{
|
|
#define SETRTC(_X_) { if (cvtrtc) *cvtrtc = (_X_); }
|
|
static int days_of_month[] =
|
|
{
|
|
0, 31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31
|
|
};
|
|
register int i;
|
|
time_t t;
|
|
|
|
/*
|
|
* map 2 digit years to 19xx (DCF77 is a 20th century item)
|
|
*/
|
|
if ( clock_time->year < YEAR_PIVOT ) /* in case of Y2KFixes [ */
|
|
clock_time->year += 100; /* *year%100, make tm_year */
|
|
/* *(do we need this?) */
|
|
if ( clock_time->year < YEAR_BREAK ) /* (failsafe if) */
|
|
clock_time->year += 1900; /* Y2KFixes ] */
|
|
|
|
/*
|
|
* must have been a really bad year code - drop it
|
|
*/
|
|
if (clock_time->year < (YEAR_PIVOT + 1900) ) /* Y2KFixes */
|
|
{
|
|
SETRTC(CVT_FAIL|CVT_BADDATE);
|
|
return -1;
|
|
}
|
|
/*
|
|
* sorry, slow section here - but it's not time critical anyway
|
|
*/
|
|
|
|
/*
|
|
* calculate days since 1970 (watching leap years)
|
|
*/
|
|
t = julian0( clock_time->year ) - julian0( 1970 );
|
|
|
|
/* month */
|
|
if (clock_time->month <= 0 || clock_time->month > 12)
|
|
{
|
|
SETRTC(CVT_FAIL|CVT_BADDATE);
|
|
return -1; /* bad month */
|
|
}
|
|
/* adjust current leap year */
|
|
#if 0
|
|
if (clock_time->month < 3 && days_per_year(clock_time->year) == 366)
|
|
t--;
|
|
#endif
|
|
|
|
/*
|
|
* collect days from months excluding the current one
|
|
*/
|
|
for (i = 1; i < clock_time->month; i++)
|
|
{
|
|
t += days_of_month[i];
|
|
}
|
|
/* day */
|
|
if (clock_time->day < 1 || ((clock_time->month == 2 && days_per_year(clock_time->year) == 366) ?
|
|
clock_time->day > 29 : clock_time->day > days_of_month[clock_time->month]))
|
|
{
|
|
SETRTC(CVT_FAIL|CVT_BADDATE);
|
|
return -1; /* bad day */
|
|
}
|
|
|
|
/*
|
|
* collect days from date excluding the current one
|
|
*/
|
|
t += clock_time->day - 1;
|
|
|
|
/* hour */
|
|
if (clock_time->hour < 0 || clock_time->hour >= 24)
|
|
{
|
|
SETRTC(CVT_FAIL|CVT_BADTIME);
|
|
return -1; /* bad hour */
|
|
}
|
|
|
|
/*
|
|
* calculate hours from 1. 1. 1970
|
|
*/
|
|
t = TIMES24(t) + clock_time->hour;
|
|
|
|
/* min */
|
|
if (clock_time->minute < 0 || clock_time->minute > 59)
|
|
{
|
|
SETRTC(CVT_FAIL|CVT_BADTIME);
|
|
return -1; /* bad min */
|
|
}
|
|
|
|
/*
|
|
* calculate minutes from 1. 1. 1970
|
|
*/
|
|
t = TIMES60(t) + clock_time->minute;
|
|
/* sec */
|
|
|
|
/*
|
|
* calculate UTC in minutes
|
|
*/
|
|
t += clock_time->utcoffset;
|
|
|
|
if (clock_time->second < 0 || clock_time->second > 60) /* allow for LEAPs */
|
|
{
|
|
SETRTC(CVT_FAIL|CVT_BADTIME);
|
|
return -1; /* bad sec */
|
|
}
|
|
|
|
/*
|
|
* calculate UTC in seconds - phew !
|
|
*/
|
|
t = TIMES60(t) + clock_time->second;
|
|
/* done */
|
|
return t;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* cheap half baked 1/0 decision - for interactive operation only
|
|
*/
|
|
static char
|
|
type(
|
|
unsigned int c
|
|
)
|
|
{
|
|
c ^= 0xFF;
|
|
return (c > 0xF);
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* week day representation
|
|
*/
|
|
static const char *wday[8] =
|
|
{
|
|
"??",
|
|
"Mo",
|
|
"Tu",
|
|
"We",
|
|
"Th",
|
|
"Fr",
|
|
"Sa",
|
|
"Su"
|
|
};
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* generate a string representation for a timeval
|
|
*/
|
|
static char *
|
|
pr_timeval(
|
|
struct timeval *val
|
|
)
|
|
{
|
|
static char buf[20];
|
|
|
|
if (val->tv_sec == 0)
|
|
sprintf(buf, "%c0.%06ld", (val->tv_usec < 0) ? '-' : '+', (long int)l_abs(val->tv_usec));
|
|
else
|
|
sprintf(buf, "%ld.%06ld", (long int)val->tv_sec, (long int)l_abs(val->tv_usec));
|
|
return buf;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* correct the current time by an offset by setting the time rigorously
|
|
*/
|
|
static void
|
|
set_time(
|
|
struct timeval *offset
|
|
)
|
|
{
|
|
struct timeval the_time;
|
|
|
|
if (no_set)
|
|
return;
|
|
|
|
LPRINTF("set_time: %s ", pr_timeval(offset));
|
|
syslog(LOG_NOTICE, "setting time (offset %s)", pr_timeval(offset));
|
|
|
|
if (gettimeofday(&the_time, 0L) == -1)
|
|
{
|
|
perror("gettimeofday()");
|
|
}
|
|
else
|
|
{
|
|
timeradd(&the_time, offset);
|
|
if (settimeofday(&the_time, 0L) == -1)
|
|
{
|
|
perror("settimeofday()");
|
|
}
|
|
}
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* slew the time by a given offset
|
|
*/
|
|
static void
|
|
adj_time(
|
|
long offset
|
|
)
|
|
{
|
|
struct timeval time_offset;
|
|
|
|
if (no_set)
|
|
return;
|
|
|
|
time_offset.tv_sec = offset / 1000000;
|
|
time_offset.tv_usec = offset % 1000000;
|
|
|
|
LPRINTF("adj_time: %ld us ", (long int)offset);
|
|
if (adjtime(&time_offset, 0L) == -1)
|
|
perror("adjtime()");
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* read in a possibly previously written drift value
|
|
*/
|
|
static void
|
|
read_drift(
|
|
const char *drift_file
|
|
)
|
|
{
|
|
FILE *df;
|
|
|
|
df = fopen(drift_file, "r");
|
|
if (df != NULL)
|
|
{
|
|
int idrift = 0, fdrift = 0;
|
|
|
|
fscanf(df, "%4d.%03d", &idrift, &fdrift);
|
|
fclose(df);
|
|
LPRINTF("read_drift: %d.%03d ppm ", idrift, fdrift);
|
|
|
|
accum_drift = idrift << USECSCALE;
|
|
fdrift = (fdrift << USECSCALE) / 1000;
|
|
accum_drift += fdrift & (1<<USECSCALE);
|
|
LPRINTF("read_drift: drift_comp %ld ", (long int)accum_drift);
|
|
}
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* write out the current drift value
|
|
*/
|
|
static void
|
|
update_drift(
|
|
const char *drift_file,
|
|
long offset,
|
|
time_t reftime
|
|
)
|
|
{
|
|
FILE *df;
|
|
|
|
df = fopen(drift_file, "w");
|
|
if (df != NULL)
|
|
{
|
|
int idrift = R_SHIFT(accum_drift, USECSCALE);
|
|
int fdrift = accum_drift & ((1<<USECSCALE)-1);
|
|
|
|
LPRINTF("update_drift: drift_comp %ld ", (long int)accum_drift);
|
|
fdrift = (fdrift * 1000) / (1<<USECSCALE);
|
|
fprintf(df, "%4d.%03d %c%ld.%06ld %.24s\n", idrift, fdrift,
|
|
(offset < 0) ? '-' : '+', (long int)(l_abs(offset) / 1000000),
|
|
(long int)(l_abs(offset) % 1000000), asctime(localtime(&reftime)));
|
|
fclose(df);
|
|
LPRINTF("update_drift: %d.%03d ppm ", idrift, fdrift);
|
|
}
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* process adjustments derived from the DCF77 observation
|
|
* (controls clock PLL)
|
|
*/
|
|
static void
|
|
adjust_clock(
|
|
struct timeval *offset,
|
|
const char *drift_file,
|
|
time_t reftime
|
|
)
|
|
{
|
|
struct timeval toffset;
|
|
register long usecoffset;
|
|
int tmp;
|
|
|
|
if (no_set)
|
|
return;
|
|
|
|
if (skip_adjust)
|
|
{
|
|
skip_adjust = 0;
|
|
return;
|
|
}
|
|
|
|
toffset = *offset;
|
|
toffset.tv_sec = l_abs(toffset.tv_sec);
|
|
toffset.tv_usec = l_abs(toffset.tv_usec);
|
|
if (timercmp(&toffset, &max_adj_offset, >))
|
|
{
|
|
/*
|
|
* hopeless - set the clock - and clear the timing
|
|
*/
|
|
set_time(offset);
|
|
clock_adjust = 0;
|
|
skip_adjust = 1;
|
|
return;
|
|
}
|
|
|
|
usecoffset = offset->tv_sec * 1000000 + offset->tv_usec;
|
|
|
|
clock_adjust = R_SHIFT(usecoffset, TIMECONSTANT); /* adjustment to make for next period */
|
|
|
|
tmp = 0;
|
|
while (adjustments > (1 << tmp))
|
|
tmp++;
|
|
adjustments = 0;
|
|
if (tmp > FREQ_WEIGHT)
|
|
tmp = FREQ_WEIGHT;
|
|
|
|
accum_drift += R_SHIFT(usecoffset << USECSCALE, TIMECONSTANT+TIMECONSTANT+FREQ_WEIGHT-tmp);
|
|
|
|
if (accum_drift > MAX_DRIFT) /* clamp into interval */
|
|
accum_drift = MAX_DRIFT;
|
|
else
|
|
if (accum_drift < -MAX_DRIFT)
|
|
accum_drift = -MAX_DRIFT;
|
|
|
|
update_drift(drift_file, usecoffset, reftime);
|
|
LPRINTF("clock_adjust: %s, clock_adjust %ld, drift_comp %ld(%ld) ",
|
|
pr_timeval(offset),(long int) R_SHIFT(clock_adjust, USECSCALE),
|
|
(long int)R_SHIFT(accum_drift, USECSCALE), (long int)accum_drift);
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* adjust the clock by a small mount to simulate frequency correction
|
|
*/
|
|
static void
|
|
periodic_adjust(
|
|
void
|
|
)
|
|
{
|
|
register long adjustment;
|
|
|
|
adjustments++;
|
|
|
|
adjustment = R_SHIFT(clock_adjust, PHASE_WEIGHT);
|
|
|
|
clock_adjust -= adjustment;
|
|
|
|
adjustment += R_SHIFT(accum_drift, USECSCALE+ADJINTERVAL);
|
|
|
|
adj_time(adjustment);
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* control synchronisation status (warnings) and do periodic adjusts
|
|
* (frequency control simulation)
|
|
*/
|
|
static void
|
|
tick(
|
|
int signum
|
|
)
|
|
{
|
|
static unsigned long last_notice = 0;
|
|
|
|
#if !defined(HAVE_SIGACTION) && !defined(HAVE_SIGVEC)
|
|
(void)signal(SIGALRM, tick);
|
|
#endif
|
|
|
|
periodic_adjust();
|
|
|
|
ticks += 1<<ADJINTERVAL;
|
|
|
|
if ((ticks - last_sync) > MAX_UNSYNC)
|
|
{
|
|
/*
|
|
* not getting time for a while
|
|
*/
|
|
if (sync_state == SYNC)
|
|
{
|
|
/*
|
|
* completely lost information
|
|
*/
|
|
sync_state = NO_SYNC;
|
|
syslog(LOG_INFO, "DCF77 reception lost (timeout)");
|
|
last_notice = ticks;
|
|
}
|
|
else
|
|
/*
|
|
* in NO_SYNC state - look whether its time to speak up again
|
|
*/
|
|
if ((ticks - last_notice) > NOTICE_INTERVAL)
|
|
{
|
|
syslog(LOG_NOTICE, "still not synchronized to DCF77 - check receiver/signal");
|
|
last_notice = ticks;
|
|
}
|
|
}
|
|
|
|
#ifndef ITIMER_REAL
|
|
(void) alarm(1<<ADJINTERVAL);
|
|
#endif
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* break association from terminal to avoid catching terminal
|
|
* or process group related signals (-> daemon operation)
|
|
*/
|
|
static void
|
|
detach(
|
|
void
|
|
)
|
|
{
|
|
# ifdef HAVE_DAEMON
|
|
daemon(0, 0);
|
|
# else /* not HAVE_DAEMON */
|
|
if (fork())
|
|
exit(0);
|
|
|
|
{
|
|
u_long s;
|
|
int max_fd;
|
|
|
|
#if defined(HAVE_SYSCONF) && defined(_SC_OPEN_MAX)
|
|
max_fd = sysconf(_SC_OPEN_MAX);
|
|
#else /* HAVE_SYSCONF && _SC_OPEN_MAX */
|
|
max_fd = getdtablesize();
|
|
#endif /* HAVE_SYSCONF && _SC_OPEN_MAX */
|
|
for (s = 0; s < max_fd; s++)
|
|
(void) close((int)s);
|
|
(void) open("/", 0);
|
|
(void) dup2(0, 1);
|
|
(void) dup2(0, 2);
|
|
#ifdef SYS_DOMAINOS
|
|
{
|
|
uid_$t puid;
|
|
status_$t st;
|
|
|
|
proc2_$who_am_i(&puid);
|
|
proc2_$make_server(&puid, &st);
|
|
}
|
|
#endif /* SYS_DOMAINOS */
|
|
#if defined(HAVE_SETPGID) || defined(HAVE_SETSID)
|
|
# ifdef HAVE_SETSID
|
|
if (setsid() == (pid_t)-1)
|
|
syslog(LOG_ERR, "dcfd: setsid(): %m");
|
|
# else
|
|
if (setpgid(0, 0) == -1)
|
|
syslog(LOG_ERR, "dcfd: setpgid(): %m");
|
|
# endif
|
|
#else /* HAVE_SETPGID || HAVE_SETSID */
|
|
{
|
|
int fid;
|
|
|
|
fid = open("/dev/tty", 2);
|
|
if (fid >= 0)
|
|
{
|
|
(void) ioctl(fid, (u_long) TIOCNOTTY, (char *) 0);
|
|
(void) close(fid);
|
|
}
|
|
# ifdef HAVE_SETPGRP_0
|
|
(void) setpgrp();
|
|
# else /* HAVE_SETPGRP_0 */
|
|
(void) setpgrp(0, getpid());
|
|
# endif /* HAVE_SETPGRP_0 */
|
|
}
|
|
#endif /* HAVE_SETPGID || HAVE_SETSID */
|
|
}
|
|
#endif /* not HAVE_DAEMON */
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* list possible arguments and options
|
|
*/
|
|
static void
|
|
usage(
|
|
char *program
|
|
)
|
|
{
|
|
fprintf(stderr, "usage: %s [-n] [-f] [-l] [-t] [-i] [-o] [-d <drift_file>] [-D <input delay>] <device>\n", program);
|
|
fprintf(stderr, "\t-n do not change time\n");
|
|
fprintf(stderr, "\t-i interactive\n");
|
|
fprintf(stderr, "\t-t trace (print all datagrams)\n");
|
|
fprintf(stderr, "\t-f print all databits (includes PTB private data)\n");
|
|
fprintf(stderr, "\t-l print loop filter debug information\n");
|
|
fprintf(stderr, "\t-o print offet average for current minute\n");
|
|
fprintf(stderr, "\t-Y make internal Y2K checks then exit\n"); /* Y2KFixes */
|
|
fprintf(stderr, "\t-d <drift_file> specify alternate drift file\n");
|
|
fprintf(stderr, "\t-D <input delay>specify delay from input edge to processing in micro seconds\n");
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* check_y2k() - internal check of Y2K logic
|
|
* (a lot of this logic lifted from ../ntpd/check_y2k.c)
|
|
*/
|
|
static int
|
|
check_y2k( void )
|
|
{
|
|
int year; /* current working year */
|
|
int year0 = 1900; /* sarting year for NTP time */
|
|
int yearend; /* ending year we test for NTP time.
|
|
* 32-bit systems: through 2036, the
|
|
**year in which NTP time overflows.
|
|
* 64-bit systems: a reasonable upper
|
|
**limit (well, maybe somewhat beyond
|
|
**reasonable, but well before the
|
|
**max time, by which time the earth
|
|
**will be dead.) */
|
|
time_t Time;
|
|
struct tm LocalTime;
|
|
|
|
int Fatals, Warnings;
|
|
#define Error(year) if ( (year)>=2036 && LocalTime.tm_year < 110 ) \
|
|
Warnings++; else Fatals++
|
|
|
|
Fatals = Warnings = 0;
|
|
|
|
Time = time( (time_t *)NULL );
|
|
LocalTime = *localtime( &Time );
|
|
|
|
year = ( sizeof( u_long ) > 4 ) /* save max span using year as temp */
|
|
? ( 400 * 3 ) /* three greater gregorian cycles */
|
|
: ((int)(0x7FFFFFFF / 365.242 / 24/60/60)* 2 ); /*32-bit limit*/
|
|
/* NOTE: will automacially expand test years on
|
|
* 64 bit machines.... this may cause some of the
|
|
* existing ntp logic to fail for years beyond
|
|
* 2036 (the current 32-bit limit). If all checks
|
|
* fail ONLY beyond year 2036 you may ignore such
|
|
* errors, at least for a decade or so. */
|
|
yearend = year0 + year;
|
|
|
|
year = 1900+YEAR_PIVOT;
|
|
printf( " starting year %04d\n", (int) year );
|
|
printf( " ending year %04d\n", (int) yearend );
|
|
|
|
for ( ; year < yearend; year++ )
|
|
{
|
|
clocktime_t ct;
|
|
time_t Observed;
|
|
time_t Expected;
|
|
unsigned Flag;
|
|
unsigned long t;
|
|
|
|
ct.day = 1;
|
|
ct.month = 1;
|
|
ct.year = year;
|
|
ct.hour = ct.minute = ct.second = ct.usecond = 0;
|
|
ct.utcoffset = 0;
|
|
ct.flags = 0;
|
|
|
|
Flag = 0;
|
|
Observed = dcf_to_unixtime( &ct, &Flag );
|
|
/* seems to be a clone of parse_to_unixtime() with
|
|
* *a minor difference to arg2 type */
|
|
if ( ct.year != year )
|
|
{
|
|
fprintf( stdout,
|
|
"%04d: dcf_to_unixtime(,%d) CORRUPTED ct.year: was %d\n",
|
|
(int)year, (int)Flag, (int)ct.year );
|
|
Error(year);
|
|
break;
|
|
}
|
|
t = julian0(year) - julian0(1970); /* Julian day from 1970 */
|
|
Expected = t * 24 * 60 * 60;
|
|
if ( Observed != Expected || Flag )
|
|
{ /* time difference */
|
|
fprintf( stdout,
|
|
"%04d: dcf_to_unixtime(,%d) FAILURE: was=%lu s/b=%lu (%ld)\n",
|
|
year, (int)Flag,
|
|
(unsigned long)Observed, (unsigned long)Expected,
|
|
((long)Observed - (long)Expected) );
|
|
Error(year);
|
|
break;
|
|
}
|
|
|
|
if ( year >= YEAR_PIVOT+1900 )
|
|
{
|
|
/* check year % 100 code we put into dcf_to_unixtime() */
|
|
ct.year = year % 100;
|
|
Flag = 0;
|
|
|
|
Observed = dcf_to_unixtime( &ct, &Flag );
|
|
|
|
if ( Observed != Expected || Flag )
|
|
{ /* time difference */
|
|
fprintf( stdout,
|
|
"%04d: dcf_to_unixtime(%d,%d) FAILURE: was=%lu s/b=%lu (%ld)\n",
|
|
year, (int)ct.year, (int)Flag,
|
|
(unsigned long)Observed, (unsigned long)Expected,
|
|
((long)Observed - (long)Expected) );
|
|
Error(year);
|
|
break;
|
|
}
|
|
|
|
/* check year - 1900 code we put into dcf_to_unixtime() */
|
|
ct.year = year - 1900;
|
|
Flag = 0;
|
|
|
|
Observed = dcf_to_unixtime( &ct, &Flag );
|
|
|
|
if ( Observed != Expected || Flag ) { /* time difference */
|
|
fprintf( stdout,
|
|
"%04d: dcf_to_unixtime(%d,%d) FAILURE: was=%lu s/b=%lu (%ld)\n",
|
|
year, (int)ct.year, (int)Flag,
|
|
(unsigned long)Observed, (unsigned long)Expected,
|
|
((long)Observed - (long)Expected) );
|
|
Error(year);
|
|
break;
|
|
}
|
|
|
|
|
|
}
|
|
}
|
|
|
|
return ( Fatals );
|
|
}
|
|
|
|
/*--------------------------------------------------
|
|
* rawdcf_init - set up modem lines for RAWDCF receivers
|
|
*/
|
|
#if defined(TIOCMSET) && (defined(TIOCM_DTR) || defined(CIOCM_DTR))
|
|
static void
|
|
rawdcf_init(
|
|
int fd
|
|
)
|
|
{
|
|
/*
|
|
* You can use the RS232 to supply the power for a DCF77 receiver.
|
|
* Here a voltage between the DTR and the RTS line is used. Unfortunately
|
|
* the name has changed from CIOCM_DTR to TIOCM_DTR recently.
|
|
*/
|
|
|
|
#ifdef TIOCM_DTR
|
|
int sl232 = TIOCM_DTR; /* turn on DTR for power supply */
|
|
#else
|
|
int sl232 = CIOCM_DTR; /* turn on DTR for power supply */
|
|
#endif
|
|
|
|
if (ioctl(fd, TIOCMSET, (caddr_t)&sl232) == -1)
|
|
{
|
|
syslog(LOG_NOTICE, "rawdcf_init: WARNING: ioctl(fd, TIOCMSET, [C|T]IOCM_DTR): %m");
|
|
}
|
|
}
|
|
#else
|
|
static void
|
|
rawdcf_init(
|
|
int fd
|
|
)
|
|
{
|
|
syslog(LOG_NOTICE, "rawdcf_init: WARNING: OS interface incapable of setting DTR to power DCF modules");
|
|
}
|
|
#endif /* DTR initialisation type */
|
|
|
|
/*-----------------------------------------------------------------------
|
|
* main loop - argument interpreter / setup / main loop
|
|
*/
|
|
int
|
|
main(
|
|
int argc,
|
|
char **argv
|
|
)
|
|
{
|
|
unsigned char c;
|
|
char **a = argv;
|
|
int ac = argc;
|
|
char *file = NULL;
|
|
const char *drift_file = "/etc/dcfd.drift";
|
|
int fd;
|
|
int offset = 15;
|
|
int offsets = 0;
|
|
int delay = DEFAULT_DELAY; /* average delay from input edge to time stamping */
|
|
int trace = 0;
|
|
int errs = 0;
|
|
|
|
/*
|
|
* process arguments
|
|
*/
|
|
while (--ac)
|
|
{
|
|
char *arg = *++a;
|
|
if (*arg == '-')
|
|
while ((c = *++arg))
|
|
switch (c)
|
|
{
|
|
case 't':
|
|
trace = 1;
|
|
interactive = 1;
|
|
break;
|
|
|
|
case 'f':
|
|
offset = 0;
|
|
interactive = 1;
|
|
break;
|
|
|
|
case 'l':
|
|
loop_filter_debug = 1;
|
|
offsets = 1;
|
|
interactive = 1;
|
|
break;
|
|
|
|
case 'n':
|
|
no_set = 1;
|
|
break;
|
|
|
|
case 'o':
|
|
offsets = 1;
|
|
interactive = 1;
|
|
break;
|
|
|
|
case 'i':
|
|
interactive = 1;
|
|
break;
|
|
|
|
case 'D':
|
|
if (ac > 1)
|
|
{
|
|
delay = atoi(*++a);
|
|
ac--;
|
|
}
|
|
else
|
|
{
|
|
fprintf(stderr, "%s: -D requires integer argument\n", argv[0]);
|
|
errs=1;
|
|
}
|
|
break;
|
|
|
|
case 'd':
|
|
if (ac > 1)
|
|
{
|
|
drift_file = *++a;
|
|
ac--;
|
|
}
|
|
else
|
|
{
|
|
fprintf(stderr, "%s: -d requires file name argument\n", argv[0]);
|
|
errs=1;
|
|
}
|
|
break;
|
|
|
|
case 'Y':
|
|
errs=check_y2k();
|
|
exit( errs ? 1 : 0 );
|
|
|
|
default:
|
|
fprintf(stderr, "%s: unknown option -%c\n", argv[0], c);
|
|
errs=1;
|
|
break;
|
|
}
|
|
else
|
|
if (file == NULL)
|
|
file = arg;
|
|
else
|
|
{
|
|
fprintf(stderr, "%s: device specified twice\n", argv[0]);
|
|
errs=1;
|
|
}
|
|
}
|
|
|
|
if (errs)
|
|
{
|
|
usage(argv[0]);
|
|
exit(1);
|
|
}
|
|
else
|
|
if (file == NULL)
|
|
{
|
|
fprintf(stderr, "%s: device not specified\n", argv[0]);
|
|
usage(argv[0]);
|
|
exit(1);
|
|
}
|
|
|
|
errs = LINES+1;
|
|
|
|
/*
|
|
* get access to DCF77 tty port
|
|
*/
|
|
fd = open(file, O_RDONLY);
|
|
if (fd == -1)
|
|
{
|
|
perror(file);
|
|
exit(1);
|
|
}
|
|
else
|
|
{
|
|
int i, rrc;
|
|
struct timeval t, tt, tlast;
|
|
struct timeval timeout;
|
|
struct timeval phase;
|
|
struct timeval time_offset;
|
|
char pbuf[61]; /* printable version */
|
|
char buf[61]; /* raw data */
|
|
clocktime_t clock_time; /* wall clock time */
|
|
time_t utc_time = 0;
|
|
time_t last_utc_time = 0;
|
|
long usecerror = 0;
|
|
long lasterror = 0;
|
|
#if defined(HAVE_TERMIOS_H) || defined(STREAM)
|
|
struct termios term;
|
|
#else /* not HAVE_TERMIOS_H || STREAM */
|
|
# if defined(HAVE_TERMIO_H) || defined(HAVE_SYSV_TTYS)
|
|
struct termio term;
|
|
# endif/* HAVE_TERMIO_H || HAVE_SYSV_TTYS */
|
|
#endif /* not HAVE_TERMIOS_H || STREAM */
|
|
unsigned int rtc = CVT_NONE;
|
|
|
|
rawdcf_init(fd);
|
|
|
|
timeout.tv_sec = 1;
|
|
timeout.tv_usec = 500000;
|
|
|
|
phase.tv_sec = 0;
|
|
phase.tv_usec = delay;
|
|
|
|
/*
|
|
* setup TTY (50 Baud, Read, 8Bit, No Hangup, 1 character IO)
|
|
*/
|
|
if (TTY_GETATTR(fd, &term) == -1)
|
|
{
|
|
perror("tcgetattr");
|
|
exit(1);
|
|
}
|
|
|
|
memset(term.c_cc, 0, sizeof(term.c_cc));
|
|
term.c_cc[VMIN] = 1;
|
|
#ifdef NO_PARENB_IGNPAR
|
|
term.c_cflag = CS8|CREAD|CLOCAL;
|
|
#else
|
|
term.c_cflag = CS8|CREAD|CLOCAL|PARENB;
|
|
#endif
|
|
term.c_iflag = IGNPAR;
|
|
term.c_oflag = 0;
|
|
term.c_lflag = 0;
|
|
|
|
cfsetispeed(&term, B50);
|
|
cfsetospeed(&term, B50);
|
|
|
|
if (TTY_SETATTR(fd, &term) == -1)
|
|
{
|
|
perror("tcsetattr");
|
|
exit(1);
|
|
}
|
|
|
|
/*
|
|
* lose terminal if in daemon operation
|
|
*/
|
|
if (!interactive)
|
|
detach();
|
|
|
|
/*
|
|
* get syslog() initialized
|
|
*/
|
|
#ifdef LOG_DAEMON
|
|
openlog("dcfd", LOG_PID, LOG_DAEMON);
|
|
#else
|
|
openlog("dcfd", LOG_PID);
|
|
#endif
|
|
|
|
/*
|
|
* setup periodic operations (state control / frequency control)
|
|
*/
|
|
#ifdef HAVE_SIGACTION
|
|
{
|
|
struct sigaction act;
|
|
|
|
# ifdef HAVE_SA_SIGACTION_IN_STRUCT_SIGACTION
|
|
act.sa_sigaction = (void (*) P((int, siginfo_t *, void *)))0;
|
|
# endif /* HAVE_SA_SIGACTION_IN_STRUCT_SIGACTION */
|
|
act.sa_handler = tick;
|
|
sigemptyset(&act.sa_mask);
|
|
act.sa_flags = 0;
|
|
|
|
if (sigaction(SIGALRM, &act, (struct sigaction *)0) == -1)
|
|
{
|
|
syslog(LOG_ERR, "sigaction(SIGALRM): %m");
|
|
exit(1);
|
|
}
|
|
}
|
|
#else
|
|
#ifdef HAVE_SIGVEC
|
|
{
|
|
struct sigvec vec;
|
|
|
|
vec.sv_handler = tick;
|
|
vec.sv_mask = 0;
|
|
vec.sv_flags = 0;
|
|
|
|
if (sigvec(SIGALRM, &vec, (struct sigvec *)0) == -1)
|
|
{
|
|
syslog(LOG_ERR, "sigvec(SIGALRM): %m");
|
|
exit(1);
|
|
}
|
|
}
|
|
#else
|
|
(void) signal(SIGALRM, tick);
|
|
#endif
|
|
#endif
|
|
|
|
#ifdef ITIMER_REAL
|
|
{
|
|
struct itimerval it;
|
|
|
|
it.it_interval.tv_sec = 1<<ADJINTERVAL;
|
|
it.it_interval.tv_usec = 0;
|
|
it.it_value.tv_sec = 1<<ADJINTERVAL;
|
|
it.it_value.tv_usec = 0;
|
|
|
|
if (setitimer(ITIMER_REAL, &it, (struct itimerval *)0) == -1)
|
|
{
|
|
syslog(LOG_ERR, "setitimer: %m");
|
|
exit(1);
|
|
}
|
|
}
|
|
#else
|
|
(void) alarm(1<<ADJINTERVAL);
|
|
#endif
|
|
|
|
PRINTF(" DCF77 monitor %s - Copyright (C) 1993-2005 by Frank Kardel\n\n", revision);
|
|
|
|
pbuf[60] = '\0';
|
|
for ( i = 0; i < 60; i++)
|
|
pbuf[i] = '.';
|
|
|
|
read_drift(drift_file);
|
|
|
|
/*
|
|
* what time is it now (for interval measurement)
|
|
*/
|
|
gettimeofday(&tlast, 0L);
|
|
i = 0;
|
|
/*
|
|
* loop until input trouble ...
|
|
*/
|
|
do
|
|
{
|
|
/*
|
|
* get an impulse
|
|
*/
|
|
while ((rrc = read(fd, &c, 1)) == 1)
|
|
{
|
|
gettimeofday(&t, 0L);
|
|
tt = t;
|
|
timersub(&t, &tlast);
|
|
|
|
if (errs > LINES)
|
|
{
|
|
PRINTF(" %s", &"PTB private....RADMLSMin....PHour..PMDay..DayMonthYear....P\n"[offset]);
|
|
PRINTF(" %s", &"---------------RADMLS1248124P124812P1248121241248112481248P\n"[offset]);
|
|
errs = 0;
|
|
}
|
|
|
|
/*
|
|
* timeout -> possible minute mark -> interpretation
|
|
*/
|
|
if (timercmp(&t, &timeout, >))
|
|
{
|
|
PRINTF("%c %.*s ", pat[i % (sizeof(pat)-1)], 59 - offset, &pbuf[offset]);
|
|
|
|
if ((rtc = cvt_rawdcf((unsigned char *)buf, i, &clock_time)) != CVT_OK)
|
|
{
|
|
/*
|
|
* this data was bad - well - forget synchronisation for now
|
|
*/
|
|
PRINTF("\n");
|
|
if (sync_state == SYNC)
|
|
{
|
|
sync_state = NO_SYNC;
|
|
syslog(LOG_INFO, "DCF77 reception lost (bad data)");
|
|
}
|
|
errs++;
|
|
}
|
|
else
|
|
if (trace)
|
|
{
|
|
PRINTF("\r %.*s ", 59 - offset, &buf[offset]);
|
|
}
|
|
|
|
|
|
buf[0] = c;
|
|
|
|
/*
|
|
* collect first character
|
|
*/
|
|
if (((c^0xFF)+1) & (c^0xFF))
|
|
pbuf[0] = '?';
|
|
else
|
|
pbuf[0] = type(c) ? '#' : '-';
|
|
|
|
for ( i = 1; i < 60; i++)
|
|
pbuf[i] = '.';
|
|
|
|
i = 0;
|
|
}
|
|
else
|
|
{
|
|
/*
|
|
* collect character
|
|
*/
|
|
buf[i] = c;
|
|
|
|
/*
|
|
* initial guess (usually correct)
|
|
*/
|
|
if (((c^0xFF)+1) & (c^0xFF))
|
|
pbuf[i] = '?';
|
|
else
|
|
pbuf[i] = type(c) ? '#' : '-';
|
|
|
|
PRINTF("%c %.*s ", pat[i % (sizeof(pat)-1)], 59 - offset, &pbuf[offset]);
|
|
}
|
|
|
|
if (i == 0 && rtc == CVT_OK)
|
|
{
|
|
/*
|
|
* we got a good time code here - try to convert it to
|
|
* UTC
|
|
*/
|
|
if ((utc_time = dcf_to_unixtime(&clock_time, &rtc)) == -1)
|
|
{
|
|
PRINTF("*** BAD CONVERSION\n");
|
|
}
|
|
|
|
if (utc_time != (last_utc_time + 60))
|
|
{
|
|
/*
|
|
* well, two successive sucessful telegrams are not 60 seconds
|
|
* apart
|
|
*/
|
|
PRINTF("*** NO MINUTE INC\n");
|
|
if (sync_state == SYNC)
|
|
{
|
|
sync_state = NO_SYNC;
|
|
syslog(LOG_INFO, "DCF77 reception lost (data mismatch)");
|
|
}
|
|
errs++;
|
|
rtc = CVT_FAIL|CVT_BADTIME|CVT_BADDATE;
|
|
}
|
|
else
|
|
usecerror = 0;
|
|
|
|
last_utc_time = utc_time;
|
|
}
|
|
|
|
if (rtc == CVT_OK)
|
|
{
|
|
if (i == 0)
|
|
{
|
|
/*
|
|
* valid time code - determine offset and
|
|
* note regained reception
|
|
*/
|
|
last_sync = ticks;
|
|
if (sync_state == NO_SYNC)
|
|
{
|
|
syslog(LOG_INFO, "receiving DCF77");
|
|
}
|
|
else
|
|
{
|
|
/*
|
|
* we had at least one minute SYNC - thus
|
|
* last error is valid
|
|
*/
|
|
time_offset.tv_sec = lasterror / 1000000;
|
|
time_offset.tv_usec = lasterror % 1000000;
|
|
adjust_clock(&time_offset, drift_file, utc_time);
|
|
}
|
|
sync_state = SYNC;
|
|
}
|
|
|
|
time_offset.tv_sec = utc_time + i;
|
|
time_offset.tv_usec = 0;
|
|
|
|
timeradd(&time_offset, &phase);
|
|
|
|
usecerror += (time_offset.tv_sec - tt.tv_sec) * 1000000 + time_offset.tv_usec
|
|
-tt.tv_usec;
|
|
|
|
/*
|
|
* output interpreted DCF77 data
|
|
*/
|
|
PRINTF(offsets ? "%s, %2ld:%02ld:%02d, %ld.%02ld.%02ld, <%s%s%s%s> (%c%ld.%06lds)" :
|
|
"%s, %2ld:%02ld:%02d, %ld.%02ld.%02ld, <%s%s%s%s>",
|
|
wday[clock_time.wday],
|
|
clock_time.hour, clock_time.minute, i, clock_time.day, clock_time.month,
|
|
clock_time.year,
|
|
(clock_time.flags & DCFB_ALTERNATE) ? "R" : "_",
|
|
(clock_time.flags & DCFB_ANNOUNCE) ? "A" : "_",
|
|
(clock_time.flags & DCFB_DST) ? "D" : "_",
|
|
(clock_time.flags & DCFB_LEAP) ? "L" : "_",
|
|
(lasterror < 0) ? '-' : '+', l_abs(lasterror) / 1000000, l_abs(lasterror) % 1000000
|
|
);
|
|
|
|
if (trace && (i == 0))
|
|
{
|
|
PRINTF("\n");
|
|
errs++;
|
|
}
|
|
lasterror = usecerror / (i+1);
|
|
}
|
|
else
|
|
{
|
|
lasterror = 0; /* we cannot calculate phase errors on bad reception */
|
|
}
|
|
|
|
PRINTF("\r");
|
|
|
|
if (i < 60)
|
|
{
|
|
i++;
|
|
}
|
|
|
|
tlast = tt;
|
|
|
|
if (interactive)
|
|
fflush(stdout);
|
|
}
|
|
} while ((rrc == -1) && (errno == EINTR));
|
|
|
|
/*
|
|
* lost IO - sorry guys
|
|
*/
|
|
syslog(LOG_ERR, "TERMINATING - cannot read from device %s (%m)", file);
|
|
|
|
(void)close(fd);
|
|
}
|
|
|
|
closelog();
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* History:
|
|
*
|
|
* dcfd.c,v
|
|
* Revision 4.18 2005/10/07 22:08:18 kardel
|
|
* make dcfd.c compile on NetBSD 3.99.9 again (configure/sigvec compatibility fix)
|
|
*
|
|
* Revision 4.17.2.1 2005/10/03 19:15:16 kardel
|
|
* work around configure not detecting a missing sigvec compatibility
|
|
* interface on NetBSD 3.99.9 and above
|
|
*
|
|
* Revision 4.17 2005/08/10 10:09:44 kardel
|
|
* output revision information
|
|
*
|
|
* Revision 4.16 2005/08/10 06:33:25 kardel
|
|
* cleanup warnings
|
|
*
|
|
* Revision 4.15 2005/08/10 06:28:45 kardel
|
|
* fix setting of baud rate
|
|
*
|
|
* Revision 4.14 2005/04/16 17:32:10 kardel
|
|
* update copyright
|
|
*
|
|
* Revision 4.13 2004/11/14 15:29:41 kardel
|
|
* support PPSAPI, upgrade Copyright to Berkeley style
|
|
*
|
|
*/
|