diff --git a/src/modules/mc_pos_control/mc_pos_control_main.cpp b/src/modules/mc_pos_control/mc_pos_control_main.cpp
index 765100eb8a..7fb9de58b0 100644
--- a/src/modules/mc_pos_control/mc_pos_control_main.cpp
+++ b/src/modules/mc_pos_control/mc_pos_control_main.cpp
@@ -3161,11 +3161,11 @@ MulticopterPositionControl::task_main()
 		if (_test_flight_tasks.get()) {
 			switch (_vehicle_status.nav_state) {
 			case vehicle_status_s::NAVIGATION_STATE_ALTCTL:
-				_flight_tasks.switchTask(FlightTaskIndex::AltitudeSmooth);
+				_flight_tasks.switchTask(FlightTaskIndex::Altitude);
 				break;
 
 			case vehicle_status_s::NAVIGATION_STATE_POSCTL:
-				_flight_tasks.switchTask(FlightTaskIndex::PositionSmooth);
+				_flight_tasks.switchTask(FlightTaskIndex::Position);
 				break;
 
 			case vehicle_status_s::NAVIGATION_STATE_MANUAL: