yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00:00
Code Issues Packages Projects Releases Wiki Activity

batt_smbus: exit/continue correctly when no device is on the bus

Browse Source
This commit is contained in:
Beat Küng
2019-11-05 15:11:02 +01:00
parent 72e62a62cb
commit ce1ae3fcb7
1 changed files with 6 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

11
src/drivers/batt_smbus/batt_smbus.cpp
View File

@@ -122,16 +122,17 @@ int BATT_SMBUS::task_spawn(int argc, char *argv[])
SMBus *interface = new SMBus(smbus_bus_options[i].busnum, BATT_SMBUS_ADDR);
BATT_SMBUS *dev = new BATT_SMBUS(interface, smbus_bus_options[i].devpath);
// Successful read of device type, we've found our battery
_object.store(dev);
_task_id = task_id_is_work_queue;
int result = dev->get_startup_info();
if (result != PX4_OK) {
return PX4_ERROR;
delete dev;
continue;
}
// Successful read of device type, we've found our battery
_object.store(dev);
_task_id = task_id_is_work_queue;
dev->ScheduleOnInterval(BATT_SMBUS_MEASUREMENT_INTERVAL_US);
return PX4_OK;