Browse Source

AP_Proximity: validate range finder distances

master
Randy Mackay 8 years ago
parent
commit
0b7ec0dc64
  1. 2
      libraries/AP_Proximity/AP_Proximity_RangeFinder.cpp

2
libraries/AP_Proximity/AP_Proximity_RangeFinder.cpp

@ -45,9 +45,9 @@ void AP_Proximity_RangeFinder::update(void) @@ -45,9 +45,9 @@ void AP_Proximity_RangeFinder::update(void)
uint8_t sector = (uint8_t)rngfnd->get_orientation(i);
_angle[sector] = sector * 45;
_distance[sector] = rngfnd->distance_cm(i) / 100.0f;
_distance_valid[sector] = true;
_distance_min = rngfnd->min_distance_cm(i) / 100.0f;
_distance_max = rngfnd->max_distance_cm(i) / 100.0f;
_distance_valid[sector] = (_distance[sector] >= _distance_min) && (_distance[sector] <= _distance_max);
_last_update_ms = AP_HAL::millis();
update_boundary_for_sector(sector);
}

Loading…
Cancel
Save