Repository navigation
Expand file tree
/
Copy pathStatusLED.cpp
More file actions
68 lines (57 loc) · 1.48 KB
/
Copy pathStatusLED.cpp
File metadata and controls
68 lines (57 loc) · 1.48 KB
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
#include "StatusLED.h"
#include <Arduino.h>
StatusLED::StatusLED(int pin, unsigned long shortBlinkTime,
unsigned long longBlinkTime, unsigned long blinkPause,
unsigned long pause, bool inverted):
pin(pin), inverted(inverted), shortBlinkTime(shortBlinkTime), longBlinkTime(longBlinkTime),
blinkPause(blinkPause), pause(pause), bitfield(0), indexMod(1), currentIndex(0)
{}
StatusLED::StatusLED(int pin, bool inverted):
StatusLED(pin, 200, 400, 400, 1000, inverted)
{}
void StatusLED::setOutput(bool state)
{
digitalWrite(pin, state ^ inverted);
}
void StatusLED::reset()
{
currentIndex = 0;
setOutput(false);
time = millis() + pause;
}
void StatusLED::setStatus(uint8_t status, uint8_t bitCount)
{
indexMod = 1 + 2 * bitCount;
bitfield = status;
reset();
}
/* Index:
* index == 0 -- pause between status byte blinks, skipped if bit number is not 0
* (index - 1) / 2 is current bit number
* (index - 1) % 2: pause between bits
* 0 -- on time
* 1 -- off time
*/
void StatusLED::update()
{
if (time > millis()) {
return;
}
currentIndex = (currentIndex + 1) % indexMod;
if (currentIndex == 0) { // pause
reset();
return;
}
uint8_t bitnum = (currentIndex - 1) / 2;
uint8_t state = (currentIndex - 1) % 2;
bool isLongBit = bitfield & (1 << bitnum);
unsigned long onTime = (isLongBit ? longBlinkTime : shortBlinkTime);
if (state == 0) { // on time
setOutput(true);
time = millis() + onTime;
return;
}
// off time
setOutput(false);
time = millis() + blinkPause;
}