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

RangeFinder_Analog: set status

This commit is contained in:
Randy Mackay 2015-04-13 15:08:19 +09:00
parent fadfa70e99
commit 715da653c3
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_RangeFinder/AP_RangeFinder_analog.cpp
View File

@ -38,11 +38,12 @@ AP_RangeFinder_analog::AP_RangeFinder_analog(RangeFinder &_ranger, uint8_t insta
source = hal.analogin->channel(ranger._pin[instance]);
if (source == NULL) {
// failed to allocate a ADC channel? This shouldn't happen
state.healthy = false;
set_status(RangeFinder::RangeFinder_NotConnected);
return;
}
source->set_stop_pin((uint8_t)ranger._stop_pin[instance]);
source->set_settle_time((uint16_t)ranger._settle_time_ms[instance]);
set_status(RangeFinder::RangeFinder_NoData);
}
/*
@ -116,8 +117,7 @@ void AP_RangeFinder_analog::update(void)
}
state.distance_cm = dist_m * 100.0f;
// we can't actually tell if an analog rangefinder is healthy, so
// always set as healthy
state.healthy = true;
// update range_valid state based on distance measured
update_status();
}