mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-23 22:58:10 +08:00
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:
@@ -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) &&
|
||||
|
||||
@@ -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
|
||||
*/
|
||||
|
||||
Reference in New Issue
Block a user