User Tools

Site Tools


2linearmotors-code
#include <Servo.h>

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);
}
2linearmotors-code.txt · Last modified: 2012/09/09 20:35 by 81.10.136.85