use os exit, verify on the hardware

spot_rl_experiments/spot_rl/utils/skill_executor.py

@@ -592,22 +592,27 @@ def main():
     parser.add_argument("--useful_parameters", action="store_true")
     _ = parser.parse_args()
 
-    while True:
-        reset_ros_param()
-        # Call the skill manager
-        spotskillmanager = SpotSkillManager(
-            use_mobile_pick=True, use_semantic_place=True, use_place_ee=True
-        )
-        executor = None
+    try:
+        while True:
+            reset_ros_param()
+            # Call the skill manager
+            spotskillmanager = SpotSkillManager(
+                use_mobile_pick=True, use_semantic_place=True, use_place_ee=True
+            )
+            executor = None
+            try:
+                rospy.set_param("skill_in_execution_lock", False)
+                executor = SpotRosSkillExecutor(spotskillmanager)
+                # While loop to run in the background
+                while not rospy.is_shutdown() and not executor.end:
+                    executor.execute_skills()
+            except Exception as e:
+                print(f"Ending script: {e}\n Full exception : {traceback.print_exc()}")
+    except KeyboardInterrupt:
         try:
-            rospy.set_param("skill_in_execution_lock", False)
-            executor = SpotRosSkillExecutor(spotskillmanager)
-            # While loop to run in the background
-            while not rospy.is_shutdown() and not executor.end:
-                executor.execute_skills()
-        except Exception as e:
-            print(f"Ending script: {e}\n Full exception : {traceback.print_exc()}")
-            sys.exit()
+            sys.exit(0)
+        except SystemExit:
+            os._exit(0)
 
 
 if __name__ == "__main__":