Removed publishing yaw directly from magnetometer, will do a specific kalman filter for that