Added output magnetometer data option
Added OUTPUT_RC mode