Browse Source

Mission: for tangential loiter exit, set current position setpoint typ to position

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
master
Silvan Fuhrer 4 years ago committed by Roman Bapst
parent
commit
cb78ba34d7
  1. 4
      src/modules/navigator/mission_block.cpp

4
src/modules/navigator/mission_block.cpp

@ -441,7 +441,9 @@ MissionBlock::is_mission_item_reached() @@ -441,7 +441,9 @@ MissionBlock::is_mission_item_reached()
bearing += inner_angle;
}
// Replace current setpoint lat/lon with tangent coordinate
// set typ to position, will get set to loiter in the fw position controller once close
// and replace current setpoint lat/lon with tangent coordinate
curr_sp.type = position_setpoint_s::SETPOINT_TYPE_POSITION;
waypoint_from_heading_and_distance(curr_sp.lat, curr_sp.lon,
bearing, fabsf(curr_sp.loiter_radius),
&curr_sp.lat, &curr_sp.lon);

Loading…
Cancel
Save