mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-02-19 18:13:55 +08:00
7f0b3180a4
* add PubMaster & SubMaster
remove 'delete msg'
remove headers
* use constructor to initial all submster
* modify drain sockets
* fix typo in ssconscript.remove lines
no checkValid in loggerd
last modify
handle_message:event->&event
fix type
remove heads
event to auto
* new interface
* api changed
* Revert "use constructor to initial all submster"
This reverts commit 73be7ea46250a325ce41d3a0445e34395a2ae692.
* change to new api
* revert loggerd
* dd
* use new PubSub api
* update to new interface
don't modify loggerd
reset panda
reset opendbc
remove empty lines
* switch to new pubMaster
* update to the new inteface
change
remove error code
. to ->
merge paramsd.cc
update panda
fix typo
simplify
fix typo
* Fix build
* always conflate
Co-authored-by: deanlee <deanlee3@gmail.com>
old-commit-hash: ab5af232b2
63 lines
1.5 KiB
C++
63 lines
1.5 KiB
C++
#include <stdio.h>
|
|
#include <stdint.h>
|
|
#include <sys/resource.h>
|
|
#include <sys/timerfd.h>
|
|
#include <sys/time.h>
|
|
#include <utils/Timers.h>
|
|
#include "messaging.hpp"
|
|
#include "common/timing.h"
|
|
|
|
namespace {
|
|
int64_t arm_cntpct() {
|
|
int64_t v;
|
|
asm volatile("mrs %0, cntpct_el0" : "=r"(v));
|
|
return v;
|
|
}
|
|
}
|
|
|
|
int main() {
|
|
setpriority(PRIO_PROCESS, 0, -13);
|
|
|
|
int err = 0;
|
|
PubMaster pm({"clocks"});
|
|
|
|
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;
|
|
|
|
err = timerfd_settime(timerfd, 0, &spec, 0);
|
|
assert(err == 0);
|
|
|
|
uint64_t expirations = 0;
|
|
while ((err = read(timerfd, &expirations, sizeof(expirations)))) {
|
|
if (err < 0) break;
|
|
|
|
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();
|
|
|
|
uint64_t modem_uptime_v = arm_cntpct() / 19200ULL; // 19.2 mhz clock
|
|
|
|
capnp::MallocMessageBuilder msg;
|
|
cereal::Event::Builder event = msg.initRoot<cereal::Event>();
|
|
event.setLogMonoTime(boottime);
|
|
auto clocks = event.initClocks();
|
|
|
|
clocks.setBootTimeNanos(boottime);
|
|
clocks.setMonotonicNanos(monotonic);
|
|
clocks.setMonotonicRawNanos(monotonic_raw);
|
|
clocks.setWallTimeNanos(wall_time);
|
|
clocks.setModemUptimeMillis(modem_uptime_v);
|
|
|
|
pm.send("clocks", msg);
|
|
}
|
|
|
|
close(timerfd);
|
|
return 0;
|
|
} |