Add drawBox for XYConstrainedOrientedBox

source/RobotAPI/components/DebugDrawer/DebugDrawerHelper.h

@@ -24,7 +24,8 @@
 #pragma once
 
 #include <VirtualRobot/Robot.h>
-#include <SimoxUtility/eigen/OrientedBox.h>
+#include <SimoxUtility/shapes/OrientedBox.h>
+#include <SimoxUtility/shapes/XYConstrainedOrientedBox.h>
 
 #include <RobotAPI/interface/visualization/DebugDrawerInterface.h>
 #include <RobotAPI/libraries/core/Pose.h>
@@ -91,6 +92,11 @@ namespace armarx::detail::DebugDrawerHelper
         {
             drawBox(name, box.template transformation_centered<float>(), box.template dimensions<float>(), color);
         }
+        template<class FloatT>
+        void drawBox(const std::string& name, const simox::XYConstrainedOrientedBox<FloatT>& box, const DrawColor& color)
+        {
+            drawBox(name, box.template transformation_centered<float>(), box.template dimensions<float>(), color);
+        }
 
 
         void drawLine(const std::string& name, const Eigen::Vector3f& p1, const Eigen::Vector3f& p2);