Fix rotation

Reported on https://github.com/AutonomyLab/ardrone_autonomy/issues/113 was causing reversed axes issues with the robot_localization package.

Also keep the magnetometer data published even if the readings are stuck.
Thanks for noticing it!