edit: my bad it says backward is not declared
#include <Servo.h>
Servo servoLeft;
Servo servoRight;
void setup()
{
pinMode(7, INPUT);
pinMode(5, INPUT);
tone(4, 3000, 1000);
delay(1000);
servoLeft.attach(11);
servoRight.attach(10); }
void loop()
{
byte wLeft = digitalRead(5);
byte wRight = digitalRead(7);
if((wLeft == 0) && (wRight == 0))
{
backward(1000);
turnLeft(800);
}
else if(wLeft == 0)
{
backward(1000);
turnRight(400);
}
else if(wRight == 0)
{
backward(1000);
turnLeft(400);
}
else
{
forward(20);
}
}
void forward(int time)
{
servoLeft.writeMicroseconds(1700);
servoRight.writeMicroseconds(1300);
delay(time);
}
void turnLeft(int time)
servoLeft.writeMicroseconds(1300);
servoRight.writeMicroseconds(1300);
delay(time); }
// Maneuver for time ms
void turnRight(int time) // Right turn function
{
servoLeft.writeMicroseconds(1700);
servoRight.writeMicroseconds(1700);
delay(time); }
void backward(int time) // Backward function
{
servoLeft.writeMicroseconds(1300);
servoRight.writeMicroseconds(1700);
delay(time);
}