diff --git a/.ci/Jenkinsfile-SITL_tests b/.ci/Jenkinsfile-SITL_tests
index 34d3a42ddf..6ad6022c00 100644
--- a/.ci/Jenkinsfile-SITL_tests
+++ b/.ci/Jenkinsfile-SITL_tests
@@ -93,13 +93,13 @@ pipeline {
               vehicle: "iris_obs_avoid",
               run_script: "rostest_avoidance_run.sh"
             ],
-            // [
-            //   name: "MC_safe_landing",
-            //   test: "mavros_posix_test_safe_landing.test",
-            //   mission: "MC_safe_landing",
-            //   vehicle: "iris_obs_avoid",
-            //   run_script: "rostest_avoidance_run.sh"
-            // ],
+            [
+              name: "MC_safe_landing",
+              test: "mavros_posix_test_safe_landing.test",
+              mission: "MC_safe_landing",
+              vehicle: "iris_obs_avoid",
+              run_script: "rostest_avoidance_run.sh"
+            ],
 
           ]
 
diff --git a/test/mavros_posix_test_safe_landing.test b/test/mavros_posix_test_safe_landing.test
index 4f764813b8..909a5f86d2 100644
--- a/test/mavros_posix_test_safe_landing.test
+++ b/test/mavros_posix_test_safe_landing.test
@@ -23,7 +23,7 @@
     <!-- MAVROS -->
     <include file="$(find mavros)/launch/node.launch">
         <arg name="pluginlists_yaml" value="$(find mavros)/launch/px4_pluginlists.yaml"/>
-        <arg name="config_yaml" value="$(find mavros)/launch/px4_config.yaml"/>
+        <arg name="config_yaml" value="$(find local_planner)/resource/px4_config.yaml"/>
         <arg name="gcs_url" value=""/>
         <arg name="fcu_url" value="udp://:14540@localhost:14557"/>
         <arg name="tgt_system" value="1"/>