Browse Source

AP_RangeFinder: PWM driver adds offset param value

zr-v5.1
Randy Mackay 5 years ago
parent
commit
2bdb2f67ab
  1. 2
      libraries/AP_RangeFinder/AP_RangeFinder_PWM.cpp

2
libraries/AP_RangeFinder/AP_RangeFinder_PWM.cpp

@ -166,6 +166,8 @@ void AP_RangeFinder_PWM::update(void) @@ -166,6 +166,8 @@ void AP_RangeFinder_PWM::update(void)
}
if (!get_reading(state.distance_cm)) {
// add offset
state.distance_cm += params.offset;
// failure; consider changing our state
if (AP_HAL::millis() - state.last_reading_ms > 200) {
set_status(RangeFinder::Status::NoData);

Loading…
Cancel
Save