Advertisement
Hitamputih07

LINE FOLLOWER

Aug 31st, 2020
3,359
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #define sensorKiri 4
  2. #define sensorKanan 2
  3.  
  4. #define motorKiri_1 11
  5. #define motorKiri_2 10
  6. #define motorKanan_2 8
  7. #define motorKanan_1 9
  8.  
  9. #define motorKiri 6
  10. #define motorKanan 5
  11.  
  12. int vnormal = 60;
  13. int vbelok = 90;
  14.  
  15. void setup()
  16. {
  17.     Serial.begin(9600);
  18.     pinMode(sensorKiri, INPUT);
  19.     pinMode(sensorKanan, INPUT);
  20.  
  21.     pinmode(motorKiri_1, OUTPUT);
  22.     pinmode(motorKiri_2, OUTPUT);
  23.  
  24.     pinmode(motorKanan_2, OUTPUT);
  25.     pinmode(motorKanan_1, OUTPUT);
  26.  
  27.     pinmode(motorKanan, OUTPUT);
  28.     pinmode(motorKiri, OUTPUT);
  29. }
  30.  
  31. void loop()
  32. {
  33.     if(digitalRead(sensorKiri) && digitalRead(sensorKanan))
  34.     {
  35.     digitalWrite(motorKiri_1, LOW);
  36.     digitalWrite(motorKiri_2, LOW);
  37.     digitalWrite(motorKanan_1, LOW);
  38.     digitalWrite(motorKanan_2, LOW);
  39.     Serial.println("Berhenti");
  40.     delay(10);
  41.     }
  42. }
  43. if(!(digitalRead(sensorKiri)) && digitalRead(sensorKanan))
  44. {
  45.     digitalWrite(motorKiri_1, HIGH);
  46.     digitalWrite(motorKiri_2, LOW);
  47.  
  48.     digitalWrite(motorKanan_1, LOW);
  49.     digitalWrite(motorKanan_2, LOW);
  50.  
  51.     analogWrite(motorKiri, vbelok);
  52.     analogWrite(motorKanan, vnormal);
  53.  
  54.     delay(10);
  55.     Serial.println("Belok kanan");
  56. }
  57. if(digitalRead(sensorKiri) && !(digitalRead(sensorKanan)))
  58. {
  59.     digitalWrite(motorKiri_1, LOW);
  60.     digitalWrite(motorKiri_2, LOW);
  61.  
  62.     digitalWrite(motorKanan_1, HIGH);
  63.     digitalWrite(motorKanan_2, LOW);
  64.  
  65.     analogWrite(motorKiri, vnormal);
  66.     analogWrite(motorKanan, vbelok);
  67.  
  68.     delay(10);
  69.     Serial.println("Belok kiri");
  70. }
  71. if(!(digitalRead(sensorKiri)) && digitalRead(sensorKanan))
  72. {
  73.     digitalWrite(motorKiri_1, HIGH);
  74.     digitalWrite(motorKiri_2, LOW);
  75.  
  76.     digitalWrite(motorKanan_1, HIGH);
  77.     digitalWrite(motorKanan_2, LOW);
  78.  
  79.     analogWrite(motorKiri, vnormal);
  80.     analogWrite(motorKanan, vnormal);
  81.  
  82.     delay(10);
  83.     Serial.println("maju");
  84. }
  85. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement