Advertisement
safwan092

Untitled

Mar 27th, 2022
74
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.13 KB | None | 0 0
  1. #define ENA 3 //must be PWM (~)
  2. #define IN1 4
  3. #define IN2 5
  4. #define IN3 6
  5. #define IN4 7
  6. #define ENB 9 //must be PWM (~)
  7.  
  8.  
  9. void setup() {
  10. Serial.begin(9600);
  11. pinMode(ENA, OUTPUT);
  12. pinMode(IN1, OUTPUT);
  13. pinMode(IN2, OUTPUT);
  14. pinMode(IN3, OUTPUT);
  15. pinMode(IN4, OUTPUT);
  16. pinMode(ENB, OUTPUT);
  17. analogWrite(ENA, 80); //0-255
  18. analogWrite(ENB, 80); //0-255
  19. stopp();
  20. }
  21.  
  22. void loop() {
  23. front();
  24. delay(1000);
  25. back();
  26. delay(1000);
  27. left();
  28. delay(1000);
  29. right();
  30. delay(1000);
  31. stopp();
  32. delay(1000);
  33. }
  34.  
  35. void front() {
  36. digitalWrite(IN1, 1);
  37. digitalWrite(IN2, 0);
  38. digitalWrite(IN3, 1);
  39. digitalWrite(IN4, 0);
  40. }
  41.  
  42. void back() {
  43. digitalWrite(IN1, 0);
  44. digitalWrite(IN2, 1);
  45. digitalWrite(IN3, 0);
  46. digitalWrite(IN4, 1);
  47. }
  48.  
  49. void left() {
  50. digitalWrite(IN1, 1);
  51. digitalWrite(IN2, 0);
  52. digitalWrite(IN3, 0);
  53. digitalWrite(IN4, 1);
  54. }
  55.  
  56. void right() {
  57. digitalWrite(IN1, 0);
  58. digitalWrite(IN2, 1);
  59. digitalWrite(IN3, 1);
  60. digitalWrite(IN4, 0);
  61. }
  62.  
  63. void stopp() {
  64. digitalWrite(IN1, 0);
  65. digitalWrite(IN2, 0);
  66. digitalWrite(IN3, 0);
  67. digitalWrite(IN4, 0);
  68. }
  69.  
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement