-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathlightFunctions.cpp
116 lines (104 loc) · 3.68 KB
/
lightFunctions.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
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
/************************************
* Copyright (C) 2020 Marina Egner <[email protected]>
*
* This program is free software: you can redistribute it and/or modify it
* under the terms of the GNU General Public License as published by the
* Free Software Foundation, either version 3 of the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY;
* without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
* See the GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License along with this program.
* If not, see <https://www.gnu.org/licenses/>.
************************************/
#include "lightFunctions.h"
#include "tools.h"
#include <SoftPWM.h> // https://github.com/bhagman/SoftPWM
Blink flasher[3];
bool directlyToOutput(bool lightState) {
return lightState;
}
bool highBeamFlash(bool lightState, bool lightFlashState, uint16_t flashFrequency) {
if(lightState) return true;
if(lightFlashState) return flasher[0].blink(flashFrequency);
// else then reset
flasher[0].resetBlink();
return false;
}
void setFlasherLight(bool leftFlasherState, bool rightFlasherState, bool hazardState, bool* outLeftLight, bool* outRightLight, uint16_t flashFrequency) {
if(hazardState) {
bool blinkerState = flasher[1].blink(flashFrequency);
*outLeftLight = blinkerState;
*outRightLight = blinkerState;
} else if(leftFlasherState) {
*outLeftLight = flasher[1].blink(flashFrequency);
*outRightLight = false;
} else if(rightFlasherState) {
*outLeftLight = false;
*outRightLight = flasher[1].blink(flashFrequency);
} else if((*outLeftLight || *outRightLight) && !flasher[1].blink(flashFrequency)) {
*outLeftLight = false;
*outRightLight = false;
} else if (!*outLeftLight && !*outRightLight) {
flasher[1].resetBlink();
}
}
void initLightOutput() {
SoftPWMBegin(); //Init Soft PWM Lib
}
void setupLightOutput(uint8_t pin, uint16_t fadeOnTime, uint16_t fadeOffTime) {
SoftPWMSet(pin, SOFT_PWM_LOW); //Create and set pin to 0
SoftPWMSetFadeTime(pin, fadeOnTime, fadeOffTime); //Set Fade on/off time for output
}
void setBooleanLight(uint8_t pin, bool state, uint8_t highValue = SOFT_PWM_HIGH) {
if(state) SoftPWMSet(pin, highValue);
if(!state) SoftPWMSet(pin, SOFT_PWM_LOW);
}
void setCombinedHeadlightAll(uint8_t pin,
uint8_t parkingState,
uint8_t lowBeamState,
uint8_t highBeamState,
uint8_t parkingOutValue,
uint8_t lowBeamOutValue,
uint8_t highBeamOutValue) {
if(highBeamState) {
SoftPWMSet(pin, highBeamOutValue);
} else if(lowBeamState) {
SoftPWMSet(pin, lowBeamOutValue);
} else if(parkingState) {
SoftPWMSet(pin, parkingOutValue);
} else {
SoftPWMSet(pin, SOFT_PWM_LOW);
}
}
void setCombinedHeadlightHighOnly(uint8_t pin,
uint8_t lowBeamState,
uint8_t highBeamState,
uint8_t lowBeamOutValue,
uint8_t highBeamOutValue) {
if(highBeamState) {
SoftPWMSet(pin, highBeamOutValue);
} else if(lowBeamState) {
SoftPWMSet(pin, lowBeamOutValue);
} else {
SoftPWMSet(pin, SOFT_PWM_LOW);
}
}
void setCombinedHeadlightParkOnly(uint8_t pin,
uint8_t parkingState,
uint8_t lowBeamState,
uint8_t parkingOutValue,
uint8_t lowBeamOutValue) {
if(lowBeamState) {
SoftPWMSet(pin, lowBeamOutValue);
} else if(parkingState) {
SoftPWMSet(pin, parkingOutValue);
} else {
SoftPWMSet(pin, SOFT_PWM_LOW);
}
}
uint8_t starterDimming(bool active, uint8_t defaultDimValue, uint8_t divisor, uint8_t multiplier1) {
if(!active) return defaultDimValue;
if(active) return defaultDimValue / divisor * multiplier1;
}