diff --git a/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc b/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc
index b9b55570a6be242b2900d760f0bc657a957e3a0e..40fbad594623fe44f03693d0b980c2f941064d98 100644
--- a/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc
+++ b/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc
@@ -220,6 +220,7 @@ QList<MAV_CMD> PX4FirmwarePlugin::supportedMissionCommands(void)
          << MAV_CMD_DO_JUMP
          << MAV_CMD_CONDITION_DELAY
          << MAV_CMD_DO_VTOL_TRANSITION
-         << MAV_CMD_DO_DIGICAM_CONTROL;
+         << MAV_CMD_DO_DIGICAM_CONTROL
+         << MAV_CMD_DO_SET_SERVO;
     return list;
 }