//Wilde Springerei
#include parameters.inc

        CSUB Motor1
        JA Motor3

Motor1: ROL 0, 500                  //Drehe Motor
        WAIT TICKS, 0, 500
        CSUB Motor2
        MST 0
        RSUB

Motor2: ROR 1, 500                  //Drehe in die andere Richtung
        WAIT TICKS, 0, 500
        MST 1
        RSUB

Motor3: SAP VMax, 2, 500            //Setze VMax
        SAP AMax, 2, 5              //Setze AMax
Loop:   CSUB Sub1
        CSUB Sub2
        JA Loop                     //Endlosschleife

Sub1:   MVP ABS, 2, 10000
        WAIT POS, 2, 0              //Warte bis angekommen
        RSUB

Sub2:   MVP ABS, 2, -10000
        CSUB Motor1
        WAIT POS, 2, 0              //Warte bis angekommen
        RSUB