fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-30 05:54:06 +08:00
Code Issues Packages Projects Releases Wiki Activity

Navigator: loiter direction check: use -FLT_EPS instad of <0

Browse Source 
Signed-off-by: Silvan <silvan@auterion.com>
This commit is contained in:
Silvan 2025-07-22 13:21:59 +02:00 committed by Silvan Fuhrer
parent 85ccc064bd
commit 63f9acfa84
2 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/modules/fw_mode_manager/figure_eight/FigureEight.cpp
View File

@ -95,7 +95,7 @@ FigureEight::FigureEightPatternParameters FigureEight::sanitizeParameters(const
if (!PX4_ISFINITE(parameters.loiter_radius)) {
valid_parameters.loiter_radius = DEFAULT_MAJOR_TO_MINOR_AXIS_RATIO * valid_parameters.loiter_minor_radius;
valid_parameters.loiter_direction_counter_clockwise = _param_nav_loiter_rad.get() < 0;
valid_parameters.loiter_direction_counter_clockwise = _param_nav_loiter_rad.get() < -FLT_EPSILON;
}
valid_parameters.loiter_radius = math::max(valid_parameters.loiter_radius,

4
src/modules/navigator/navigator_main.cpp
View File

@ -525,7 +525,7 @@ void Navigator::run()
if (PX4_ISFINITE(cmd.param1)) {
rep->current.loiter_radius = fabsf(cmd.param1);
rep->current.loiter_direction_counter_clockwise = cmd.param1 < 0;
rep->current.loiter_direction_counter_clockwise = cmd.param1 < -FLT_EPSILON;
}
rep->current.lat = position_setpoint.lat;
@ -571,7 +571,7 @@ void Navigator::run()
if (PX4_ISFINITE(cmd.param1)) {
rep->current.loiter_radius = fabsf(cmd.param1);
rep->current.loiter_direction_counter_clockwise = cmd.param1 < 0;
rep->current.loiter_direction_counter_clockwise = cmd.param1 < -FLT_EPSILON;
}
rep->current.loiter_radius = math::max(rep->current.loiter_radius, 2.0f * rep->current.loiter_minor_radius);