fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-22 02:23:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

FlightTaskOrbit: NACK command if coordinates could not get applied

Browse Source
This commit is contained in:
Matthias Grob
2021-03-17 09:50:11 -04:00
committed by Daniel Agar
parent bffa83bd47
commit ef774578e1
1 changed files with 13 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/flight_mode_manager/tasks/Orbit/FlightTaskOrbit.cpp
+13 -5
View File
@@ -77,16 +77,24 @@ bool FlightTaskOrbit::applyCommandParameters(const vehicle_command_s &command)
_initial_heading = _yaw;
// commanded center coordinates
if (map_projection_initialized(&_global_local_proj_ref)) {
if (PX4_ISFINITE(command.param5) && PX4_ISFINITE(command.param6)) {
if (PX4_ISFINITE(command.param5) && PX4_ISFINITE(command.param6)) {
if (map_projection_initialized(&_global_local_proj_ref)) {
map_projection_project(&_global_local_proj_ref,
command.param5, command.param6,
&_center(0), &_center(1));
}
// commanded altitude
if (PX4_ISFINITE(command.param7)) {
} else {
ret = false;
}
}
// commanded altitude
if (PX4_ISFINITE(command.param7)) {
if (map_projection_initialized(&_global_local_proj_ref)) {
_position_setpoint(2) = _global_local_alt0 - command.param7;
} else {
ret = false;
}
}