mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-08-31 13:13:44 +08:00
github-actions[bot]
eefc084302
version: sunnypilot v2025.003.000 (dev) date: 2025-12-18T05:48:43 master commit: 16c052af0835f049a67b80251d8cc1114fc08bb4
41 lines
1.0 KiB
C++
41 lines
1.0 KiB
C++
#include "common/ratekeeper.h"
|
|
|
|
#include <algorithm>
|
|
|
|
#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;
|
|
}
|