mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-02-19 01:53:57 +08:00
97631ec362
* c++ RateKeeper
* add to files_common
* use util::random_int
* improve monotor_time
* remove ~ratekeeper
old-commit-hash: 3eef63af9b
39 lines
1019 B
C++
39 lines
1019 B
C++
#include "common/ratekeeper.h"
|
|
|
|
#include "common/swaglog.h"
|
|
#include "common/timing.h"
|
|
#include "common/util.h"
|
|
|
|
RateKeeper::RateKeeper(const std::string &name, float rate, float print_delay_threshold)
|
|
: name(name),
|
|
print_delay_threshold(std::max(0.f, print_delay_threshold)) {
|
|
interval = 1 / rate;
|
|
last_monitor_time = seconds_since_boot();
|
|
next_frame_time = last_monitor_time + interval;
|
|
}
|
|
|
|
bool RateKeeper::keepTime() {
|
|
bool lagged = monitorTime();
|
|
if (remaining_ > 0) {
|
|
util::sleep_for(remaining_ * 1000);
|
|
}
|
|
return lagged;
|
|
}
|
|
|
|
bool RateKeeper::monitorTime() {
|
|
++frame_;
|
|
last_monitor_time = seconds_since_boot();
|
|
remaining_ = next_frame_time - last_monitor_time;
|
|
|
|
bool lagged = remaining_ < 0;
|
|
if (lagged) {
|
|
if (print_delay_threshold > 0 && remaining_ < -print_delay_threshold) {
|
|
LOGW("%s lagging by %.2f ms", name.c_str(), -remaining_ * 1000);
|
|
}
|
|
next_frame_time = last_monitor_time + interval;
|
|
} else {
|
|
next_frame_time += interval;
|
|
}
|
|
return lagged;
|
|
}
|