#include Servo servoLeft; // Define left servo Servo servoRight; // Define right servo void setup() { servoLeft.attach(11); // Set left servo to digital pin 11 servoRight.attach(9); // Set right servo to digital pin 9 } void loop() { // Loop through motion tests forward(); // Example: move forward delay(200); // Wait 200 milliseconds reverse(); delay(200); } // Motion routines for forward, reverse and stop void forward() { servoLeft.write(40); servoRight.write(40); delay(3000); servoLeft.write(145); servoRight.write(145); } void reverse() { servoRight.write(145); servoLeft.write(145); delay(3000); servoRight.write(40); servoLeft.write(40); }