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

AP_RangeFinder: call handle_msg for all backends

Browse Source
This commit is contained in:
Randy Mackay 2016-05-04 11:59:01 +09:00
parent 9b940687c1
commit 96f665061e
1 changed files with 5 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_RangeFinder/RangeFinder.cpp
View File

@ -574,9 +574,11 @@ RangeFinder::RangeFinder_Status RangeFinder::status(uint8_t instance) const
void RangeFinder::handle_msg(mavlink_message_t *msg) {
uint8_t i;
for (i=0; i<num_instances; i++)
if(_type[i] == RangeFinder_TYPE_CC)
drivers[i]->handle_msg(msg);
for (i=0; i<num_instances; i++) {
if ((drivers[i] != NULL) && (_type[i] != RangeFinder_TYPE_NONE)) {
drivers[i]->handle_msg(msg);
}
}
}
// true if sensor is returning data