fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-22 03:43:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

libuavcan passive mode support

Browse Source
This commit is contained in:
Pavel Kirienko
2014-07-12 16:52:17 +04:00
parent 93f861ad60
commit c9c9a16e94
6 changed files with 47 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
libuavcan/src/protocol/uc_node_status_provider.cpp
+12 -4
View File
@@ -62,10 +62,15 @@ int NodeStatusProvider::startAndPublish()
return -ErrNotInited;
}
int res = publish(); // Initial broadcast
if (res < 0)
int res = -1;
if (!getNode().isPassiveMode())
{
goto fail;
res = publish(); // Initial broadcast
if (res < 0)
{
goto fail;
}
}
res = gdr_sub_.start(GlobalDiscoveryRequestCallback(this, &NodeStatusProvider::handleGlobalDiscoveryRequest));
@@ -80,7 +85,10 @@ int NodeStatusProvider::startAndPublish()
goto fail;
}
TimerBase::startPeriodic(MonotonicDuration::fromMSec(protocol::NodeStatus::PUBLICATION_PERIOD_MS));
if (!getNode().isPassiveMode())
{
TimerBase::startPeriodic(MonotonicDuration::fromMSec(protocol::NodeStatus::PUBLICATION_PERIOD_MS));
}
return res;