Advertisement
Guest User

BattleBot

a guest
Dec 13th, 2019
114
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.40 KB | None | 0 0
  1. const int in1 = 9;
  2. const int in2 = 8;
  3. const int in3 = 7;
  4. const int in4 = 6;
  5. const int ENA = 10;
  6. const int ENB = 5;
  7. char j;
  8. const int speed = 0;
  9.  
  10. void setup()
  11. {
  12. pinMode(in1, OUTPUT);
  13. pinMode(in2, OUTPUT);
  14. pinMode(ENA, OUTPUT);
  15. pinMode(in3, OUTPUT);
  16. pinMode(in4, OUTPUT);
  17. pinMode(ENB, OUTPUT);
  18.  
  19. Serial.begin(9600);
  20. }
  21.  
  22. void loop()
  23. {
  24. if(Serial.available())
  25. {
  26. j = Serial.read();
  27. }
  28. analogWrite(ENA, speed);
  29. analogWrite(ENB, speed);
  30.  
  31. if(j == 'U')
  32. {
  33. forward();
  34. }
  35. if(j == 'D')
  36. {
  37. backward();
  38. }
  39. if(j == 'S')
  40. {
  41. stop();
  42. }
  43. if(j == 'L')
  44. {
  45. left();
  46. }
  47. if(j == 'R')
  48. {
  49. right();
  50. }
  51. if(j == 'F')
  52. {
  53. speed = 255;
  54. }
  55. if(j == 'M')
  56. {
  57. speed = 155;
  58. }
  59.  
  60.  
  61.  
  62. }
  63.  
  64. void forward()
  65. {
  66. digitalWrite(in1, HIGH);
  67. digitalWrite(in2, LOW);
  68. digitalWrite(in3, HIGH);
  69. digitalWrite(in4, LOW);
  70. }
  71. void backward()
  72. {
  73. digitalWrite(in1, LOW);
  74. digitalWrite(in2, HIGH);
  75. digitalWrite(in3, LOW);
  76. digitalWrite(in4, HIGH);
  77. }
  78. void left()
  79. {
  80. digitalWrite(in1, LOW);
  81. digitalWrite(in2, LOW);
  82. digitalWrite(in3, HIGH);
  83. digitalWrite(in4, LOW);
  84. }
  85. void right()
  86. {
  87. digitalWrite(in1, HIGH);
  88. digitalWrite(in2, LOW);
  89. digitalWrite(in3, LOW);
  90. digitalWrite(in4, LOW);
  91. }
  92. void stop()
  93. {
  94. digitalWrite(in1, LOW);
  95. digitalWrite(in2, LOW);
  96. digitalWrite(in3, LOW);
  97. digitalWrite(in4, LOW);
  98. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement