- 18 Mar 2017
- 426
- 0
Bence bir sorun bulunmuyor.
2 gözlü Arduino Uno ile engelden kaçan robot yapıyorum.
2 gözlü Arduino Uno ile engelden kaçan robot yapıyorum.
Kod:
const int trig1 = 10;
const int echo1 = 8;
const int trig3 = 12;
const int echo3 = 13;
const int sol_i = 2;
const int sol_g = 3;
const int sag_i = 4;
const int sag_g = 5;
int sure1 = 0;
int mesafe1 = 0;
int sure3 = 0;
int mesafe3 = 0;
**** setup()
{
pinMode(trig1 , OUTPUT);
pinMode(echo1 , INPUT );
pinMode(trig3 , OUTPUT);
pinMode(echo3 , INPUT );
pinMode(sol_i, OUTPUT);
pinMode(sol_g, OUTPUT);
pinMode(sag_i, OUTPUT);
pinMode(sag_g, OUTPUT);
}
**** loop()
{
digitalWrite(trig1 , HIGH);
delayMicroseconds(1000);
digitalWrite(trig1 , LOW);
sure1 = pulseIn(echo1 , HIGH);
mesafe1 = (sure1 / 2) / 28.5;
digitalWrite(trig3 , HIGH);
delayMicroseconds(1000);
digitalWrite(trig3 , LOW);
sure3 = pulseIn(echo3 , HIGH);
mesafe3 = (sure3 / 2) / 28.5;
if (mesafe1 < 30 and mesafe3 > 30) {
digitalWrite(sol_i , 1);
digitalWrite(sol_g , 0);
digitalWrite(sag_i , 0);
digitalWrite(sag_g , 1);
}
if (mesafe1 > 30 and mesafe3 < 30) {
digitalWrite(sol_i , 0);
digitalWrite(sol_g , 1);
digitalWrite(sag_i , 1);
digitalWrite(sag_g , 0);
}
}