Navigator: Provide better feedback if no mission present, enforce minimum altitude in loiter and in auto modes

This commit is contained in:
Lorenz Meier
2015-06-12 15:57:27 +02:00
parent 6c0539c243
commit 05993bee6f
5 changed files with 37 additions and 13 deletions
+3 -2
View File
@@ -55,7 +55,8 @@
#include "navigator.h"
Loiter::Loiter(Navigator *navigator, const char *name) :
MissionBlock(navigator, name)
MissionBlock(navigator, name),
_param_min_alt(this, "MIS_TAKEOFF_ALT", false)
{
/* load initial params */
updateParams();
@@ -74,7 +75,7 @@ void
Loiter::on_activation()
{
/* set current mission item to loiter */
set_loiter_item(&_mission_item);
set_loiter_item(&_mission_item, _param_min_alt.get());
/* convert mission item to current setpoint */
struct position_setpoint_triplet_s *pos_sp_triplet = _navigator->get_position_setpoint_triplet();