Serial.begin(9600); // Starts the serial communication
}
void loop() {
****void loop() {
distance_f=ping(); //Psaxnw gia thn apostash pou exw brosta mou
if(distance_f > maxLowDistance){ //An einai megaluteri apo 20cm h apostash tou amaksiou apo to prwto ebodio (diladi thn elaxisth apostash pou tou exw orisei) tote tha paei eutheia
displayDistance(); //to kanw gia na kanw debug kai na kserw oti leitourgei o aisthititras apostashs
@ -78,7 +78,7 @@ void displayDistance(){
//exw ftiaksei 5 sunartiseis gia na boreis na pigainei brosta pisw aristera deksia kai na stamataei
//shnarthsh gia na pigenei brosta to amaksi
void front(){
****void front(){
Serial.println("Forward Move"); //vazw se leitourgeia kai tous 4 troxous
digitalWrite(lm2,HIGH);
digitalWrite(rm2,HIGH);
@ -89,7 +89,7 @@ digitalWrite(rm1,LOW);
//shnarthsh gia na pigenei pisw to amaksi
void back(){
****void back(){
Serial.println("Back Move"); //vazw se leitourgeia kai tous 4 troxous alla antistrefw thn polikothta gia na paei pros ta pisw
digitalWrite(lm1,HIGH);
digitalWrite(rm1,HIGH);
@ -99,7 +99,7 @@ void back(){
//shnarthsh gia na pigenei aristera to amaksi
void left(){
****void left(){
digitalWrite(rm2,HIGH); //vazw se leitourgeia mono tous dyo deksious troxous
digitalWrite(rm1,LOW);
digitalWrite(lm1,HIGH);
@ -108,7 +108,7 @@ void left(){
//shnarthsh gia na pigenei deksia to amaksi
void right(){
****void right(){
digitalWrite(lm2,HIGH); //vazw se leitourgeia mono tous dyo aristerous troxous
digitalWrite(lm1,LOW);
digitalWrite(rm1,HIGH);
@ -117,14 +117,14 @@ void right(){
//shnarthsh gia na pigenei stamataei to amaksi
void Break(){
****void Break(){
digitalWrite(lm2,LOW); //vgazw apo thn leitourgeia kai tous 4 troxous
digitalWrite(lm1,LOW);
digitalWrite(rm1,LOW);
digitalWrite(rm2,LOW);
}
void get_Distance(){
****void get_Distance(){
myservo.write(0); //gurnaw to servo mou deksia gia na boresei na parei metrisi o aisthitiras
delay(500);
int temp_r1=ping(); //pernw thn apostash deksia mou
@ -155,7 +155,7 @@ void get_Distance(){
}
//thn xrisimopoiw gia na parw tis metriseis tou aisthitira kai na kanw thn katalili metatropi.