mirror of
https://github.com/meshtastic/firmware.git
synced 2025-04-30 11:23:53 +00:00
36 lines
643 B
C++
36 lines
643 B
C++
#include "PeriodicScheduler.h"
|
|
#include "PeriodicTask.h"
|
|
#include "LockGuard.h"
|
|
#include "../timing.h"
|
|
|
|
namespace concurrency {
|
|
|
|
/// call this from loop
|
|
void PeriodicScheduler::loop()
|
|
{
|
|
LockGuard lg(&lock);
|
|
|
|
uint32_t now = timing::millis();
|
|
for (auto t : tasks) {
|
|
if (t->period && (now - t->lastMsec) >= t->period) {
|
|
|
|
t->doTask();
|
|
t->lastMsec = now;
|
|
}
|
|
}
|
|
}
|
|
|
|
void PeriodicScheduler::schedule(PeriodicTask *t)
|
|
{
|
|
LockGuard lg(&lock);
|
|
tasks.insert(t);
|
|
}
|
|
|
|
void PeriodicScheduler::unschedule(PeriodicTask *t)
|
|
{
|
|
LockGuard lg(&lock);
|
|
tasks.erase(t);
|
|
}
|
|
|
|
} // namespace concurrency
|