sketch inversione di marcia temporizzata comandata da Arduino e modulo bluetooth

Salve a tutti ragazzi da poco tempo ho un modulo HC-05 acquistato su ebay,
devo progettare un programma che deve svolgere le seguenti azioni:

  • premo 1 sul mio cellulare e si avvia il primo relè
  • quando tocco il finecorsa il primo relè si spegne
  • delay 5000
  • si avvia il secondo relè
  • tocco il secondo finecorsa il secondo relè si spegne

una parte di Sketch l'ho cominciata

#include <SoftwareSerial.h>// FILE DELLA LIBRERIA 

SoftwareSerial Genotronex(2, 3); // RX (pin ricezione), TX(pin trasmissione)
int ledpin=13; // nome utilizzato per chiamare il pin 13 ovvero quello del led integrato ad arduino
int BluetoothData; // è il nome della stringa dei dati bluetooth
int finecorsa;
int finecorsa2; 
void setup() {
 
  Genotronex.begin(9600);
  Genotronex.println("Bluetooth On please press 1 or 0 blink LED ..");
  pinMode(ledpin,OUTPUT);
  pinMode(4,OUTPUT);
   pinMode(9,INPUT);
    pinMode(8,INPUT);
     pinMode(5,OUTPUT);
}

void loop() {
  finecorsa=digitalRead(9);
finecorsa2=digitalRead(8);
   if (Genotronex.available()){
BluetoothData=Genotronex.read();
   if(BluetoothData=='1'){   // if number 1 pressed ....
   digitalWrite(ledpin,1);
   Genotronex.println("LED  On D13 ON ! ");
   }
  if (BluetoothData=='0'){// if number 0 pressed ....
  digitalWrite(ledpin,0);
   Genotronex.println("LED  On D13 Off ! ");
  }
    if (BluetoothData=='2'){// if number 2 pressed ....
  digitalWrite(4,0);
   Genotronex.println("Rele OFF ARRESTO MARCIA CANCELLO ");
  }
      if (BluetoothData=='3'){// if number 3 pressed ....
  digitalWrite(4,1);
   Genotronex.println("Rele ON AVVIO MARCIA CANCELLO ");
  }
}
delay(100);// prepare for next data ...


}  
}