Advertisement
safwan092

test-motors+LED-on-pin13

Feb 13th, 2018
180
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.29 KB | None | 0 0
  1.  
  2.  
  3. #define LEDPin 13 // Onboard LED
  4.  
  5. int IN1 = 5;
  6. int IN2 = 6;
  7. int IN3 = 7;
  8. int IN4 = 8;
  9. int ENA = 9;
  10. int ENB = 10;
  11.  
  12. void setup() {
  13.  
  14.   delay(5000);
  15.  
  16.   for (int i = 5; i < 11; i ++)
  17.   {
  18.     pinMode(i, OUTPUT);
  19.   }
  20.   pinMode(LEDPin, OUTPUT); // Use LED indicator (if required)
  21.  
  22. }
  23.  
  24. void loop() {
  25.  
  26.   digitalWrite(LEDPin, HIGH);
  27.   back();
  28.   delay(500);
  29.   left();
  30.   delay(500);
  31.   right();
  32.   delay(500);
  33.   front();
  34.   delay(500);
  35.   stopM();
  36.   digitalWrite(LEDPin, LOW);
  37.   delay(2000);
  38.  
  39. }
  40.  
  41.  
  42.  
  43.  
  44.  
  45.  
  46.  
  47.  
  48.  
  49.  
  50.  
  51.  
  52.  
  53.  
  54.  
  55.  
  56.  
  57.  
  58.  
  59.  
  60.  
  61. void stopM() {
  62.   analogWrite(ENA, 0);
  63.   analogWrite(ENB, 0);
  64. }
  65.  
  66. void right() {
  67.   digitalWrite(IN1, 0);
  68.   digitalWrite(IN2, 1);
  69.   digitalWrite(IN3, 0);
  70.   digitalWrite(IN4, 1);
  71.   analogWrite(ENA, 255);
  72.   analogWrite(ENB, 255);
  73. }
  74.  
  75. void left() {
  76.   digitalWrite(IN1, 1);
  77.   digitalWrite(IN2, 0);
  78.   digitalWrite(IN3, 1);
  79.   digitalWrite(IN4, 0);
  80.   analogWrite(ENA, 255);
  81.   analogWrite(ENB, 255);
  82. }
  83.  
  84. void front() {
  85.   digitalWrite(IN1, 1);
  86.   digitalWrite(IN2, 0);
  87.   digitalWrite(IN3, 0);
  88.   digitalWrite(IN4, 1);
  89.   analogWrite(ENA, 150);
  90.   analogWrite(ENB, 150);
  91. }
  92.  
  93. void back() {
  94.   digitalWrite(IN1, 0);
  95.   digitalWrite(IN2, 1);
  96.   digitalWrite(IN3, 1);
  97.   digitalWrite(IN4, 0);
  98.   analogWrite(ENA, 150);
  99.   analogWrite(ENB, 150);
  100. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement