Add plugins to get the PTZ joint states out of gazebo and into ROS (#126

)
clearpathrobotics · Dec 9, 2024 · 51df8e9 · 51df8e9
1 parent c26ac0e
commit 51df8e9
Show file tree

Hide file tree

Showing 2 changed files with 22 additions and 2 deletions.
diff --git a/clearpath_sensors_description/urdf/axis/axis_dome_ptz.urdf.xacro b/clearpath_sensors_description/urdf/axis/axis_dome_ptz.urdf.xacro
@@ -112,6 +112,14 @@
         <cmd_max>2.61</cmd_max>
         <topic>$(arg namespace)/sensors/${prefix}/cmd_tilt_vel</topic>
       </plugin>
+      <plugin filename="gz-sim-joint-state-publisher-system" name="gz::sim::systems::JointStatePublisher">
+        <joint_name>${prefix}_pan_joint</joint_name>
+        <topic>$(arg namespace)/sensors/${prefix}/pan_joint_state</topic>
+      </plugin>
+      <plugin filename="gz-sim-joint-state-publisher-system" name="gz::sim::systems::JointStatePublisher">
+        <joint_name>${prefix}_tilt_joint</joint_name>
+        <topic>$(arg namespace)/sensors/${prefix}/tilt_joint_state</topic>
+      </plugin>
     </gazebo>
     <gazebo reference="${prefix}_link">
       <material>Gazebo/Black</material>

diff --git a/clearpath_sensors_description/urdf/axis/axis_q62.urdf.xacro b/clearpath_sensors_description/urdf/axis/axis_q62.urdf.xacro
@@ -97,14 +97,18 @@
           <box size="0.03 0.09 0.01" />
         </geometry>
         <origin xyz="-0.01 0 0.05" rpy="0 0 0" />
-        <material name="black" />
+        <material name="black">
+          <color rgba="0 0 0 1" />
+        </material>
       </visual>
       <visual>
         <geometry>
           <box size="0.03 0.09 0.01" />
         </geometry>
         <origin xyz="-0.01 0.20 0.05" rpy="0 0 0" />
-        <material name="black" />
+        <material name="black">
+          <color rgba="0 0 0 1" />
+        </material>
       </visual>
       <inertial>
         <origin xyz="0 0 0" rpy="0 0 0" />
@@ -138,6 +142,14 @@
         <cmd_max>2.61</cmd_max>
         <topic>$(arg namespace)/sensors/${prefix}/cmd_tilt_vel</topic>
       </plugin>
+      <plugin filename="gz-sim-joint-state-publisher-system" name="gz::sim::systems::JointStatePublisher">
+        <joint_name>${prefix}_pan_joint</joint_name>
+        <topic>$(arg namespace)/sensors/${prefix}/pan_joint_state</topic>
+      </plugin>
+      <plugin filename="gz-sim-joint-state-publisher-system" name="gz::sim::systems::JointStatePublisher">
+        <joint_name>${prefix}_tilt_joint</joint_name>
+        <topic>$(arg namespace)/sensors/${prefix}/tilt_joint_state</topic>
+      </plugin>
     </gazebo>
     <gazebo reference="${prefix}_link">
       <plugin filename="libgz-sim-sensors-system.so" name="gz::sim::systems::Sensors">