Gabriiel

/*
*Programme dévellopé par : Gab Riiel
*But : Trouvé valeur du neutre Servomoteurs
*Date : 24-01-2014
*OS : Arduino Uno
*/

//**************Déclarations******************
#include <Servo.h>
#define Contact_D 3; // Sur la patte 3
Servo Servo_Droit;
Servo Servo_Gauche;

//******************Setup************************
void setup()
{
Servo_Droit.attach(4);
Servo_Gauche.attach(5);
Serial.begin(9600);
pinMode(Contact_D, INPUT);
}

//******************Loop*************************
void loop()
{
int i=0;

while((i>=0) && (i<=180))
{
Servo_Droit.write(i);
Serial.printIn(i);
delay(2000);
i+=1;
if(digitalRead(Capteur_D) == HIGH)
{
i=666;
}
}
int y=0;

while((y>=0) && (y<=180))
{
Servo_Gauche.write(y);
Serial.printIn(y);
delay(2000);
y+=1;
if(digitalRead(Capteur_D) == HIGH)
{
y=666;
}
}
}