const int sensorpin1=3;
const int sensorpin2=4;
const int mot1A = 7;
const int mot1B = 8;
const int mot2A = 5;
const int mot2B = 6;
int sense1 = 0;
int sense2 = 0;
void botForward(){
digitalWrite(mot1A, HIGH);
digitalWrite(mot1B, LOW);
digitalWrite(mot2A, HIGH);
digitalWrite(mot2B, LOW);
}
void botBackward(){
digitalWrite(mot1A, 0);
digitalWrite(mot1B, 1);
digitalWrite(mot2A, 0);
digitalWrite(mot2B, 1);
}
void botTurnLeft(){
digitalWrite(mot1A, 0);
digitalWrite(mot1B, 1);
digitalWrite(mot2A, 1);
digitalWrite(mot2B, 0);
}
void botTurnRight(){
digitalWrite(mot1A, 1);
digitalWrite(mot1B, 0);
digitalWrite(mot2A, 0);
digitalWrite(mot2B, 1);
}
void botStop(){
digitalWrite(mot1A, 0);
digitalWrite(mot1B, 0);
digitalWrite(mot2A, 0);
digitalWrite(mot2B, 0);
}
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
pinMode(sensorpin1, INPUT);
pinMode(sensorpin2, INPUT);
}
void loop() {
// put your main code here, to run repeatedly:
// Serial.print("sensor 1 : ");
// Serial.println(digitalRead(sensorpin1));
// Serial.print("sensor 2 : ");
// Serial.println(digitalRead(sensorpin2));
sense1 = digitalRead(3);
sense2 = digitalRead(4);
if(sense1 && sense2){
botForward();
}else if((sense1)){
botTurnRight();
}else if(sense2){
botTurnLeft();
}else{
botBackward();
}
}