mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-20 07:23:34 +08:00
NodeDiscoverer logic fix
This commit is contained in:
@@ -267,11 +267,6 @@ class NodeDiscoverer : TimerBase
|
||||
return;
|
||||
}
|
||||
|
||||
if (!handler_.canDiscoverNewNodes())
|
||||
{
|
||||
return; // Timer must continue to run in order to not stuck when it unlocks
|
||||
}
|
||||
|
||||
const NodeID node_id = pickNextNodeToQueryAndCleanupMap();
|
||||
if (!node_id.isUnicast())
|
||||
{
|
||||
@@ -280,6 +275,11 @@ class NodeDiscoverer : TimerBase
|
||||
return;
|
||||
}
|
||||
|
||||
if (!handler_.canDiscoverNewNodes())
|
||||
{
|
||||
return; // Timer must continue to run in order to not stuck when it unlocks
|
||||
}
|
||||
|
||||
trace(TraceDiscoveryGetNodeInfoRequest, node_id.get());
|
||||
|
||||
UAVCAN_TRACE("dynamic_node_id_server::NodeDiscoverer", "Requesting GetNodeInfo from node %d",
|
||||
|
||||
Reference in New Issue
Block a user