Browse Source

MulticopterPositionControl: default cases with unsupported POS_MODE

release/1.12
Matthias Grob 4 years ago
parent
commit
e6338d8a2f
  1. 18
      src/modules/mc_pos_control/MulticopterPositionControl.cpp

18
src/modules/mc_pos_control/MulticopterPositionControl.cpp

@ -589,6 +589,10 @@ void MulticopterPositionControl::start_flight_task() @@ -589,6 +589,10 @@ void MulticopterPositionControl::start_flight_task()
FlightTaskError error = FlightTaskError::NoError;
switch (_param_mpc_pos_mode.get()) {
case 0:
error = _flight_tasks.switchTask(FlightTaskIndex::ManualPosition);
break;
case 1:
error = _flight_tasks.switchTask(FlightTaskIndex::ManualPositionSmooth);
break;
@ -598,11 +602,8 @@ void MulticopterPositionControl::start_flight_task() @@ -598,11 +602,8 @@ void MulticopterPositionControl::start_flight_task()
break;
case 4:
error = _flight_tasks.switchTask(FlightTaskIndex::ManualAcceleration);
break;
default:
error = _flight_tasks.switchTask(FlightTaskIndex::ManualPosition);
error = _flight_tasks.switchTask(FlightTaskIndex::ManualAcceleration);
break;
}
@ -626,16 +627,17 @@ void MulticopterPositionControl::start_flight_task() @@ -626,16 +627,17 @@ void MulticopterPositionControl::start_flight_task()
FlightTaskError error = FlightTaskError::NoError;
switch (_param_mpc_pos_mode.get()) {
case 0:
error = _flight_tasks.switchTask(FlightTaskIndex::ManualAltitude);
break;
case 1:
error = _flight_tasks.switchTask(FlightTaskIndex::ManualAltitudeSmooth);
break;
case 3:
error = _flight_tasks.switchTask(FlightTaskIndex::ManualAltitudeSmoothVel);
break;
default:
error = _flight_tasks.switchTask(FlightTaskIndex::ManualAltitude);
error = _flight_tasks.switchTask(FlightTaskIndex::ManualAltitudeSmoothVel);
break;
}

Loading…
Cancel
Save