Du könntest die task_RP6System() öfter aufrufen oder einen bumperStateChangeHandler einbauen oder beides oder mal zeigen wie dein Program zur Zeit aussieht.

Grüße,
Jan