Browse Source

ekf2: publish control state gyro bias data

sbg
Paul Riseborough 8 years ago committed by Lorenz Meier
parent
commit
27e6f07485
  1. 3
      src/modules/ekf2/ekf2_main.cpp

3
src/modules/ekf2/ekf2_main.cpp

@ -711,6 +711,9 @@ void Ekf2::task_main() @@ -711,6 +711,9 @@ void Ekf2::task_main()
ctrl_state.roll_rate = _lp_roll_rate.apply(gyro_rad[0]);
ctrl_state.pitch_rate = _lp_pitch_rate.apply(gyro_rad[1]);
ctrl_state.yaw_rate = _lp_yaw_rate.apply(gyro_rad[2]);
ctrl_state.roll_rate_bias = gyro_bias[0];
ctrl_state.pitch_rate_bias = gyro_bias[1];
ctrl_state.yaw_rate_bias = gyro_bias[2];
// Velocity in body frame
Vector3f v_n(velocity);

Loading…
Cancel
Save