fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

Properly handling passive mode in NodeStatusProvider

Browse Source
This commit is contained in:
Pavel Kirienko 2014-07-15 00:54:35 +04:00
parent 90702b5795
commit abaaf8d440
1 changed files with 14 additions and 15 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

29
libuavcan/src/protocol/uc_node_status_provider.cpp
View File

@ -28,10 +28,17 @@ int NodeStatusProvider::publish()
void NodeStatusProvider::publishWithErrorHandling()
{
const int res = publish();
if (res < 0)
if (getNode().isPassiveMode())
{
getNode().registerInternalFailure("NodeStatus pub failed");
UAVCAN_TRACE("NodeStatusProvider", "NodeStatus pub skipped - passive mode");
}
else
{
const int res = publish();
if (res < 0)
{
getNode().registerInternalFailure("NodeStatus pub failed");
}
}
}
@ -62,15 +69,10 @@ int NodeStatusProvider::startAndPublish()
return -ErrNotInited;
}
int res = -1;
if (!getNode().isPassiveMode())
int res = publish(); // Initial broadcast
if (res < 0)
{
res = publish(); // Initial broadcast
if (res < 0)
{
goto fail;
}
goto fail;
}
res = gdr_sub_.start(GlobalDiscoveryRequestCallback(this, &NodeStatusProvider::handleGlobalDiscoveryRequest));
@ -85,10 +87,7 @@ int NodeStatusProvider::startAndPublish()
goto fail;
}
if (!getNode().isPassiveMode())
{
TimerBase::startPeriodic(MonotonicDuration::fromMSec(protocol::NodeStatus::PUBLICATION_PERIOD_MS));
}
TimerBase::startPeriodic(MonotonicDuration::fromMSec(protocol::NodeStatus::PUBLICATION_PERIOD_MS));
return res;