Browse Source

L1 pos control: Publish timestamp when setting nav capabilities

sbg
Lorenz Meier 10 years ago
parent
commit
c7be59038c
  1. 2
      src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp

2
src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp

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

Loading…
Cancel
Save