Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-01 21:48:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_BattMonitor: helper func

Browse Source
This commit is contained in:
Eugene Shamaev 2018-03-11 11:51:04 +02:00 committed by Tom Pittenger
parent 9195ba80fc
commit f7e9ce44b1
1 changed files with 4 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
libraries/AP_BattMonitor/AP_BattMonitor_UAVCAN.cpp
View File

@ -30,17 +30,14 @@ void AP_BattMonitor_UAVCAN::init()
}
for (uint8_t i = 0; i < MAX_NUMBER_OF_CAN_DRIVERS; i++) {
if (hal.can_mgr[i] == nullptr) {
continue;
}
AP_UAVCAN *uavcan = hal.can_mgr[i]->get_UAVCAN();
if (uavcan == nullptr) {
AP_UAVCAN *ap_uavcan = AP_UAVCAN::get_uavcan(i);
if (ap_uavcan == nullptr) {
continue;
}
switch (_type) {
case UAVCAN_BATTERY_INFO:
if (uavcan->register_BM_bi_listener_to_id(this, _params._serial_number)) {
if (ap_uavcan->register_BM_bi_listener_to_id(this, _params._serial_number)) {
debug_bm_uavcan(2, "UAVCAN BattMonitor BatteryInfo registered id: %d\n\r", _params._serial_number);
}
break;