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

AP_UAVCAN: throw allocation error when failing to allocate

Browse Source
This commit is contained in:
bugobliterator 2021-09-29 13:06:49 +05:30 committed by Peter Barker
parent b897f984a7
commit fd369e8262
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_UAVCAN/AP_UAVCAN_DNA_Server.cpp
View File

@ -279,7 +279,7 @@ bool AP_UAVCAN_DNA_Server::init(AP_UAVCAN *ap_uavcan)
//Setup publisher for this driver index
allocation_pub[driver_index] = new uavcan::Publisher<uavcan::protocol::dynamic_node_id::Allocation>(*_node);
if (allocation_pub[driver_index] == nullptr) {
return false;
AP_BoardConfig::allocation_error("AP_UAVCAN_DNA: allocation_pub[%d]", driver_index);
}
int res = allocation_pub[driver_index]->init(uavcan::TransferPriority::Default);
@ -291,7 +291,7 @@ bool AP_UAVCAN_DNA_Server::init(AP_UAVCAN *ap_uavcan)
//Setup GetNodeInfo Client
getNodeInfo_client[driver_index] = new uavcan::ServiceClient<uavcan::protocol::GetNodeInfo>(*_node);
if (getNodeInfo_client[driver_index] == nullptr) {
return false;
AP_BoardConfig::allocation_error("AP_UAVCAN_DNA: getNodeInfo_client[%d]", driver_index);
}
res = getNodeInfo_client[driver_index]->init();