Browse Source

EKF: only fuse optical flow if terrain is valid

master
ChristophTobler 7 years ago
parent
commit
b7e589b98a
  1. 4
      EKF/control.cpp

4
EKF/control.cpp

@ -383,8 +383,8 @@ void Ekf::controlOpticalFlowFusion()
_imu_del_ang_of += _imu_sample_delayed.delta_ang - _state.gyro_bias; _imu_del_ang_of += _imu_sample_delayed.delta_ang - _state.gyro_bias;
_delta_time_of += _imu_sample_delayed.delta_ang_dt; _delta_time_of += _imu_sample_delayed.delta_ang_dt;
// fuse the data // fuse the data if the terrain/distance to bottom is valid
if (_control_status.flags.opt_flow) { if (_control_status.flags.opt_flow && get_terrain_valid()) {
// Update optical flow bias estimates // Update optical flow bias estimates
calcOptFlowBias(); calcOptFlowBias();

Loading…
Cancel
Save