Revert "VelocityControllerHelper: make use of new robotunit function to remove...

Revert "VelocityControllerHelper: make use of new robotunit function to remove and delete controllers"

This reverts commit a3e0c32a.

source/RobotAPI/libraries/RobotStatechartHelpers/VelocityControllerHelper.cpp

@@ -79,5 +79,13 @@ void VelocityControllerHelper::setNullSpaceControl(bool enabled)
 
 void VelocityControllerHelper::cleanup()
 {
-    controller->deactivateAndDeleteController();
+    controller->deactivateController();
+    if (controllerCreated)
+    {
+        while (controller->isControllerActive())
+        {
+            TimeUtil::SleepMS(1);
+        }
+        controller->deleteController();
+    }
 }