fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-24 13:23:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

GlobalTimeSyncSlave: methods isActive(), getMasterNodeID()

Browse Source
This commit is contained in:
Pavel Kirienko
2014-03-24 10:53:41 +04:00
parent d56d5d5dca
commit 438340ae98
3 changed files with 49 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
libuavcan/src/protocol/global_time_sync_slave.cpp
+12
View File
@@ -19,6 +19,7 @@ void GlobalTimeSyncSlave::adjustFromMsg(const ReceivedDataStructure<protocol::Gl
int(msg.getSrcNodeID().get()), int(msg.getIfaceIndex()));
getSystemClock().adjustUtc(adjustment);
last_adjustment_ts_ = msg.getMonotonicTimestamp();
state = Update;
}
@@ -84,4 +85,15 @@ int GlobalTimeSyncSlave::start()
return sub_.start(GlobalTimeSyncCallback(this, &GlobalTimeSyncSlave::handleGlobalTimeSync));
}
bool GlobalTimeSyncSlave::isActive() const
{
const MonotonicDuration since_prev_adj = getSystemClock().getMonotonic() - last_adjustment_ts_;
return !last_adjustment_ts_.isZero() && since_prev_adj.toMSec() <= protocol::GlobalTimeSync::PUBLISHER_TIMEOUT_MS;
}
NodeID GlobalTimeSyncSlave::getMasterNodeID() const
{
return isActive() ? master_nid_ : NodeID();
}
}