Ich denke das Programm ist noch etwas zu durcheinandergewirbelt Bild   um die Timerprogrammierung so zu verstehen. Müsste man etwas klarer strukturieren. Die Schrittbefehle in seperate Subroutinen und Kapseln und unnötiges raus!