Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define SPEED_1 5
- #define DIR_1 4
- #define SPEED_2 6
- #define DIR_2 7
- #define LINE_L 9
- #define LINE_R 8
- void setup()
- {
- pinMode(SPEED_1, OUTPUT);
- pinMode(DIR_1, OUTPUT);
- pinMode(SPEED_2 , OUTPUT);
- pinMode(DIR_2, OUTPUT);
- delay(5000);
- }
- void loop(){
- goL();goR();
- if ((digitalRead(LINE_L) == HIGH) and (digitalRead(LINE_R)) == HIGH){
- TURN();}
- }
- void goL()
- {
- digitalWrite(DIR_1, LOW);
- analogWrite(SPEED_1, 50);
- }
- void goR(){
- digitalWrite(DIR_2, LOW);
- analogWrite(SPEED_2, 50);}
- void TURN(){
- goL();
- delay(4500);}
Advertisement
Add Comment
Please, Sign In to add comment