feature: Implement disableAndStop and enable for PlatformUnitExecutor

source/Navigation/libraries/server/execution/PlatformUnitExecutor.cpp

@@ -17,7 +17,21 @@ namespace armarx::nav::server
 
     void PlatformUnitExecutor::move(const core::Twist& twist)
     {
-        platformUnit->move(twist.linear.x(), twist.linear.y(), twist.angular.z());
+        if (enabled.get())
+        {
+            platformUnit->move(twist.linear.x(), twist.linear.y(), twist.angular.z());
+        }
+    }
+
+    void PlatformUnitExecutor::disableAndStop()
+    {
+        enabled.set(false);
+        platformUnit->move(0, 0, 0);
+    }
+
+    void PlatformUnitExecutor::enable()
+    {
+        enabled.set(true);
     }
 
 }