Al_Ninyo

Ultrabot

Apr 5th, 2015
272
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.13 KB | None | 0 0
  1. #include <Ultrasonic.h> // подключаем библиотеку для работы с ультразвуковым датчиком
  2.  
  3. Ultrasonic ultraPin(6,7);   // (Trig PIN,Echo PIN)
  4.  
  5. #include <Servo.h> // подключаем библиотеку для работы с серводвигателями
  6.  
  7. Servo leftServo;  // создаём объект "левый двигатель"
  8. Servo rightServo;  // создаём объект "правый двигатель"
  9.      
  10. void setup()
  11. {
  12.   Serial.begin(9600);
  13.   leftServo.attach(10);  // подключаем левый двигательк 10 пину
  14.   rightServo.attach(9); // подключаем правый двигатель к 9 пину
  15. }
  16.  
  17. void loop()
  18. {
  19.   if (ultraPin.Ranging(CM) < 20) {
  20.     leftServo.write(70); // команда для левого мотора
  21.     rightServo.write(60); // команда для правого мотора
  22.     delay(1200);
  23.   } else {
  24.     leftServo.write(60); // команда для левого мотора
  25.     rightServo.write(180); // команда для правого мотора
  26.   }
  27.   delay(100);
  28. }
Add Comment
Please, Sign In to add comment