df_hmc5883_wrapper: fix mag rotation

The external GPS+Mag needs some rotation.
This commit is contained in:
Julian Oes
2016-03-11 14:41:30 -08:00
committed by Lorenz Meier
parent 1aee73a8a7
commit 09dd88ec01

View File

@@ -168,6 +168,12 @@ int DfHmc9250Wrapper::_publish(struct mag_sensor_data &data)
mag_report mag_report = {};
mag_report.timestamp = data.last_read_time_usec;
/* The standard external mag by 3DR has x pointing to the
* right, y pointing backwards, and z down, therefore switch x
* and y and invert y. */
data.field_x_ga = -data.field_y_ga;
data.field_y_ga = data.field_x_ga;
// TODO: remove these (or get the values)
mag_report.x_raw = NAN;
mag_report.y_raw = NAN;