Fixed error with odometry caused by clockwise/counterclockwise angles

[HALtheWise]

During testing with the AR Drone 2.0, we noticed that odometry and state estimation was behaving incorrectly when the drone was not facing North or South. We tracked this down to a missing negative sign in the state estimate calculations, caused by clockwise angles coming from the drone, and counterclockwise angles expected by the trigonometry.