Advertisement
Ruslan_nig

simpleStopZagotovka

Mar 29th, 2022
2,184
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. int leftLinePin = 10;  //на pin 10 подключается датчик чёрной линии
  2. int rightLinePin = 11; //на pin 10 подключается датчик чёрной линии
  3. int leftDirPin = 4;    //pin 4 управляет направлением вращения колеса
  4. int leftSpeedPin = 5;  //pin 5 управляет скоростью вращения колеса
  5. int rightDirPin = 7;   //pin 7 управляет направлением вращения колеса
  6. int rightSpeedPin = 6; //pin 6 управляет скоростью вращения колеса
  7. int runSpeed = 40;     //величина скорости вращения оптимально от 30 до 100
  8.  
  9. void setup() {         //устанавливаем режим работы pin 4,5,6,7
  10.     pinMode(leftDirPin, OUTPUT);
  11.     pinMode(leftSpeedPin, OUTPUT);
  12.     pinMode(rightDirPin, OUTPUT);
  13.     pinMode(rightSpeedPin, OUTPUT);  }
  14.  
  15. void loop()   {
  16.     boolean whiteLeft = digitalRead(leftLinePin); // Считываем данные с сенсоров
  17.     boolean whiteRight = digitalRead(rightLinePin);
  18.  
  19.     if (whiteLeft==0 && whiteRight==0)   // или==1 для некоторых датчиков
  20.     {
  21.     digitalWrite(leftDirPin, HIGH);
  22.     /*  здесь надо добавить код   */
  23.     analogWrite(rightSpeedPin, runSpeed);
  24.     }
  25.    
  26.     else {
  27.      /*  здесь надо добавить код  */  
  28.     }  
  29. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement