L1 pos control: Publish timestamp when setting nav capabilities

This commit is contained in:
Lorenz Meier 2015-06-05 10:16:24 +02:00
parent ac215fe2cb
commit c7be59038c
1 changed files with 2 additions and 0 deletions

View File

@ -900,6 +900,8 @@ FixedwingPositionControl::calculate_gndspeed_undershoot(const math::Vector<2> &c
void FixedwingPositionControl::navigation_capabilities_publish()
{
_nav_capabilities.timestamp = hrt_absolute_time();
if (_nav_capabilities_pub > 0) {
orb_publish(ORB_ID(navigation_capabilities), _nav_capabilities_pub, &_nav_capabilities);
} else {