Here's a top view of the servos.
FRONT
Dis Cont Servo
Cont Servo FL Cont Servo FR
ROBOT
Cont Servo BL Cont Servo BR
BACK
We taped the ultrasonic sensor on the dis cont servo and it looks in the forward direction.
The task is to avoid obstacles. We want to make the robot move forward while detecting for objects with the ultrasonic sensor. If the sensor reports back a float < a certain amount, then we will turn the robot and get around the obstacle.
The way we want to do it is as follows:
If object is detected, turn robot left, turn dis cont servo so sensor is facing the obstacle. Move forward as long as sensor is giving back a float < a certain amount. Once the float is > that amount(we moved pass the obstacle), turn right and continue moving forward.
I think the biggest problem we have is we don't understand how to move forward using the write() functions. Does Servo.write(180) tell the servo to go in the forward direction at full speed? How do you specify how long you want it to move int that direction for? We thought that was the purpose of the delay() function.
We are designing the field ourselves, so we can place the obstacles however we want.
Thanks for the warm response.