parent
1b6116976e
commit
3d602a86dc
8 changed files with 0 additions and 84 deletions
@ -1 +0,0 @@ |
|||||||
clocksd |
|
@ -1,2 +0,0 @@ |
|||||||
Import('env', 'common', 'cereal', 'messaging') |
|
||||||
env.Program('clocksd.cc', LIBS=[common, cereal, messaging, 'capnp', 'zmq', 'kj']) |
|
@ -1,73 +0,0 @@ |
|||||||
#include <sys/resource.h> |
|
||||||
#include <sys/time.h> |
|
||||||
#include <unistd.h> |
|
||||||
|
|
||||||
#include <cstdint> |
|
||||||
#include <cstdio> |
|
||||||
|
|
||||||
// Apple doesn't have timerfd
|
|
||||||
#ifdef __APPLE__ |
|
||||||
#include <thread> |
|
||||||
#else |
|
||||||
#include <sys/timerfd.h> |
|
||||||
#endif |
|
||||||
|
|
||||||
#include <cassert> |
|
||||||
#include <chrono> |
|
||||||
|
|
||||||
#include "cereal/messaging/messaging.h" |
|
||||||
#include "common/timing.h" |
|
||||||
#include "common/util.h" |
|
||||||
|
|
||||||
ExitHandler do_exit; |
|
||||||
|
|
||||||
int main() { |
|
||||||
setpriority(PRIO_PROCESS, 0, -13); |
|
||||||
PubMaster pm({"clocks"}); |
|
||||||
|
|
||||||
#ifndef __APPLE__ |
|
||||||
int timerfd = timerfd_create(CLOCK_BOOTTIME, 0); |
|
||||||
assert(timerfd >= 0); |
|
||||||
|
|
||||||
struct itimerspec spec = {0}; |
|
||||||
spec.it_interval.tv_sec = 1; |
|
||||||
spec.it_interval.tv_nsec = 0; |
|
||||||
spec.it_value.tv_sec = 1; |
|
||||||
spec.it_value.tv_nsec = 0; |
|
||||||
|
|
||||||
int err = timerfd_settime(timerfd, 0, &spec, 0); |
|
||||||
assert(err == 0); |
|
||||||
|
|
||||||
uint64_t expirations = 0; |
|
||||||
while (!do_exit && (err = read(timerfd, &expirations, sizeof(expirations)))) { |
|
||||||
if (err < 0) { |
|
||||||
if (errno == EINTR) continue; |
|
||||||
break; |
|
||||||
} |
|
||||||
#else |
|
||||||
// Just run at 1Hz on apple
|
|
||||||
while (!do_exit) { |
|
||||||
util::sleep_for(1000); |
|
||||||
#endif |
|
||||||
|
|
||||||
uint64_t boottime = nanos_since_boot(); |
|
||||||
uint64_t monotonic = nanos_monotonic(); |
|
||||||
uint64_t monotonic_raw = nanos_monotonic_raw(); |
|
||||||
uint64_t wall_time = nanos_since_epoch(); |
|
||||||
|
|
||||||
MessageBuilder msg; |
|
||||||
auto clocks = msg.initEvent().initClocks(); |
|
||||||
|
|
||||||
clocks.setBootTimeNanos(boottime); |
|
||||||
clocks.setMonotonicNanos(monotonic); |
|
||||||
clocks.setMonotonicRawNanos(monotonic_raw); |
|
||||||
clocks.setWallTimeNanos(wall_time); |
|
||||||
|
|
||||||
pm.send("clocks", msg); |
|
||||||
} |
|
||||||
|
|
||||||
#ifndef __APPLE__ |
|
||||||
close(timerfd); |
|
||||||
#endif |
|
||||||
return 0; |
|
||||||
} |
|
Loading…
Reference in new issue