VTOL GPSF: fix fixed bank loiter (#12778)

* GPS Failsafe fix for VTOL
* navigator: use new uORB API for VTOL publication
This commit is contained in:
ThomasRigi
2019-10-16 17:57:44 +02:00
committed by Julian Oes
parent 412c364e90
commit 17c17f26a9
2 changed files with 8 additions and 2 deletions
+7 -1
View File
@@ -93,7 +93,13 @@ GpsFailure::on_active()
q.copyTo(att_sp.q_d);
att_sp.q_d_valid = true;
_att_sp_pub.publish(att_sp);
if (_navigator->get_vstatus()->is_vtol) {
_fw_virtual_att_sp_pub.publish(att_sp);
} else {
_att_sp_pub.publish(att_sp);
}
/* Measure time */
if ((_param_nav_gpsf_lt.get() > FLT_EPSILON) &&
+1 -1
View File
@@ -76,7 +76,7 @@ private:
hrt_abstime _timestamp_activation{0}; //*< timestamp when this mode was activated */
uORB::Publication<vehicle_attitude_setpoint_s> _att_sp_pub{ORB_ID(vehicle_attitude_setpoint)};
uORB::Publication<vehicle_attitude_setpoint_s> _fw_virtual_att_sp_pub{ORB_ID(fw_virtual_attitude_setpoint)};
/**
* Set the GPSF item
*/