Hilfe Sketch für Ironmankostüm.

Hi alle zusammen,

ich brauche Hilfe beim schreiben eines Sketch für mein Arduino Uno 3,
da ich nur Laie bin und mir so ein bisschen Randwissen angeeignet habe,
jetzt jedoch aus irgendein Grund vorm Scheidern stehen.
Folgende Funktion will ich erreichen mit Tastendruck, und zwar soll 2 
Seromotoren mit 90 Grad angesteuert werden, in die eine Richtung 
langsamer als in die andere Richtung, gleichzeitig sollen 3 LED angehen 
in die Richtung wo der Servo schneller fährt, dabei soll bevor die LEDs 
dauerhaft leuchten eine kurze Schleife erzeugt werden, wo die LEDs 3 mal 
für ein paar Millisekunden/Sekunde an und aus gehen und in die Richtung 
wo der Servo langsamer fährt, sollen die LEDs ausgehen.
Einen Sketch habe ich auch schon erstellt, bei dem die Servomotoren und 
LEDs auf Tastenknopf reagieren:

Video:

https://www.youtube.com/watch?v=YwniiN5H2IA

Sketch:

#include <Servo.h>
const int tasterPin = 2;
const int ledPin1 =  13;
const int ledPin2 = 10;
const int ledPin3 = 11;
int tasterStatus = LOW;
int tasterGedrueckt = 0;
int lichtmodus = 0;
int ledStatus = LOW;
Servo servoblau1;
Servo servoblau2;

unsigned long tasterZeit = 0;
unsigned long entprellZeit = 10;
unsigned long ledMillis = 500;


void setup()
{
  servoblau1.attach(6);
  servoblau2.attach(9);
  pinMode(ledPin1,OUTPUT);
  pinMode(ledPin2,OUTPUT);
  pinMode(ledPin3,OUTPUT);
  pinMode(tasterPin,INPUT);
}

void loop()
{
  tasterStatus = digitalRead(tasterPin);

  if (tasterStatus == HIGH)
  {
  tasterZeit = millis();
  tasterGedrueckt = 1;
  }
if ((millis() - tasterZeit> entprellZeit)&& tasterGedrueckt == 1)
{
  lichtmodus++;
  tasterGedrueckt = 0;
}
if (lichtmodus == 0)
{


digitalWrite(ledPin1,HIGH);
digitalWrite(ledPin2,HIGH);
digitalWrite(ledPin3,HIGH);
servoblau1.write (90);
servoblau2.write (0);

delay(50);
}
if (lichtmodus == 1)
{digitalWrite(ledPin1,LOW);
digitalWrite(ledPin2,LOW);
digitalWrite(ledPin3,LOW);
servoblau1.write (0);
servoblau2.write (90);
delay(50);
}
if (lichtmodus >=  2)
{
  lichtmodus = 0;
}
}


Wenn ihr mir helfen könntet würde ich mich freuen:-)