This is needed to keep sourcestats accurate when the actual frequency is different from the requested frequency due to clamping (or possibly rounding in future system drivers).
101 lines
2.4 KiB
C
101 lines
2.4 KiB
C
/*
|
|
chronyd/chronyc - Programs for keeping computer clocks accurate.
|
|
|
|
**********************************************************************
|
|
* Copyright (C) Miroslav Lichvar 2010
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of version 2 of the GNU General Public License as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
|
*
|
|
**********************************************************************
|
|
|
|
=======================================================================
|
|
|
|
Routines implementing temperature compensation.
|
|
|
|
*/
|
|
|
|
#include "conf.h"
|
|
#include "local.h"
|
|
#include "memory.h"
|
|
#include "util.h"
|
|
#include "logging.h"
|
|
#include "sched.h"
|
|
#include "tempcomp.h"
|
|
|
|
static SCH_TimeoutID timeout_id;
|
|
|
|
static LOG_FileID logfileid;
|
|
|
|
static char *filename;
|
|
static double update_interval;
|
|
static double T0, k0, k1, k2;
|
|
|
|
static void
|
|
read_timeout(void *arg)
|
|
{
|
|
FILE *f;
|
|
double temp, comp;
|
|
|
|
f = fopen(filename, "r");
|
|
|
|
if (f && fscanf(f, "%lf", &temp) == 1) {
|
|
comp = k0 + (temp - T0) * k1 + (temp - T0) * (temp - T0) * k2;
|
|
|
|
/* Don't allow corrections above 10 ppm */
|
|
if (fabs(comp) < 10.0) {
|
|
comp = LCL_SetTempComp(comp);
|
|
|
|
if (logfileid != -1) {
|
|
struct timeval now;
|
|
|
|
LCL_ReadCookedTime(&now, NULL);
|
|
LOG_FileWrite(logfileid, "%s %11.4e %11.4e",
|
|
UTI_TimeToLogForm(now.tv_sec), temp, comp);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (f)
|
|
fclose(f);
|
|
|
|
timeout_id = SCH_AddTimeoutByDelay(update_interval, read_timeout, NULL);
|
|
}
|
|
|
|
void
|
|
TMC_Initialise(void)
|
|
{
|
|
CNF_GetTempComp(&filename, &update_interval, &T0, &k0, &k1, &k2);
|
|
|
|
if (filename == NULL)
|
|
return;
|
|
|
|
if (update_interval <= 0.0)
|
|
update_interval = 1.0;
|
|
|
|
logfileid = CNF_GetLogTempComp() ? LOG_FileOpen("tempcomp",
|
|
" Date (UTC) Time Temp. Comp.")
|
|
: -1;
|
|
|
|
read_timeout(NULL);
|
|
}
|
|
|
|
void
|
|
TMC_Finalise(void)
|
|
{
|
|
if (filename == NULL)
|
|
return;
|
|
|
|
SCH_RemoveTimeout(timeout_id);
|
|
Free(filename);
|
|
}
|