Advertisement
andretafta

Line Follower Arduino L293D

Jul 8th, 2023
727
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Arduino 1.32 KB | Software | 0 0
  1. //Robot line follower by AJTekno
  2. #include <AFMotor.h>
  3. const int pinSensorKiri = A0;
  4. const int pinSensorKanan = A1;
  5.  
  6. char val;
  7. AF_DCMotor motor1(4, MOTOR12_64KHZ); //Jadikan motor kanan, 64KHZ
  8. AF_DCMotor motor2(3, MOTOR12_64KHZ); //Jadikan motor kiri, 642hHZ
  9.  
  10. void setup() {
  11.   // put your setup code here, to run once:
  12. Serial.begin (9600);
  13. pinMode (pinSensorKiri, INPUT);
  14. pinMode (pinSensorKanan, INPUT);
  15. motor1.setSpeed(180); //Set kecepatan motor 1 240 (range 0-255)
  16. motor2.setSpeed(180); //Set kecepatan motor 2 240 (range 0-255)
  17. }
  18.  
  19. void loop() {
  20.   // put your main code here, to run repeatedly:
  21. int dataAnalog1 = digitalRead (pinSensorKiri);
  22. int dataAnalog2 = digitalRead (pinSensorKanan);
  23. Serial.print ("Sensor : ");
  24. Serial.print (dataAnalog1);
  25. Serial.print (", Sensor : ");
  26. Serial.print (dataAnalog2);
  27.  
  28. if (dataAnalog1 == 0 && dataAnalog2 == 0) {
  29.   motor1.run(FORWARD); //Motor kanan maju
  30.   motor2.run(FORWARD); //Motor kiri maju
  31. }
  32. else if(dataAnalog1 == 0 && dataAnalog2 == 1) {
  33.   motor1.run(BACKWARD); //Motor kanan mundur
  34.   motor2.run(FORWARD); //Motor kiri maju
  35. }
  36. else if(dataAnalog1 == 1 && dataAnalog2 == 0){
  37.   motor1.run(FORWARD); //Motor kanan maju
  38.   motor2.run(BACKWARD); //Motor kiri mundur
  39. }
  40. else {
  41.   motor1.run(RELEASE); //Motor kanan berhenti
  42.   motor2.run(RELEASE); //Motor kiri berhenti
  43. }
  44. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement