ObstacleAvoidance: don't inject avoidance setpoint when in

loiter mode since it's the failsafe mode
This commit is contained in:
Martina Rivizzigno
2019-04-04 16:41:26 +02:00
committed by bresch
parent 0e27b5cbfa
commit 34c0bb1723
@@ -88,7 +88,8 @@ void ObstacleAvoidance::prepareAvoidanceSetpoints(Vector3f &pos_sp, Vector3f &ve
float &yaw_speed_sp)
{
if (!COM_OBS_AVOID.get()) {
if (!COM_OBS_AVOID.get() || _sub_vehicle_status->get().nav_state == vehicle_status_s::NAVIGATION_STATE_AUTO_LOITER) {
// if avoidance disabled or in failsafe nav_state LOITER, don't inject setpoints from avoidance system
return;
}