-
Notifications
You must be signed in to change notification settings - Fork 8
/
loop_stopper.cpp
74 lines (61 loc) · 1.26 KB
/
loop_stopper.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
/*
* Flybrix Flight Controller -- Copyright 2018 Flying Selfie Inc. d/b/a Flybrix
*
* http://www.flybrix.com
*/
#include "loop_stopper.h"
#include <Arduino.h>
#include "led.h"
#include "utility/clock.h"
namespace loops {
namespace {
LED* led{nullptr};
static bool ready{true};
static uint32_t starts_needed{1};
static ClockTime last_start_micros{ClockTime::zero()};
static ClockTime last_stop_micros{ClockTime::zero()};
static uint32_t overall_delay{0};
inline void updateIndicator() {
if (!led) {
return;
}
led->forceGreenIndicator(stopped());
}
} // namespace
void reset() {
ready = true;
updateIndicator();
}
bool used() {
return !ready;
}
ClockTime lastStart() {
return last_start_micros;
}
void stop() {
ready = false;
if (starts_needed++) {
return;
}
last_stop_micros = ClockTime::now();
updateIndicator();
}
void start() {
if (starts_needed-- > 1) {
return;
}
last_start_micros = ClockTime::now();
overall_delay += last_start_micros - last_stop_micros;
starts_needed = 0;
updateIndicator();
}
bool stopped() {
return starts_needed;
}
uint32_t delay() {
return overall_delay;
}
void setLedIndicator(LED* value) {
led = value;
}
} // namespace loops