Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Proximity: Cycle through all drivers to check for upward distance

This commit is contained in:
rishabsingh3003 2022-08-22 23:23:43 +05:30 committed by Andrew Tridgell
parent 5d29dd98c1
commit 3a347374c8
1 changed files with 8 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
libraries/AP_Proximity/AP_Proximity.cpp
View File

@ -392,7 +392,14 @@ bool AP_Proximity::get_upward_distance(uint8_t instance, float &distance) const
bool AP_Proximity::get_upward_distance(float &distance) const
{
return get_upward_distance(primary_instance, distance);
// get upward distance from backend
for (uint8_t i=0; i<num_instances; i++) {
// return first good upward distance
if (get_upward_distance(primary_instance, distance)) {
return true;
}
}
return false;
}
#if HAL_LOGGING_ENABLED