-
Notifications
You must be signed in to change notification settings - Fork 0
/
main.ino
116 lines (94 loc) · 1.85 KB
/
main.ino
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
#include <Servo.h>
#include <ezButton.h>
// pins
const int buzzerPin = 9;
const int emergencyButtonPin = 8;
const int servoPin = 3;
const int lightSwitchPin = 4;
// variables
int onAngle;
int offAngle;
Servo servo; // create servo object to control a servo
ezButton lightButton(lightSwitchPin);
bool lightState;
bool previousLightState = LOW;
// calibration
const int offsetAngle = 25;
const int parkAngle = 90;
void setup()
{
onAngle = parkAngle + offsetAngle;
offAngle = parkAngle - offsetAngle;
lightButton.setDebounceTime(50); // set debounce time to 50 milliseconds
servo.attach(servoPin);
servo.write(parkAngle);
}
void loop()
{
lightButton.loop(); // MUST call the loop() function first
if (lightButton.isPressed())
{
lightState = !lightState;
}
if (!goalReached())
{
handle();
}
previousLightState = lightState;
}
void handle() {
if (lightState)
{
turnOffLights();
}
else {
turnOnLights();
}
delay(250);
servo.write(parkAngle);
}
bool goalReached() {
return previousLightState == lightState;
}
bool lightsToggled()
{
return digitalRead(lightSwitchPin) != previousLightState;
}
void toggleLights()
{
lightState = !lightState;
if (lightState)
{
turnOnLights();
}
else
{
turnOffLights();
}
servo.write(parkAngle);
}
bool emergency()
{
return digitalRead(emergencyButtonPin);
}
void performEmergencyMeasures()
{
blareAlarm();
}
void blareAlarm()
{
tone(buzzerPin, 1000); // Send 1KHz sound signal...
delay(1000); // ...for 1 sec
noTone(buzzerPin); // Stop sound...
delay(1000); // ...for 1sec
}
void turnOnLights()
{
Serial.println("ON");
servo.write(onAngle);
}
void turnOffLights()
{
Serial.println("OFF");
servo.write(offAngle);
}