Advertisement
roctbb

BotLine

May 15th, 2015
230
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.39 KB | None | 0 0
  1. int IN3 = 3; // Input3 подключен к выводу 5
  2. int IN4 = 4;
  3. int IN1 = 1; // Input3 подключен к выводу 5
  4. int IN2 = 2;
  5.  
  6. int lineLeft = 12;
  7. int lineCenter = 0;
  8. int lineRight = 7;
  9. void setup()
  10. {
  11.   pinMode (IN4, OUTPUT);
  12.   pinMode (IN3, OUTPUT);
  13.     pinMode (IN1, OUTPUT);
  14.   pinMode (IN2, OUTPUT);
  15.   pinMode(lineLeft, INPUT);
  16.   pinMode(lineCenter, INPUT);
  17.   pinMode(lineRight, INPUT);
  18. }
  19. //HIGH - black
  20. void loop()
  21. {
  22.  if (digitalRead(lineCenter) == HIGH && digitalRead(lineLeft) == LOW && digitalRead(lineRight) == LOW)
  23.  {
  24.   // На пару выводов "IN" поданы разноименные сигналы, мотор вращается  
  25.   digitalWrite (IN4, HIGH);
  26.   digitalWrite (IN3, LOW);
  27.     digitalWrite (IN1, HIGH);
  28.   digitalWrite (IN2, LOW);
  29.  }
  30.   if (digitalRead(lineLeft) == HIGH)
  31.  {
  32.   // На пару выводов "IN" поданы разноименные сигналы, мотор вращается  
  33.   digitalWrite (IN4, HIGH);
  34.   digitalWrite (IN3, LOW);
  35.     digitalWrite (IN1, LOW);
  36.   digitalWrite (IN2, LOW);
  37.  }
  38.  if (digitalRead(lineRight) == HIGH)
  39.  {
  40.   // На пару выводов "IN" поданы разноименные сигналы, мотор вращается  
  41.   digitalWrite (IN4, LOW);
  42.   digitalWrite (IN3, LOW);
  43.     digitalWrite (IN1, HIGH);
  44.   digitalWrite (IN2, LOW);
  45.  }
  46.  
  47.   }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement