Robotica » BoBeBo (aka Insetto Robot)

/* 

    Progetto : Insetto Robot - HackLab Terni

    Andatura in avanti

    Luglio 2012

    Autore : Cristina Begliomini

*/

#include <Servo.h> 

Servo frontServo;  

Servo rearServo;  

int centerPos = 90;

int frontRightUp = 72;

int frontLeftUp = 108;

int backRightForward = 75;

int backLeftForward = 105;

void moveForward()

{

  frontServo.write(frontRightUp);

  rearServo.write(centerPos);

  delay(65);

  rearServo.write(backLeftForward);

  delay(125);

  frontServo.write(centerPos);

  delay(65);

  frontServo.write(frontLeftUp);

  rearServo.write(centerPos);

  delay(65);

  rearServo.write(backRightForward);

  delay(125);

  frontServo.write(centerPos);

  delay(65);

}

void setup()

{

  frontServo.attach(2);

  rearServo.attach(3);

}

void loop()

{

  moveForward();

}