// orizw katholikes metavlites gia na tis peirazw apo tis sunartiseis kai na boroun na allazoun kai timh
// orizw katholikes metavlites gia na tis peirazw apo tis sunartiseis kai na boroun na allazoun kai timh
long duration;
long duration;
int distance;
int distance;
@ -20,7 +21,10 @@ int distance_f; //apostash tou amaksiou apo antikeimeno eutheia
int distance_r; //apostash tou amaksiou apo antikeimeno deksia
int distance_r; //apostash tou amaksiou apo antikeimeno deksia
int distance_l; //apostash tou amaksiou apo antikeimeno aristera
int distance_l; //apostash tou amaksiou apo antikeimeno aristera
int maxLowDistance=20; //elaxisth apostash sthn opia ama vrethw stamataw
int maxLowDistance=20; //elaxisth apostash sthn opia ama vrethw stamataw
```
```
void setup() {
void setup() {
pinMode(trigPin, OUTPUT);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(echoPin, INPUT);
@ -35,6 +39,11 @@ myservo.write(90);
Serial.begin(9600); // Starts the serial communication
Serial.begin(9600); // Starts the serial communication
}
}
```
```
****void loop() {
****void loop() {
distance_f=ping(); //Psaxnw gia thn apostash pou exw brosta mou
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
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
@ -60,9 +69,10 @@ Serial.begin(9600); // Starts the serial communication
}
}
}
}
```
```
//thn exw gia debug ayth thn sunartisi gia na dw an leitourgei o esthitiras swsta kai an katagrafontai oi times gia tis apostaseis eutheia deksia kai aristera
//thn exw gia debug ayth thn sunartisi gia na dw an leitourgei o esthitiras swsta kai an katagrafontai oi times gia tis apostaseis eutheia deksia kai aristera
void displayDistance(){
void displayDistance(){
Serial.print("Right Distance : ");
Serial.print("Right Distance : ");
@ -76,12 +86,16 @@ void displayDistance(){
Serial.println("");
Serial.println("");
}
}
```
```
//Logo tou oloklirwmenou LM298 borw na diaxiristw kai pio eukola to amaksaki mou
//Logo tou oloklirwmenou LM298 borw na diaxiristw kai pio eukola to amaksaki mou
//exw ftiaksei 5 sunartiseis gia na boreis na pigainei brosta pisw aristera deksia kai na stamataei
//exw ftiaksei 5 sunartiseis gia na boreis na pigainei brosta pisw aristera deksia kai na stamataei
//shnarthsh gia na pigenei brosta to amaksi
//shnarthsh gia na pigenei brosta to amaksi
****void front(){
***void front(){
Serial.println("Forward Move"); //vazw se leitourgeia kai tous 4 troxous
Serial.println("Forward Move"); //vazw se leitourgeia kai tous 4 troxous
digitalWrite(lm2,HIGH);
digitalWrite(lm2,HIGH);
digitalWrite(rm2,HIGH);
digitalWrite(rm2,HIGH);
@ -126,6 +140,9 @@ digitalWrite(rm1,LOW);
digitalWrite(rm1,LOW);
digitalWrite(rm1,LOW);
digitalWrite(rm2,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
myservo.write(0); //gurnaw to servo mou deksia gia na boresei na parei metrisi o aisthitiras
@ -157,6 +174,10 @@ digitalWrite(rm1,LOW);
myservo.write(90);
myservo.write(90);
}
}
```
```
//thn xrisimopoiw gia na parw tis metriseis tou aisthitira kai na kanw thn katalili metatropi.
//thn xrisimopoiw gia na parw tis metriseis tou aisthitira kai na kanw thn katalili metatropi.