#define LS 2 // left sensor #define RS 3 // right sensor #define LM1 4 // left motor #define LM2 5 // left motor #define RM1 6 // right motor #define RM2 7 // right motor void setup() { pinMode(LS, INPUT); pinMode(RS, INPUT); pinMode(LM1, OUTPUT); pinMode(LM2, OUTPUT); pinMode(RM1, OUTPUT); pinMode(RM2, OUTPUT); } void loop() { if(digitalRead(LS) && digitalRead(RS)) / / Move Forward { digitalWrite(LM1, HIGH); digitalWrite(LM2, LOW); digitalWrite(RM1, HIGH); digitalWrite(RM2, LOW); } if(!(digitalRead(LS)) && digitalRead(RS)) // Turn right { digitalWrite(LM1, HIGH); digitalWrite(LM2, LOW); digitalWrite(RM1, LOW); digitalWrite(RM2, LOW); ...
Comments
Post a Comment