navigator: add position setpoint reset helper with safe defaults

- use in reset_triplets()
This commit is contained in:
RomanBapst
2020-01-17 10:48:38 +03:00
committed by Daniel Agar
parent 98042bf58f
commit 0e90448e52
3 changed files with 35 additions and 8 deletions
+1
View File
@@ -128,6 +128,7 @@ Takeoff::set_takeoff_position()
struct position_setpoint_triplet_s *pos_sp_triplet = _navigator->get_position_setpoint_triplet();
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->current.yaw_valid = true;
pos_sp_triplet->next.valid = false;