Advertisement
safwan092

motor-control-l298D

Jan 30th, 2018
205
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.16 KB | None | 0 0
  1. int IN1 = 5;
  2. int IN2 = 6;
  3. int IN3 = 7;
  4. int IN4 = 8;
  5. int ENA = 9;
  6. int ENB = 10;
  7. void setup()
  8. {
  9.   delay(5000);
  10.   for (int i = 5; i < 11; i ++)
  11.   {
  12.     pinMode(i, OUTPUT);
  13.   }
  14. }
  15. void loop()
  16. {
  17.  
  18.   right();
  19.   delay(250);
  20.   stopM();
  21.   delay(250);
  22.   left();
  23.   delay(250);
  24.   stopM();
  25.   delay(250);
  26.   front();
  27.   delay(250);
  28.   stopM();
  29.   delay(250);
  30.   back();
  31.   delay(250);
  32.   stopM();
  33.   delay(250);
  34. }
  35.  
  36.  
  37.  
  38. void stopM() {
  39.   analogWrite(ENA, 0);
  40.   analogWrite(ENB, 0);
  41. }
  42.  
  43. void left() {
  44.   digitalWrite(IN1, 0);
  45.   digitalWrite(IN2, 1);
  46.   digitalWrite(IN3, 0);
  47.   digitalWrite(IN4, 1);
  48.   analogWrite(ENA, 255);
  49.   analogWrite(ENB, 255);
  50. }
  51.  
  52. void right() {
  53.   digitalWrite(IN1, 1);
  54.   digitalWrite(IN2, 0);
  55.   digitalWrite(IN3, 1);
  56.   digitalWrite(IN4, 0);
  57.   analogWrite(ENA, 255);
  58.   analogWrite(ENB, 255);
  59. }
  60.  
  61. void back() {
  62.   digitalWrite(IN1, 1);
  63.   digitalWrite(IN2, 0);
  64.   digitalWrite(IN3, 0);
  65.   digitalWrite(IN4, 1);
  66.   analogWrite(ENA, 150);
  67.   analogWrite(ENB, 150);
  68. }
  69.  
  70. void front() {
  71.   digitalWrite(IN1, 0);
  72.   digitalWrite(IN2, 1);
  73.   digitalWrite(IN3, 1);
  74.   digitalWrite(IN4, 0);
  75.   analogWrite(ENA, 150);
  76.   analogWrite(ENB, 150);
  77. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement