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

AP_Periph: remove return res from canard_broadcast

Browse Source
This commit is contained in:
bugobliterator 2021-07-11 21:15:33 +05:30 committed by Andrew Tridgell
parent 64c41e51ba
commit a9fda29d42
1 changed files with 8 additions and 20 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
Tools/AP_Periph/can.cpp
View File

@ -374,7 +374,7 @@ static void handle_param_executeopcode(CanardInstance* ins, CanardRxTransfer* tr
total_size);
}
static int16_t canard_broadcast(uint64_t data_type_signature,
static void canard_broadcast(uint64_t data_type_signature,
uint16_t data_type_id,
uint8_t priority,
const void* payload,
@ -1015,31 +1015,24 @@ static void cleanup_stale_transactions(uint64_t &timestamp_usec)
}
}
static int16_t canard_broadcast(uint64_t data_type_signature,
static void canard_broadcast(uint64_t data_type_signature,
uint16_t data_type_id,
uint8_t priority,
const void* payload,
uint16_t payload_len)
{
int16_t cache = -1;
bool success = false;
for (auto &ins : instances) {
if (canardGetLocalNodeID(&ins.canard) == CANARD_BROADCAST_NODE_ID) {
continue;
}
cache = canardBroadcast(&ins.canard,
canardBroadcast(&ins.canard,
data_type_signature,
data_type_id,
&ins.transfer_id,
priority,
payload,
payload_len);
if (cache == 0) {
// we had atleast one interface where transaction was successful
success = true;
}
}
return success?0:cache;
}
static void processTx(void)
@ -1126,16 +1119,11 @@ static void node_status_send(void)
uint32_t len = uavcan_protocol_NodeStatus_encode(&node_status, buffer);
const int16_t bc_res = canard_broadcast(UAVCAN_PROTOCOL_NODESTATUS_SIGNATURE,
UAVCAN_PROTOCOL_NODESTATUS_ID,
CANARD_TRANSFER_PRIORITY_LOW,
buffer,
len);
if (bc_res <= 0) {
printf("broadcast fail %d\n", bc_res);
} else {
//printf("broadcast node status OK\n");
}
canard_broadcast(UAVCAN_PROTOCOL_NODESTATUS_SIGNATURE,
UAVCAN_PROTOCOL_NODESTATUS_ID,
CANARD_TRANSFER_PRIORITY_LOW,
buffer,
len);
}