Fix urdf include

moveit2.repos

@@ -12,3 +12,7 @@ repositories:
     type: git
     url: https://github.com/moveit/moveit_resources.git
     version: ros2
+  srdfdom:
+    type: git
+    url: https://github.com/moveit/srdfdom.git
+    version: ros2

moveit_core/constraint_samplers/test/pr2_arm_ik.h

@@ -37,7 +37,11 @@
 #pragma once
 
 #include <urdf_model/model.h>
+#if __has_include(<urdf/model.hpp>)
+#include <urdf/model.hpp>
+#else
 #include <urdf/model.h>
+#endif
 #include <Eigen/Geometry>
 #include <Eigen/LU>  // provides LU decomposition
 #include <kdl/chainiksolver.hpp>

moveit_core/constraint_samplers/test/pr2_arm_kinematics_plugin.h

@@ -50,7 +50,11 @@
 
 #include <kdl/chainfksolverpos_recursive.hpp>
 
+#if __has_include(<urdf/model.hpp>)
+#include <urdf/model.hpp>
+#else
 #include <urdf/model.h>
+#endif
 
 #include <moveit/kinematics_base/kinematics_base.h>
 

moveit_core/utils/include/moveit/utils/robot_model_test_utils.h

@@ -38,7 +38,11 @@
 #pragma once
 
 #include <srdfdom/srdf_writer.h>
+#if __has_include(<urdf/model.hpp>)
+#include <urdf/model.hpp>
+#else
 #include <urdf/model.h>
+#endif
 #include <moveit/robot_model/robot_model.h>
 #include <geometry_msgs/msg/pose.hpp>
 

moveit_ros/planning/rdf_loader/include/moveit/rdf_loader/rdf_loader.h

@@ -38,7 +38,11 @@
 
 #include <moveit/macros/class_forward.h>
 #include <moveit/rdf_loader/synchronized_string_parameter.h>
+#if __has_include(<urdf/model.hpp>)
+#include <urdf/model.hpp>
+#else
 #include <urdf/model.h>
+#endif
 #include <srdfdom/model.h>
 #include <rclcpp/rclcpp.hpp>
 

moveit_setup_assistant/moveit_setup_framework/include/moveit_setup_framework/data/urdf_config.hpp

@@ -35,7 +35,11 @@
 #pragma once
 
 #include <moveit_setup_framework/config.hpp>
-#include <urdf/model.h>  // for testing a valid urdf is loaded
+#if __has_include(<urdf/model.hpp>)  // for testing a valid urdf is loaded
+#include <urdf/model.hpp>
+#else
+#include <urdf/model.h>
+#endif
 
 namespace moveit_setup
 {