EKF : introduce new architechture for navigation limits

This commit is contained in:
Mohammed Kabir
2018-06-09 22:23:55 +02:00
committed by Lorenz Meier
parent 8a713398cb
commit b4d2b8c57d
7 changed files with 67 additions and 35 deletions
+1 -1
View File
@@ -382,7 +382,7 @@ void EstimatorInterface::setOpticalFlowData(uint64_t time_usec, flow_message *fl
bool flow_magnitude_good = true;
if (delta_time_good) {
flow_rate_magnitude = flow->flowdata.norm() / delta_time;
flow_magnitude_good = (flow_rate_magnitude <= _params.flow_rate_max);
flow_magnitude_good = (flow_rate_magnitude <= _flow_max_rate);
}
bool relying_on_flow = _control_status.flags.opt_flow