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.
What happens if `mag_normalizer` is so small that it causes a div/zero?