-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathDriver_Safety__Enhancement_System.ino
145 lines (125 loc) · 2.33 KB
/
Driver_Safety__Enhancement_System.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
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
#define m11 11 // rear motor
#define m12 12
#define m21 10 // front motor
#define m22 9
char str[2],i;
void forward()
{
digitalWrite(m11, LOW);
digitalWrite(m12, LOW);
digitalWrite(m21, HIGH);
digitalWrite(m22, LOW);
}
void backward()
{
digitalWrite(m11, LOW);
digitalWrite(m12, LOW);
digitalWrite(m21, LOW);
digitalWrite(m22, HIGH);
}
void left()
{
digitalWrite(m11, HIGH);
digitalWrite(m12, LOW);
delay(100);
digitalWrite(m21, HIGH);
digitalWrite(m22, LOW);
}
void right()
{
digitalWrite(m11, LOW);
digitalWrite(m12, HIGH);
delay(100);
digitalWrite(m21, HIGH);
digitalWrite(m22, LOW);
}
void Stop()
{
digitalWrite(m11, LOW);
digitalWrite(m12, LOW);
digitalWrite(m21, LOW);
digitalWrite(m22, LOW);
}
int sensorPin = A0; // select the input pin for the potentiometer
int ledPin = 8; // select the pin for the LED
int sensorValue = 0;
long time1;
boolean flag=1;
void setup()
{
Serial.begin(9600);
pinMode(m11, OUTPUT);
pinMode(m12, OUTPUT);
pinMode(m21, OUTPUT);
pinMode(m22, OUTPUT);
pinMode(ledPin, OUTPUT);
//digitalWrite(ledPin,LOW);
}
void loop()
{
while(Serial.available())
{
char ch=Serial.read();
str[i++]=ch;
if(str[i-1]=='1')
{
Serial.println("Forward");
forward();
i=0;
}
else if(str[i-1]=='2')
{
Serial.println("Left");
right();
i=0;
}
else if(str[i-1]=='3')
{
Serial.println("Right");
left();
i=0;
}
else if(str[i-1]=='4')
{
Serial.println("Backward");
backward();
i=0;
}
else if(str[i-1]=='5')
{
Serial.println("Stop");
Stop();
i=0;
}
delay(100);
}
sensorValue=analogRead(A0);
Serial.print("POT:");
Serial.println(sensorValue);
//isConstant();
//Serial.println(millis()-time1);
if(sensorValue>=460 && sensorValue<=560){
if(flag==1){
time1=millis();
flag=0;
}
if(millis()-time1>10000)
{
digitalWrite(ledPin,HIGH);
Stop();
}
}
else{
digitalWrite(ledPin,LOW);
flag=1;
}
// if(analogRead(A0)>=460 || analogRead(A0)<=560){
// digitalWrite(ledPin,HIGH);
// }else{
// digitalWrite(ledPin,LOW);
// }
}
void isConstant()
{
time1=millis();
}