Random style fixes in the code

This commit is contained in:
bresch 2020-06-03 11:25:03 +02:00 committed by Mathieu Bresciani
parent 5d6a72e383
commit aa96fa6d9e
4 changed files with 4 additions and 1 deletions

View File

@ -367,6 +367,7 @@ void EstimatorInterface::setOpticalFlowData(const flowSample& flow)
// when there are other aiding sources available
const float flow_rate_magnitude = flow.flow_xy_rad.norm() / delta_time;
flow_magnitude_good = (flow_rate_magnitude <= _flow_max_rate);
} else {
// protect against overflow caused by division with very small delta_time
delta_time = delta_time_min;

View File

@ -45,6 +45,7 @@ bool ImuDownSampler::update(const imuSample &imu_sample_new) {
return true;
} else {
return false;
}
}

View File

@ -179,7 +179,7 @@ void Ekf::fuseFlowForTerrain()
// calculate optical LOS rates using optical flow rates that have had the body angular rate contribution removed
// correct for gyro bias errors in the data used to do the motion compensation
// Note the sign convention used: A positive LOS rate is a RH rotation of the scene about that axis.
const Vector2f opt_flow_rate = Vector2f{_flow_compensated_XY_rad} / _flow_sample_delayed.dt + Vector2f{_flow_gyro_bias};
const Vector2f opt_flow_rate = Vector2f(_flow_compensated_XY_rad) / _flow_sample_delayed.dt + Vector2f(_flow_gyro_bias);
// get latest estimated orientation
const float q0 = _state.quat_nominal(0);

View File

@ -130,6 +130,7 @@ bool Ekf::fuseVerticalPosition(const Vector3f &innov, const Vector2f &innov_gate
fuseVelPosHeight(innov(2), innov_var(2), 5);
return true;
} else {
_innov_check_fail_status.flags.reject_ver_pos = true;
return false;