Your code is returning TOO_SLOW_OR_TOO_LOW for the case when the heading is too far right. The disassembly in the op looks like it correctly jumps to too_far_right.