Transmit altitude and hdop
Fix compass calibration bug
Switch back to compass+odom for odometry