Vorwärts, Rückwärts Auswertung Geschwindigkeit

const int SchalterVor = 13;
const int SchalterRueck =2 ;
const int RelaisVor = 3;
const int RelaisRueck = 11;
const int auswertung = 12;

int vor;
int rueck;
int rVor;
int rRueck;
int GeschwindigkeitOk;

void setup() {

     pinMode(RelaisVor, OUTPUT);
     pinMode(SchalterVor, INPUT);
     pinMode(RelaisRueck, OUTPUT);
     pinMode(SchalterRueck, INPUT);
     pinMode(auswertung, INPUT);

}

void loop() {         //ist die Geschwindigkeit ok, dann soll wenn entweder der Vorwärts- oder der Rückwärtsgang
                      //drin ist, das jeweilige Relais anziehen. Fällt der jeweilige Schalter für die Fahrtrichtung
                      //ab, soll auch da jeweilie Relais abfallen.

    GeschwindigkeitOk = digitalRead(auswertung);

   vor = digitalRead(SchalterVor); // Schalter fürs vorwärtsfahren
     if (vor == LOW)
     {
       digitalWrite (RelaisVor, HIGH); //RelaisVor soll aus sein!!
     }
      if (vor==HIGH && GeschwindigkeitOk==HIGH && rueck!=HIGH)
      {
         rVor = LOW;
         digitalWrite(RelaisVor, rVor); //RelaisVor soll an sein!!
        }
   rueck = digitalRead(SchalterRueck);   // Schalter fürs rückwärtsfahren
     if (rueck == LOW)
     {
        digitalWrite (RelaisRueck, HIGH); //RelaisRueck soll aus sein!!
     }
      if (rueck==HIGH && GeschwindigkeitOk==HIGH && vor!=HIGH)
      {
         rRueck = LOW;
         digitalWrite(RelaisRueck, rRueck); //RelaisRueck soll an sein!!
        }
}