Nach dem CP r17,r19 könntest Du auch ein BRCC einfügen.
Das wird dann aktiv wenn der rechte Wert kleiner oder gleich dem linken ist.

Hat bei mir immer funktioniert.