@Inka wie vertraut bist Du denn mir dem allgemeinen Aufbau eines Arduino Sktechs?

Code:
konstanten und Variablen Deklaration

void setup()
{
Eingänge, Ausgänge konfigurieren
Initialationen und Code der einmalig beim Controller Power On ausgeführt werden soll. 
}

void loop()
{
Hauptschleife  die immer wieder durchlaufen wird 
}

void <funktionname>()
{
Funktionen und Interrupt Service Routinen die aus der Hauptschleife oder durch IRQ's aufgerufen werden
}
Ist dieses allgemeine Schema bekannt oder kopierst Du eher bestehenden Code zusammen und variierst ihn dann für Deine Bedürfnisse?