|
|
@ -259,6 +259,9 @@ void MAVLink_routing::handle_heartbeat(mavlink_channel_t in_channel, const mavli |
|
|
|
// the routing table is full
|
|
|
|
// the routing table is full
|
|
|
|
mask &= ~(1U<<(in_channel-MAVLINK_COMM_0)); |
|
|
|
mask &= ~(1U<<(in_channel-MAVLINK_COMM_0)); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// mask out channels that do not want the heartbeat to be forwarded
|
|
|
|
|
|
|
|
mask &= ~no_route_mask; |
|
|
|
|
|
|
|
|
|
|
|
// mask out channels that are known sources for this sysid/compid
|
|
|
|
// mask out channels that are known sources for this sysid/compid
|
|
|
|
for (uint8_t i=0; i<num_routes; i++) { |
|
|
|
for (uint8_t i=0; i<num_routes; i++) { |
|
|
|
if (routes[i].sysid == msg->sysid && routes[i].compid == msg->compid) { |
|
|
|
if (routes[i].sysid == msg->sysid && routes[i].compid == msg->compid) { |
|
|
|