mirror of
https://github.com/meshtastic/firmware.git
synced 2025-12-23 11:10:52 +00:00
36 lines
639 B
C++
36 lines
639 B
C++
|
#include "PeriodicScheduler.h"
|
||
|
|
#include "PeriodicTask.h"
|
||
|
|
#include "LockGuard.h"
|
||
|
|
#include "../time.h"
|
||
|
|
|
||
|
|
namespace concurrency {
|
||
|
|
|
||
|
|
/// call this from loop
|
||
|
|
void PeriodicScheduler::loop()
|
||
|
|
{
|
||
|
|
LockGuard lg(&lock);
|
||
|
|
|
||
|
|
uint32_t now = time::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
|