From 1790426f455b6ae901397780592dc9fb14cfb3fc Mon Sep 17 00:00:00 2001
From: Felix Exner <exner@fzi.de>
Date: Thu, 22 Jun 2023 16:06:11 +0200
Subject: [PATCH] Added logging output for freedrive mode in urscript

---
 resources/external_control.urscript | 4 ++++
 1 file changed, 4 insertions(+)

diff --git a/resources/external_control.urscript b/resources/external_control.urscript
index 70ee7606..f49010a2 100644
--- a/resources/external_control.urscript
+++ b/resources/external_control.urscript
@@ -248,6 +248,7 @@ def tool_contact_detection():
       kill thread_trajectory
       clear_remaining_trajectory_points()
     elif control_mode == MODE_FREEDRIVE:
+      textmsg("Leaving freedrive mode")
       end_freedrive_mode()
     else:
       kill thread_move
@@ -333,6 +334,7 @@ while keepalive > 0 and control_mode > MODE_STOPPED:
         clear_remaining_trajectory_points()
       # Stop freedrive
       elif control_mode == MODE_FREEDRIVE:
+        textmsg("Leaving freedrive mode")
         end_freedrive_mode()
       end
 
@@ -383,8 +385,10 @@ while keepalive > 0 and control_mode > MODE_STOPPED:
       set_servo_pose(pose)
     elif control_mode == MODE_FREEDRIVE:
       if params_mult[2] == FREEDRIVE_MODE_START:
+        textmsg("Entering freedrive mode")
         freedrive_mode()
       elif params_mult[2] == FREEDRIVE_MODE_STOP:
+        textmsg("Leaving freedrive mode")
         end_freedrive_mode()
       end
     end