Renk farkından faydalanarak bir çizgiyi takip eder.
Ortadaki sensör robotun çizgi üzerinde gidebilmesi için her daim çizginin üzerinde olmalıdır.
Bu koşulu sağlayana kadar tekerlekler dönmesi gereken yönde döner.
Robot kitinin içerisinde bulunan sarhoş teker burada büyük önem taşımaktadır.
Sarhoş teker sayesinde araç hareketlerini devrilmeden gerçekleştirebilir.
|
1 2 3 4 5 6 7 8 9 10 |
#define enA 7 #define enB 6 #define in1 9 #define in2 8 #define in3 11 #define in4 12 #define sol 2 #define orta 3 #define sag 4 |
Rotasyon belirlemek için sağ, sol ve orta için 0’dan başlayacak şekilde belirleme yapıyoruz.
|
1 2 3 |
int sag_s = 0; int orta_s = 0; int sol_s = 0; |
void setup() içerisinde pinMode’larını tanımlıyoruz. Sensörlerden alınan değerler ile motorlar hareket ettiği için sensörler INPUT motor pinleri OUTPUT olur.
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 |
void setup() { Serial.begin(9600); pinMode(6, OUTPUT); pinMode(7, OUTPUT); pinMode(8, OUTPUT); pinMode(9, OUTPUT); pinMode(11, OUTPUT); pinMode(12, OUTPUT); pinMode(2, INPUT); pinMode(3, INPUT); pinMode(4, INPUT); } |
İlerlemesi, sağ ve sol hareketleri için fonksiyonlar oluşturmalıyız.
|
1 2 3 4 5 6 7 8 9 10 |
void ileri() { analogWrite(enA, 200); digitalWrite(in1, 0); digitalWrite(in2, 1); analogWrite(enB, 200); digitalWrite(in3, 0); digitalWrite(in4, 1); } |
void loop() içerisinde sensörün çıkışlarını gözlemlemek için port ekranına sonuçları yazdırıyoruz.
|
1 2 3 4 5 6 7 8 9 10 |
sag_s = digitalRead(sag); Serial.print("Sağ Sensor: "); Serial.println(sag_s); orta_s = digitalRead(orta); Serial.print("Orta Sensor: "); Serial.println(orta_s); sol_s = digitalRead(sol); Serial.print("Sol Sensor: "); Serial.println(sol_s); delay(1000); |
İleri, sağ ve sol için ilerleme koşullarını ve çıktılarını if ile gerçekleştiriyoruz.
|
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 |
if(sag_s==0 && orta_s==0 && sol_s==0) { ileri(); } if(sag_s==0 && orta_s ==1 && sol_s==0) { ileri(); } if(sag_s==0 && orta_s==1 && sol_s==1) { soldon(); } if(sag_s==0 && orta_s==0 && sol_s==1) { soldon(); } if(sag_s==1 && orta_s ==1 && sol_s==0) { sagdon(); } if(sag_s==1 && orta_s==0 && sol_s==0) { sagdon(); } } |
Kodun tamamı aşağıda verilmiştir.
|
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 |
#define enA 7 #define enB 6 #define in1 9 #define in2 8 #define in3 11 #define in4 12 #define sol 2 #define orta 3 #define sag 4 int sag_s = 0; int orta_s = 0; int sol_s = 0; void setup() { Serial.begin(9600); pinMode(6, OUTPUT); pinMode(7, OUTPUT); pinMode(8, OUTPUT); pinMode(9, OUTPUT); pinMode(11, OUTPUT); pinMode(12, OUTPUT); pinMode(2, INPUT); pinMode(3, INPUT); pinMode(4, INPUT); } void loop() { sag_s = digitalRead(sag); Serial.print("Sağ Sensor: "); Serial.println(sag_s); orta_s = digitalRead(orta); Serial.print("Orta Sensor: "); Serial.println(orta_s); sol_s = digitalRead(sol); Serial.print("Sol Sensor: "); Serial.println(sol_s); delay(1000); if(sag_s==0 && orta_s==0 && sol_s==0) { ileri(); } if(sag_s==0 && orta_s ==1 && sol_s==0) { ileri(); } if(sag_s==0 && orta_s==1 && sol_s==1) { soldon(); } if(sag_s==0 && orta_s==0 && sol_s==1) { soldon(); } if(sag_s==1 && orta_s ==1 && sol_s==0) { sagdon(); } if(sag_s==1 && orta_s==0 && sol_s==0) { sagdon(); } } void ileri() { analogWrite(enA, 200); digitalWrite(in1, 0); digitalWrite(in2, 1); analogWrite(enB, 200); digitalWrite(in3, 0); digitalWrite(in4, 1); } void soldon() { analogWrite(enA, 200); digitalWrite(in1, 0); digitalWrite(in2, 1); analogWrite(enB, 200); digitalWrite(in3, 0); digitalWrite(in4, 0); } void sagdon() { analogWrite(enA, 200); digitalWrite(in1, 0); digitalWrite(in2, 0); analogWrite(enB, 200); digitalWrite(in3, 0); digitalWrite(in4, 1 ); } |