/// diego colonnello botico//
///14 de octubre 2010 ///#include <Servo.h>
Servo servocentro;
Servo servoderecho;
Servo servoizquierdo;
int sensorPin = 2; // pin de entrada sensor sharp
int distancia = 300;void setup()
{
Serial.begin(9600);
servocentro.attach(8); //conecta el servo del sensor al pin 8
servoderecho.attach(10); // conecta el servo derecho al pin 10
servoizquierdo.attach(9); // conecta el servo izquierdo al pin 9}
void loop()
{Serial.println(analogRead(2));
{
if (analogRead(2) <= distancia)
{
adelante();
}
if (analogRead(2) > distancia)
{girar_iz(); // muevete girando
}
}}
//funciones de caminar//
// camina hacia adelante//
void adelante()
{
servoderecho.write(0);
servoizquierdo.write(180);
}//camina retrocediendo
void atras()
{
servoderecho.write(180);
servoizquierdo.write(0);}
//gira el cuerpo
void girar_iz()
{
servoderecho.write(180);
servoizquierdo.write(180);
delay(500);
}void girar_der()
{
servoderecho.write(0);
servoizquierdo.write(0);
}