mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-24 00:53:34 +08:00
FlightTaskAuto: need to remove check for yaw valid since there is a
bug in the navigator where this flag is not correctly set.
This commit is contained in:
committed by
Lorenz Meier
parent
740f1f284f
commit
dcdbdbd8eb
@@ -110,12 +110,12 @@ bool FlightTaskAuto::_evaluateTriplets()
|
|||||||
_sub_triplet_setpoint->get().current.lat, _sub_triplet_setpoint->get().current.lon, &target(0), &target(1));
|
_sub_triplet_setpoint->get().current.lat, _sub_triplet_setpoint->get().current.lon, &target(0), &target(1));
|
||||||
target(2) = -(_sub_triplet_setpoint->get().current.alt - _reference_altitude);
|
target(2) = -(_sub_triplet_setpoint->get().current.alt - _reference_altitude);
|
||||||
|
|
||||||
if (_sub_triplet_setpoint->get().current.yaw_valid) {
|
|
||||||
_yaw_setpoint = _sub_triplet_setpoint->get().current.yaw;
|
_yaw_setpoint = _sub_triplet_setpoint->get().current.yaw;
|
||||||
}
|
|
||||||
|
|
||||||
if (_type == WaypointType::follow_target && _sub_triplet_setpoint->get().current.yawspeed_valid) {
|
if (_type == WaypointType::follow_target && _sub_triplet_setpoint->get().current.yawspeed_valid) {
|
||||||
_yawspeed_setpoint = _sub_triplet_setpoint->get().current.yawspeed;
|
_yawspeed_setpoint = _sub_triplet_setpoint->get().current.yawspeed;
|
||||||
|
_yaw_setpoint = NAN;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Check if anything has changed. We do that by comparing the target
|
// Check if anything has changed. We do that by comparing the target
|
||||||
|
|||||||
Reference in New Issue
Block a user