Browse Source

AP_InertialSensor: fixed default orientation for PXF board MPU9250

mission-4.1.18
Andrew Tridgell 11 years ago
parent
commit
50068a7c6a
  1. 6
      libraries/AP_InertialSensor/AP_InertialSensor_MPU9250.cpp

6
libraries/AP_InertialSensor/AP_InertialSensor_MPU9250.cpp

@ -294,6 +294,12 @@ bool AP_InertialSensor_MPU9250::update( void ) @@ -294,6 +294,12 @@ bool AP_InertialSensor_MPU9250::update( void )
_accel[0].rotate(ROTATION_ROLL_180_YAW_90);
_gyro[0].rotate(ROTATION_ROLL_180_YAW_90);
#if CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_PXF
// PXF has an additional YAW 180
_accel[0].rotate(ROTATION_YAW_180);
_gyro[0].rotate(ROTATION_YAW_180);
#endif
Vector3f accel_scale = _accel_scale[0].get();
_accel[0].x *= accel_scale.x;
_accel[0].y *= accel_scale.y;

Loading…
Cancel
Save