Advertisement
Guest User

Untitled

a guest
Nov 12th, 2019
71
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.85 KB | None | 0 0
  1.  
  2.  
  3.  
  4. #define LS 10 // left sensor <ir ko output>
  5. #define RS 11 // right sensor <ir ko output>
  6.  
  7.  
  8. #define LM1 4 // left motor <positive>
  9. #define LM2 5 // left motor < black / negative >
  10. #define RM1 6 // right motor <positive>
  11. #define RM2 7 // right motor < black / negative >
  12.  
  13.  
  14. #define led 13
  15. void setup()
  16. {
  17.  
  18. Serial.begin(9600);
  19. pinMode(LS, OUTPUT);
  20. pinMode(RS, OUTPUT);
  21.  
  22. digitalWrite(LS, LOW);
  23. digitalWrite(RS, LOW);
  24.  
  25. delay(100);
  26.  
  27. pinMode(LS, INPUT);
  28. pinMode(RS, INPUT);
  29.  
  30. pinMode(LM1, OUTPUT);
  31. pinMode(LM2, OUTPUT);
  32. pinMode(RM1, OUTPUT);
  33. pinMode(RM2, OUTPUT);
  34.  
  35. pinMode(led, OUTPUT);
  36.  
  37. digitalWrite(led, HIGH);
  38. }
  39.  
  40. void loop()
  41. {
  42.  
  43. Serial.println("Car is ready.");
  44. //duitai ma 1 aayo vane yo hune.
  45. if(digitalRead(LS) && digitalRead(RS)) // Move Forward
  46. {
  47.  
  48. Serial.println("Car is going forward");
  49. digitalWrite(LM1, HIGH);
  50. digitalWrite(LM2, LOW);
  51. digitalWrite(RM1, HIGH);
  52. digitalWrite(RM2, LOW);
  53.  
  54.  
  55.  
  56. }
  57. //left ko ma 0 aayo vane yo garne
  58. if(!(digitalRead(LS)) && digitalRead(RS)) // Turn right
  59. {
  60. Serial.println("Car is going right");
  61. digitalWrite(LM1, LOW);
  62. digitalWrite(LM2, LOW);
  63. digitalWrite(RM1, HIGH);
  64. digitalWrite(RM2, LOW);
  65. }
  66. //right ko ma 0 aayo vane yo garne
  67. if(digitalRead(LS) && !(digitalRead(RS))) // turn left
  68. {
  69. Serial.println("Car is going left");
  70. digitalWrite(LM1, HIGH);
  71. digitalWrite(LM2, LOW);
  72. digitalWrite(RM1, LOW);
  73. digitalWrite(RM2, LOW);
  74. }
  75.  
  76. //kunai pani direction ma xaina vane yo hos
  77. if(!(digitalRead(LS)) && !(digitalRead(RS))) // stop
  78. {
  79. Serial.println("Car is stopping");
  80. digitalWrite(LM1, LOW);
  81. digitalWrite(LM2, LOW);
  82. digitalWrite(RM1, LOW);
  83. digitalWrite(RM2, LOW);
  84. }
  85.  
  86. delay(100);
  87. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement