mc_pos_control: use correct altitude as limit

fadfdasf
This commit is contained in:
Dennis Mannhart
2017-06-26 10:22:29 +02:00
parent 115e7246b0
commit 8a0a8e20e1
15 changed files with 58 additions and 49 deletions

View File

@@ -84,7 +84,7 @@ RTL::on_activation()
{
set_current_position_item(&_mission_item);
struct position_setpoint_triplet_s *pos_sp_triplet = _navigator->get_position_setpoint_triplet();
mission_apply_limitation(&_mission_item);
mission_apply_limitation(_mission_item);
mission_item_to_position_setpoint(_mission_item, &pos_sp_triplet->current);
pos_sp_triplet->previous.valid = false;
pos_sp_triplet->next.valid = false;
@@ -292,7 +292,7 @@ RTL::set_rtl_item()
}
/* convert mission item to current position setpoint and make it valid */
mission_apply_limitation(&_mission_item);
mission_apply_limitation(_mission_item);
mission_item_to_position_setpoint(_mission_item, &pos_sp_triplet->current);
pos_sp_triplet->next.valid = false;