Browse Source

df_hmc5883_wrapper: fix mag rotation

The external GPS+Mag needs some rotation.
sbg
Julian Oes 9 years ago committed by Lorenz Meier
parent
commit
09dd88ec01
  1. 6
      src/platforms/posix/drivers/df_hmc5883_wrapper/df_hmc5883_wrapper.cpp

6
src/platforms/posix/drivers/df_hmc5883_wrapper/df_hmc5883_wrapper.cpp

@ -168,6 +168,12 @@ int DfHmc9250Wrapper::_publish(struct mag_sensor_data &data) @@ -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;

Loading…
Cancel
Save