Fix for unexpected behavior on conditional statements (uCOS MPC5604)