This is full code
int FWPin = 3;
int BWPin = 4;
int SpeedPin = 5;
int StopPin = 6;
void setup()
{
pinMode(FWPin,OUTPUT);
pinMode(BWPin,OUTPUT);
pinMode(SpeedPin,OUTPUT);
pinMode(StopPin,OUTPUT);
pinMode(2,INPUT);
pinMode(8,INPUT);
pinMode(9,INPUT);
}
void loop()
{
if (digitalRead(9) == LOW)
{
digitalWrite(FWPin,HIGH);
delay(2000);
digitalWrite(FWPin,LOW);
digitalWrite(BWPin,HIGH);
if (digitalRead(9) == HIGH)
{
digitalWrite(BWPin,LOW);
}
}
if (digitalRead(2) == HIGH)
{
digitalWrite(FWPin,HIGH);
delay(5000);
digitalWrite(FWPin,LOW);
digitalWrite(FWPin,HIGH);
digitalWrite(SpeedPin,HIGH);
delay(2000);
digitalWrite(FWPin,LOW);
delay(3000);
digitalWrite(BWPin,HIGH);
delay(2000);
digitalWrite(BWPin,LOW);
delay(3000);
digitalWrite(FWPin,HIGH);
delay(3000);
digitalWrite(FWPin,LOW);
delay(3000);
digitalWrite(BWPin,HIGH);
delay(3000);
digitalWrite(BWPin,LOW);
delay(3000);
digitalWrite(FWPin,HIGH);
delay(4000);
digitalWrite(FWPin,LOW);
delay(3000);
digitalWrite(BWPin,HIGH);
delay(4000);
digitalWrite(BWPin,LOW);
delay(3000);
digitalWrite(BWPin,HIGH);
delay(500);
digitalWrite(BWPin,LOW);
digitalWrite(SpeedPin,LOW);
delay(1000);
digitalWrite(BWPin,HIGH);
if (digitalRead(9) == HIGH);
{
digitalWrite(BWPin,LOW);
digitalWrite(StopPin,HIGH);
delay(100);
digitalWrite(StopPin,LOW);
delay(200);
}
}
if (digitalRead(8) == HIGH)
{
digitalWrite(FWPin,HIGH);
delay(5000);
digitalWrite(FWPin,LOW);
delay(100);
digitalWrite(FWPin,HIGH);
digitalWrite(SpeedPin,HIGH);
delay(4000);
digitalWrite(FWPin,LOW);
delay(3000);
digitalWrite(BWPin,HIGH);
delay(4000);
digitalWrite(BWPin,LOW);
digitalWrite(SpeedPin,LOW);
delay(100);
digitalWrite(BWPin,HIGH);
if (digitalRead(9) == HIGH);
{
digitalWrite(BWPin,LOW);
digitalWrite(StopPin,HIGH);
delay(100);
digitalWrite(StopPin,LOW);
delay(200);
}
}
}
on begin of the program i wanted to set a 0 point so make a movement 2 sec forward and then bach til pin 9 is high - as a reference point to start making other movements.
then if 2 is pressed it have to make some movements en go back to the 0 point and the same when 8 is pressed