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

AP_RangeFinder: Give back semaphore on whoami error

This commit is contained in:
pierre-louis.k 2018-08-03 16:42:02 +02:00 committed by Randy Mackay
parent b0acac0f55
commit b9af00e7dd
1 changed files with 1 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
libraries/AP_RangeFinder/AP_RangeFinder_TeraRangerI2C.cpp
View File

@ -76,6 +76,7 @@ bool AP_RangeFinder_TeraRangerI2C::init(void)
uint8_t whoami; uint8_t whoami;
if (!dev->read_registers(TR_WHOAMI, &whoami, 1) || if (!dev->read_registers(TR_WHOAMI, &whoami, 1) ||
whoami != TR_WHOAMI_VALUE) { whoami != TR_WHOAMI_VALUE) {
dev->get_semaphore()->give();
return false; return false;
} }