Advertisement
Ruslan_nig

RobotArduino1

Dec 10th, 2018
237
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #define SPEED_1      5
  2. #define DIR_1        4
  3.  
  4. #define SPEED_2      6
  5. #define DIR_2        7
  6.  
  7. #define LINE_L       9
  8. #define LINE_R       8
  9. void setup()
  10. {
  11.   pinMode(SPEED_1, OUTPUT);
  12.   pinMode(DIR_1, OUTPUT);
  13.   pinMode(SPEED_2 , OUTPUT);
  14.   pinMode(DIR_2, OUTPUT);
  15.   delay(5000);
  16.  
  17.  
  18.  
  19.  
  20. }
  21. void loop(){
  22.   goL();goR();
  23.   if ((digitalRead(LINE_L) == HIGH) and (digitalRead(LINE_R)) == HIGH){
  24.     TURN();}
  25.   }
  26. void goL()
  27. {
  28.   digitalWrite(DIR_1, LOW);
  29.   analogWrite(SPEED_1, 50);
  30. }
  31. void goR(){
  32.   digitalWrite(DIR_2, LOW);
  33.   analogWrite(SPEED_2, 50);}
  34. void TURN(){
  35.    goL();
  36.   delay(4500);}
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement