aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_RangeFinder: analog: check for valid pin

Browse Source
This commit is contained in:
Iampete1 2021-09-22 20:49:58 +01:00 committed by Andrew Tridgell
parent 5ea72bd371
commit f667c098a2
1 changed files with 2 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AP_RangeFinder/AP_RangeFinder_analog.cpp
View File

@ -63,12 +63,11 @@ bool AP_RangeFinder_analog::detect(AP_RangeFinder_Params &_params)
*/ */
void AP_RangeFinder_analog::update_voltage(void) void AP_RangeFinder_analog::update_voltage(void)
{ {
if (source == nullptr) { if (source == nullptr || !source->set_pin(params.pin)) {
state.voltage_mv = 0; state.voltage_mv = 0;
set_status(RangeFinder::Status::NotConnected);
return; return;
} }
// cope with changed settings
source->set_pin(params.pin);
if (params.ratiometric) { if (params.ratiometric) {
state.voltage_mv = source->voltage_average_ratiometric() * 1000U; state.voltage_mv = source->voltage_average_ratiometric() * 1000U;
} else { } else {