| File: | src/usr.sbin/ntpd/sensors.c | 
| Warning: | line 185, column 19 The left operand of '&' is a garbage value  | 
Press '?' to see keyboard shortcuts
Keyboard shortcuts:
| 1 | /* $OpenBSD: sensors.c,v 1.54 2019/11/11 06:32:52 otto Exp $ */ | |||
| 2 | ||||
| 3 | /* | |||
| 4 | * Copyright (c) 2006 Henning Brauer <henning@openbsd.org> | |||
| 5 | * | |||
| 6 | * Permission to use, copy, modify, and distribute this software for any | |||
| 7 | * purpose with or without fee is hereby granted, provided that the above | |||
| 8 | * copyright notice and this permission notice appear in all copies. | |||
| 9 | * | |||
| 10 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES | |||
| 11 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF | |||
| 12 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR | |||
| 13 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES | |||
| 14 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN | |||
| 15 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF | |||
| 16 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. | |||
| 17 | */ | |||
| 18 | ||||
| 19 | #include <sys/types.h> | |||
| 20 | #include <sys/queue.h> | |||
| 21 | #include <sys/time.h> | |||
| 22 | #include <sys/sensors.h> | |||
| 23 | #include <sys/sysctl.h> | |||
| 24 | #include <sys/device.h> | |||
| 25 | ||||
| 26 | #include <errno(*__errno()).h> | |||
| 27 | #include <fcntl.h> | |||
| 28 | #include <stdio.h> | |||
| 29 | #include <stdlib.h> | |||
| 30 | #include <string.h> | |||
| 31 | #include <unistd.h> | |||
| 32 | ||||
| 33 | #include "ntpd.h" | |||
| 34 | ||||
| 35 | #define MAXDEVNAMLEN16 16 | |||
| 36 | ||||
| 37 | int sensor_probe(int, char *, struct sensor *); | |||
| 38 | void sensor_add(int, char *); | |||
| 39 | void sensor_remove(struct ntp_sensor *); | |||
| 40 | void sensor_update(struct ntp_sensor *); | |||
| 41 | ||||
| 42 | void | |||
| 43 | sensor_init(void) | |||
| 44 | { | |||
| 45 | 	TAILQ_INIT(&conf->ntp_sensors)do { (&conf->ntp_sensors)->tqh_first = ((void *)0); (&conf->ntp_sensors)->tqh_last = &(&conf-> ntp_sensors)->tqh_first; } while (0);  | |||
| 46 | } | |||
| 47 | ||||
| 48 | int | |||
| 49 | sensor_scan(void) | |||
| 50 | { | |||
| 51 | int i, n, err; | |||
| 52 | char d[MAXDEVNAMLEN16]; | |||
| 53 | struct sensor s; | |||
| 54 | ||||
| 55 | n = 0; | |||
| 56 | for (i = 0; ; i++) | |||
| 57 | if ((err = sensor_probe(i, d, &s))) { | |||
| 58 | if (err == 0) | |||
| 59 | continue; | |||
| 60 | if (err == -1) /* no further sensors */ | |||
| 61 | break; | |||
| 62 | sensor_add(i, d); | |||
| 63 | n++; | |||
| 64 | } | |||
| 65 | ||||
| 66 | return n; | |||
| 67 | } | |||
| 68 | ||||
| 69 | /* | |||
| 70 | * 1 = time sensor! | |||
| 71 | * 0 = sensor exists... but is not a time sensor | |||
| 72 | * -1: no sensor here, and no further sensors after this | |||
| 73 | */ | |||
| 74 | int | |||
| 75 | sensor_probe(int devid, char *dxname, struct sensor *sensor) | |||
| 76 | { | |||
| 77 | int mib[5]; | |||
| 78 | size_t slen, sdlen; | |||
| 79 | struct sensordev sensordev; | |||
| 80 | ||||
| 81 | mib[0] = CTL_HW6; | |||
| 82 | mib[1] = HW_SENSORS11; | |||
| 83 | mib[2] = devid; | |||
| 84 | mib[3] = SENSOR_TIMEDELTA; | |||
| 85 | mib[4] = 0; | |||
| 86 | ||||
| 87 | sdlen = sizeof(sensordev); | |||
| 88 | if (sysctl(mib, 3, &sensordev, &sdlen, NULL((void *)0), 0) == -1) { | |||
| 89 | if (errno(*__errno()) == ENXIO6) | |||
| 90 | return (0); | |||
| 91 | if (errno(*__errno()) == ENOENT2) | |||
| 92 | return (-1); | |||
| 93 | log_warn("sensor_probe sysctl"); | |||
| 94 | } | |||
| 95 | ||||
| 96 | if (sensordev.maxnumt[SENSOR_TIMEDELTA] == 0) | |||
| 97 | return (0); | |||
| 98 | ||||
| 99 | strlcpy(dxname, sensordev.xname, MAXDEVNAMLEN16); | |||
| 100 | ||||
| 101 | slen = sizeof(*sensor); | |||
| 102 | if (sysctl(mib, 5, sensor, &slen, NULL((void *)0), 0) == -1) { | |||
| 103 | if (errno(*__errno()) != ENOENT2) | |||
| 104 | log_warn("sensor_probe sysctl"); | |||
| 105 | return (0); | |||
| 106 | } | |||
| 107 | ||||
| 108 | return (1); | |||
| 109 | } | |||
| 110 | ||||
| 111 | void | |||
| 112 | sensor_add(int sensordev, char *dxname) | |||
| 113 | { | |||
| 114 | struct ntp_sensor *s; | |||
| 115 | struct ntp_conf_sensor *cs; | |||
| 116 | ||||
| 117 | /* check whether it is already there */ | |||
| 118 | 	TAILQ_FOREACH(s, &conf->ntp_sensors, entry)for((s) = ((&conf->ntp_sensors)->tqh_first); (s) != ((void *)0); (s) = ((s)->entry.tqe_next))  | |||
| 119 | if (!strcmp(s->device, dxname)) | |||
| 120 | return; | |||
| 121 | ||||
| 122 | /* check whether it is requested in the config file */ | |||
| 123 | for (cs = TAILQ_FIRST(&conf->ntp_conf_sensors)((&conf->ntp_conf_sensors)->tqh_first); cs != NULL((void *)0) && | |||
| 124 | strcmp(cs->device, dxname) && strcmp(cs->device, "*"); | |||
| 125 | cs = TAILQ_NEXT(cs, entry)((cs)->entry.tqe_next)) | |||
| 126 | ; /* nothing */ | |||
| 127 | if (cs == NULL((void *)0)) | |||
| 128 | return; | |||
| 129 | ||||
| 130 | if ((s = calloc(1, sizeof(*s))) == NULL((void *)0)) | |||
| 131 | fatal("sensor_add calloc"); | |||
| 132 | ||||
| 133 | s->next = getmonotime(); | |||
| 134 | s->weight = cs->weight; | |||
| 135 | s->correction = cs->correction; | |||
| 136 | s->stratum = cs->stratum - 1; | |||
| 137 | s->trusted = cs->trusted; | |||
| 138 | if ((s->device = strdup(dxname)) == NULL((void *)0)) | |||
| 139 | fatal("sensor_add strdup"); | |||
| 140 | s->sensordevid = sensordev; | |||
| 141 | ||||
| 142 | if (cs->refstr == NULL((void *)0)) | |||
| 143 | memcpy(&s->refid, SENSOR_DEFAULT_REFID"HARD", sizeof(s->refid)); | |||
| 144 | else { | |||
| 145 | s->refid = 0; | |||
| 146 | strncpy((char *)&s->refid, cs->refstr, sizeof(s->refid)); | |||
| 147 | } | |||
| 148 | ||||
| 149 | 	TAILQ_INSERT_TAIL(&conf->ntp_sensors, s, entry)do { (s)->entry.tqe_next = ((void *)0); (s)->entry.tqe_prev = (&conf->ntp_sensors)->tqh_last; *(&conf-> ntp_sensors)->tqh_last = (s); (&conf->ntp_sensors)-> tqh_last = &(s)->entry.tqe_next; } while (0);  | |||
| 150 | ||||
| 151 | log_debug("sensor %s added (weight %d, correction %.6f, refstr %.4u, " | |||
| 152 | "stratum %d)", s->device, s->weight, s->correction / 1e6, | |||
| 153 | s->refid, s->stratum); | |||
| 154 | } | |||
| 155 | ||||
| 156 | void | |||
| 157 | sensor_remove(struct ntp_sensor *s) | |||
| 158 | { | |||
| 159 | 	TAILQ_REMOVE(&conf->ntp_sensors, s, entry)do { if (((s)->entry.tqe_next) != ((void *)0)) (s)->entry .tqe_next->entry.tqe_prev = (s)->entry.tqe_prev; else ( &conf->ntp_sensors)->tqh_last = (s)->entry.tqe_prev ; *(s)->entry.tqe_prev = (s)->entry.tqe_next; ; ; } while (0);  | |||
| 160 | free(s->device); | |||
| 161 | free(s); | |||
| 162 | } | |||
| 163 | ||||
| 164 | void | |||
| 165 | sensor_query(struct ntp_sensor *s) | |||
| 166 | { | |||
| 167 | char dxname[MAXDEVNAMLEN16]; | |||
| 168 | struct sensor sensor; | |||
| 169 | double sens_time; | |||
| 170 | ||||
| 171 | if (conf->settime) | |||
  | ||||
| 172 | s->next = getmonotime() + SENSOR_QUERY_INTERVAL_SETTIME(15/3); | |||
| 173 | else | |||
| 174 | s->next = getmonotime() + SENSOR_QUERY_INTERVAL15; | |||
| 175 | ||||
| 176 | /* rcvd is walltime here, monotime in client.c. not used elsewhere */ | |||
| 177 | if (s->update.rcvd < time(NULL((void *)0)) - SENSOR_DATA_MAXAGE(15*60)) | |||
| 178 | s->update.good = 0; | |||
| 179 | ||||
| 180 | if (!sensor_probe(s->sensordevid, dxname, &sensor)) { | |||
| 181 | sensor_remove(s); | |||
| 182 | return; | |||
| 183 | } | |||
| 184 | ||||
| 185 | if (sensor.flags & SENSOR_FINVALID0x0001 || | |||
  | ||||
| 186 | sensor.status != SENSOR_S_OK) | |||
| 187 | return; | |||
| 188 | ||||
| 189 | if (strcmp(dxname, s->device)) { | |||
| 190 | sensor_remove(s); | |||
| 191 | return; | |||
| 192 | } | |||
| 193 | ||||
| 194 | if (sensor.tv.tv_sec == s->last) /* already seen */ | |||
| 195 | return; | |||
| 196 | ||||
| 197 | s->last = sensor.tv.tv_sec; | |||
| 198 | ||||
| 199 | if (!s->trusted && !TAILQ_EMPTY(&conf->constraints)(((&conf->constraints)->tqh_first) == ((void *)0))) { | |||
| 200 | if (conf->constraint_median == 0) { | |||
| 201 | return; | |||
| 202 | } | |||
| 203 | sens_time = gettime() + (sensor.value / -1e9) + | |||
| 204 | (s->correction / 1e6); | |||
| 205 | if (constraint_check(sens_time) != 0) { | |||
| 206 | log_info("sensor %s: constraint check failed", s->device); | |||
| 207 | return; | |||
| 208 | } | |||
| 209 | } | |||
| 210 | /* | |||
| 211 | * TD = device time | |||
| 212 | * TS = system time | |||
| 213 | * sensor.value = TS - TD in ns | |||
| 214 | * if value is positive, system time is ahead | |||
| 215 | */ | |||
| 216 | s->offsets[s->shift].offset = (sensor.value / -1e9) - getoffset() + | |||
| 217 | (s->correction / 1e6); | |||
| 218 | s->offsets[s->shift].rcvd = sensor.tv.tv_sec; | |||
| 219 | s->offsets[s->shift].good = 1; | |||
| 220 | ||||
| 221 | s->offsets[s->shift].status.send_refid = s->refid; | |||
| 222 | /* stratum increased when sent out */ | |||
| 223 | s->offsets[s->shift].status.stratum = s->stratum; | |||
| 224 | s->offsets[s->shift].status.rootdelay = 0; | |||
| 225 | s->offsets[s->shift].status.rootdispersion = 0; | |||
| 226 | s->offsets[s->shift].status.reftime = sensor.tv.tv_sec; | |||
| 227 | s->offsets[s->shift].status.synced = 1; | |||
| 228 | ||||
| 229 | log_debug("sensor %s: offset %f", s->device, | |||
| 230 | s->offsets[s->shift].offset); | |||
| 231 | ||||
| 232 | if (++s->shift >= SENSOR_OFFSETS6) { | |||
| 233 | s->shift = 0; | |||
| 234 | sensor_update(s); | |||
| 235 | } | |||
| 236 | ||||
| 237 | } | |||
| 238 | ||||
| 239 | void | |||
| 240 | sensor_update(struct ntp_sensor *s) | |||
| 241 | { | |||
| 242 | struct ntp_offset **offsets; | |||
| 243 | int i; | |||
| 244 | ||||
| 245 | if ((offsets = calloc(SENSOR_OFFSETS6, sizeof(struct ntp_offset *))) == | |||
| 246 | NULL((void *)0)) | |||
| 247 | fatal("calloc sensor_update"); | |||
| 248 | ||||
| 249 | for (i = 0; i < SENSOR_OFFSETS6; i++) | |||
| 250 | offsets[i] = &s->offsets[i]; | |||
| 251 | ||||
| 252 | qsort(offsets, SENSOR_OFFSETS6, sizeof(struct ntp_offset *), | |||
| 253 | offset_compare); | |||
| 254 | ||||
| 255 | i = SENSOR_OFFSETS6 / 2; | |||
| 256 | memcpy(&s->update, offsets[i], sizeof(s->update)); | |||
| 257 | if (SENSOR_OFFSETS6 % 2 == 0) { | |||
| 258 | s->update.offset = | |||
| 259 | (offsets[i - 1]->offset + offsets[i]->offset) / 2; | |||
| 260 | } | |||
| 261 | free(offsets); | |||
| 262 | ||||
| 263 | log_debug("sensor update %s: offset %f", s->device, s->update.offset); | |||
| 264 | priv_adjtime(); | |||
| 265 | } |