Dein Code wird je nach Bumperstatus zu beginn gar nicht ausgeführt und dann springt der Controller in den Reset. Ich würde dir dringend raten dich etwas mehr mit der Programmierung in C zu befassen und m besten auch das beim RP6 mitgelieferte C Tutorial mal komplett durchzuarbeiten.