/******************************************************************************
*
* usrTimeSync - synchronize the system clock with an RTC
*
* This function should be called upon system initialization, after
* sysClkEnable(), or any time after that repeatedly.
*
* NOTE:
* If accurate time keeping is needed, every so often the clock resolution
* can be subtly changed to reflect possible inaccuracy of the System
* Clock interrupt generator, and keep the wall clock in sync with the RTC.
*
*/
STATUS usrTimeSync (void)
{
struct timespec tv ;
struct tm tm ;
sysRtcGet( &tm ) ;
tv.tv_sec = mktime( &tm );
tv.tv_nsec = 0;
clock_settime( CLOCK_REALTIME, &tv );
tv.tv_sec = 0;
tv.tv_nsec = 1000000000 / sysClkRateGet() ;
clock_setres( CLOCK_REALTIME, &tv );
return OK ;
}
/******************************************************************************
*
* date - set or display current time and date
*
* A simple date and time manipulator similar to "date" command on Unix.
* If the argument is 0 (or NULL), it will display the date and time
* according to the Real Time Chip. If the argument is -1, this command
* will display the date and time according to VxWorks REALTIME_CLOCK.
* Otherwise the argument can be a string of the following form
* to set the RTC and system date and time manually:
*
* "YYMMDDhhmmss"
*
* where "YY" stands for last two digits of the year, and so forth.
*
* RETURNS: N/A
*
* SEE ALSO
*
* ansiTime(1), clockLib(1)
*/
void date
(
const char *str
)
{
struct tm tm ;
struct timespec tv ;
char buf[60];
size_t i = sizeof(buf);
time_t t ;
if ((int)str == -1)
{
t = time (NULL);
localtime_r( &t, &tm);
asctime_r( &tm, buf, &i );
printf("%s", buf );
}
else if (str != NULL)
{
/* Set the time */
tm.tm_sec = (str[10] -'0')*10 + str[11] - '0' ;
tm.tm_min = (str[8] -'0')*10 + str[9] - '0' ;
tm.tm_hour = (str[6] -'0')*10 + str[7] - '0' ;
tm.tm_mday = (str[4] -'0')*10 + str[5] - '0' ;
tm.tm_mon = (str[2] -'0')*10 + str[3] - '0' - 1; /* Jan == 0 */
tm.tm_year = (str[0] -'0')*10 + str[1] - '0' ;
tm.tm_wday = 0 ;
tm.tm_yday = 0 ;
tm.tm_isdst = 0 ;
/* correction for y2k */
if (tm.tm_year < 80 )
tm.tm_year += 100 ;
tv.tv_sec = mktime( &tm );
tv.tv_nsec = 0;
sysRtcSet( &tm );
clock_settime( CLOCK_REALTIME, &tv );
asctime_r( &tm, buf, &i );
printf("%s", buf );
}
else
{
/* Print the date and time of the RTC */
sysRtcGet( &tm );
asctime_r( &tm, buf, &i );
printf("%s", buf );
}
#ifdef LOCAL_DEBUG
printf(" tm.tm_sec %d\n", tm.tm_sec);
printf(" tm.tm_min %d\n", tm.tm_min);
printf(" tm.tm_hour %d\n", tm.tm_hour);
printf(" tm.tm_mday %d\n", tm.tm_mday);
printf(" tm.tm_mon %d\n", tm.tm_mon);
printf(" tm.tm_year %d\n", tm.tm_year);
printf(" tm.tm_wday %d\n", tm.tm_wday);
printf(" tm.tm_yday %d\n", tm.tm_yday);
printf(" tm.tm_isdst %d\n", tm.tm_isdst);
#endif
}
/******************************************************************************
*
* usrTimeAdj - routinely adjust system time with the Real-Time Clock
*
*/
STATUS usrTimeAdj( int interval )
{
static time_t lastFreq, lastTime, lastPeriod ;
FAST time_t freq, t, t1;
long dif;
struct tm tm ;
struct timespec tv ;
if( interval == 0)
interval = 120 ;
freq = sysClkRateGet();
FOREVER
{
/* sleep until the next iteration */
taskDelay( interval * freq );
taskLock() ;
sysRtcGet( &tm );
freq = sysClkRateGet();
t = time (NULL);
taskUnlock();
if( t == ERROR )
{
char buf[48]; int i=sizeof(buf);
asctime_r( &tm, buf, &i );
logMsg("mktime error %s", (int) buf, 0,0,0,0,0);
}
t1 = mktime( &tm );
dif = t1 - t; /* how many seconds skew */
/* logMsg("t=%d t1=%d dif=%d\n", t, t1, dif, 0,0,0); */
/* if there is a serious difference, do a step adjustment */
if ((abs(dif) > 1) || (freq != lastFreq) )
{
if(usrTimeDebug)
{
char buf[48]; int i=sizeof(buf);
asctime_r( &tm, buf, &i );
logMsg("syncing clock %s", (int) buf, 0,0,0,0,0);
}
usrTimeSync();
/* update statics for next iteration */
lastFreq = freq ;
lastPeriod = tv.tv_nsec = 1000000000 / freq ;
lastTime = time(NULL) ;
}
#ifdef __XXX__
else if( dif != 0)
{
FAST time_t tmp ;
/* otherwise, gradually adjust clock to RTC speed */
tv.tv_sec = 0;
/* this expression must be carefully ordered, not to
* get involved with 64-bit arithmetic which is
* incomplete in the current version's library.
*/
tmp = lastPeriod / ((t - lastTime)*freq);
tv.tv_nsec += tmp * dif ;
clock_setres( CLOCK_REALTIME, &tv );
if(usrTimeDebug)
logMsg("dif %d old period %d ns, new period %d ns, interval %d\n",
dif, lastPeriod, tv.tv_nsec, t - lastTime, 0, 0 );
/* update statics for next iteration */
lastFreq = freq ;
lastPeriod = tv.tv_nsec ;
lastTime = t ;
}
#endif /*__XXX__*/
} /* FOREVER */
}
/******************************************************************************
*
* usrTimeAdj - routinely adjust system time with the Real-Time Clock
*
*/
STATUS usrTimeAdj( int interval )
{
static time_t lastFreq, lastTime, lastPeriod ;
FAST time_t freq, t, t1;
long dif;
struct tm tm ;
struct timespec tv ;
if (interval == 0)
interval = 120 ;
freq = sysClkRateGet();
FOREVER
{
/* sleep until the next iteration */
taskDelay( interval * freq );
taskLock() ;
sysRtcGet( &tm );
freq = sysClkRateGet();
t = time (NULL);
taskUnlock();
if (t == ERROR)
{
char buf[48]; int i=sizeof(buf);
asctime_r( &tm, buf, &i );
logMsg("mktime error %s", (int) buf, 0,0,0,0,0);
}
t1 = mktime( &tm );
dif = t1 - t; /* how many seconds skew */
/* logMsg("t=%d t1=%d dif=%d\n", t, t1, dif, 0,0,0); */
/* if there is a serious difference, do a step adjustment */
if ((abs(dif) > 1) || (freq != lastFreq))
{
if (usrTimeDebug)
{
char buf[48]; int i=sizeof(buf);
asctime_r( &tm, buf, &i );
logMsg("syncing clock %s", (int) buf, 0,0,0,0,0);
}
usrTimeSync();
/* update statics for next iteration */
lastFreq = freq ;
lastPeriod = tv.tv_nsec = 1000000000 / freq ;
lastTime = time(NULL) ;
}
} /* FOREVER */
}
