forked from ivanseidel/ArduinoThread
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Thread.cpp
89 lines (67 loc) · 1.99 KB
/
Thread.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
#include "Thread.h"
Thread::Thread(void (*callback)(void), unsigned long _interval, unsigned long _timeout) :
_onRun(callback), ThreadID((int)this), timeout(_timeout){
last_run = millis();
#ifdef USE_THREAD_NAMES
ThreadName = "Thread ";
ThreadName = ThreadName + ThreadID;
#endif
setInterval(_interval);
};
void Thread::runned(unsigned long time){
// Saves last_run
last_run = time;
// Cache next run
switch (pause_interval) {
case 0:
_cached_next_run = last_run + interval;
break;
default:
_cached_next_run = last_run + pause_interval;
break;
}
}
void Thread::setInterval(unsigned long _interval){
// Save interval
interval = _interval;
// Cache the next run based on the last_run
_cached_next_run = last_run + interval;
}
void Thread::setTimeout(unsigned long _timeout){
timeout = _timeout;
}
bool Thread::shouldRun(unsigned long time){
// Nothing below matters if the thread is frozen.
if (frozen){
return false;
}
// If the "sign" bit is set the signed difference would be negative
bool time_remaining = (time - _cached_next_run) & 0x80000000;
if(!time_remaining && enabled && !_started){
_started = true;
_t0 = time;
}
if (!time_remaining && pause_interval != 0){
pause_interval = 0;
}
switch (timeout)
{
// A timeout of 0 doesn't make sense and instead signifies a timeout that hasn't been set.
case 0:
// Exceeded the time limit, AND is enabled? Then should run...
return !time_remaining && enabled;
default:
bool timed_out = !((time - (_t0 + timeout)) & 0x80000000);
// Exceeded the time limit, AND not timed out, AND is enabled? Then should run...
return !time_remaining && !timeout && enabled;
}
}
void Thread::onRun(void (*callback)(void)){
_onRun = callback;
}
void Thread::run(){
if(_onRun != nullptr)
_onRun();
// Update last_run and _cached_next_run
runned();
}