Have you checked if the "update" functions are called when needed and that the angle_pitch/... values are correct as well when debugging ? I would guess that those angle values are never updated if everything else is working fine on the screen.
/Romain
