Advertisement
Guest User

Line_tracking_car

a guest
Mar 19th, 2018
185
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.37 KB | None | 0 0
  1. #define LT1 digitalRead(10)
  2. #define LT2 digitalRead(4)
  3. #define LT3 digitalRead(2)
  4.  
  5. #define ENA 5
  6. #define ENB 11
  7. #define IN1 6
  8. #define IN2 7
  9. #define IN3 8
  10. #define IN4 9
  11.  
  12. #define ABS 115
  13.  
  14. void forward(){
  15. analogWrite(ENA, ABS);
  16. analogWrite(ENB, ABS);
  17. digitalWrite(IN1, HIGH);
  18. digitalWrite(IN2, LOW);
  19. digitalWrite(IN3, LOW);
  20. digitalWrite(IN4, HIGH);
  21. Serial.println("go forward!");
  22. }
  23.  
  24. void back(){
  25. analogWrite(ENA, ABS);
  26. analogWrite(ENB, ABS);
  27. digitalWrite(IN1, LOW);
  28. digitalWrite(IN2, HIGH);
  29. digitalWrite(IN3, HIGH);
  30. digitalWrite(IN4, LOW);
  31. Serial.println("go back!");
  32. }
  33.  
  34. void left(){
  35. analogWrite(ENA, ABS);
  36. analogWrite(ENB, ABS);
  37. digitalWrite(IN1, HIGH);
  38. digitalWrite(IN2, LOW);
  39. digitalWrite(IN3, HIGH);
  40. digitalWrite(IN4, LOW);
  41. Serial.println("go left!");
  42. }
  43.  
  44. void right(){
  45. analogWrite(ENA, ABS);
  46. analogWrite(ENB, ABS);
  47. digitalWrite(IN1, LOW);
  48. digitalWrite(IN2, HIGH);
  49. digitalWrite(IN3, LOW);
  50. digitalWrite(IN4, HIGH);
  51. Serial.println("go right!");
  52. }
  53.  
  54. void stop(){
  55. digitalWrite(ENA, LOW);
  56. digitalWrite(ENB, LOW);
  57. Serial.println("Stop!");
  58. }
  59.  
  60. void setup(){
  61. Serial.begin(9600);
  62. }
  63.  
  64. void loop() {
  65. if(LT2){
  66. forward();
  67. }
  68. else if(LT1) {
  69. left();
  70. while(LT1);
  71. }
  72. else if(LT3) {
  73. right();
  74. while(LT3);
  75. }
  76. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement