fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-27 09:53:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixedwing: Enable loiter mode, tested in HIL

Browse Source
This commit is contained in:
Julian Oes
2013-11-06 23:11:14 +01:00
parent 9894751442
commit c75c5a5f30
2 changed files with 3 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/commander.cpp
+2 -1
View File
@@ -1539,7 +1539,8 @@ check_navigation_state_machine(struct vehicle_status_s *status, struct vehicle_c
// TODO AUTO_LAND handling // TODO AUTO_LAND handling
if (status->navigation_state == NAVIGATION_STATE_AUTO_TAKEOFF) { if (status->navigation_state == NAVIGATION_STATE_AUTO_TAKEOFF) {
/* don't switch to other states until takeoff not completed */ /* don't switch to other states until takeoff not completed */
if (local_pos->z > -takeoff_alt || status->condition_landed) { // XXX: only respect the condition_landed when the local position is actually valid
if (status->condition_local_altitude_valid && (local_pos->z > -takeoff_alt || status->condition_landed)) {
return TRANSITION_NOT_CHANGED; return TRANSITION_NOT_CHANGED;
} }
} }
src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp
+1 -1
View File
@@ -711,7 +711,7 @@ FixedwingPositionControl::control_position(const math::Vector2f &current_positio
_tecs.set_speed_weight(_parameters.speed_weight); _tecs.set_speed_weight(_parameters.speed_weight);
/* execute navigation once we have a setpoint */ /* execute navigation once we have a setpoint */
if (_setpoint_valid) { if (_setpoint_valid && _control_mode.flag_control_auto_enabled) {
/* current waypoint (the one currently heading for) */ /* current waypoint (the one currently heading for) */
math::Vector2f curr_wp(global_triplet.current.lat / 1e7f, global_triplet.current.lon / 1e7f); math::Vector2f curr_wp(global_triplet.current.lat / 1e7f, global_triplet.current.lon / 1e7f);