mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 23:13:34 +08:00
Support gliding setpoints for autonomous soaring (#14643)
* Enable offboard gliding position setpoints Adds a capability to make the vehicle glide when given position setpoints. Gliding setpoints are enabled by setting POSITION_TARGET_TYPEMASK_Z_IGNORE, POSITION_TARGET_TYPEMASK_VZ_IGNORE, POSITION_TARGET_TYPEMASK_AZ_IGNORE on the typemask of position setpoints. Include zero cruising throttle Invalid setpoints with nan * Handle nans for curise_throttle
This commit is contained in:
@@ -1912,6 +1912,7 @@ bool Mission::position_setpoint_equal(const position_setpoint_s *p1, const posit
|
||||
(p1->acceleration_is_force == p2->acceleration_is_force) &&
|
||||
(fabsf(p1->acceptance_radius - p2->acceptance_radius) < FLT_EPSILON) &&
|
||||
(fabsf(p1->cruising_speed - p2->cruising_speed) < FLT_EPSILON) &&
|
||||
(fabsf(p1->cruising_throttle - p2->cruising_throttle) < FLT_EPSILON));
|
||||
((fabsf(p1->cruising_throttle - p2->cruising_throttle) < FLT_EPSILON) || (!PX4_ISFINITE(p1->cruising_throttle)
|
||||
&& !PX4_ISFINITE(p2->cruising_throttle))));
|
||||
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user