Merge pull request #41 from ICube-Robotics/tpoignonec-use_mock_compon…

…ents Use mock components
ICube-Robotics · Apr 4, 2024 · ffe687d · ffe687d
2 parents d95b60d + d80f9da
commit ffe687d
Show file tree

Hide file tree

Showing 2 changed files with 24 additions and 9 deletions.
diff --git a/iiwa_description/package.xml b/iiwa_description/package.xml
@@ -16,6 +16,7 @@
 
   <exec_depend>xacro</exec_depend>
   <exec_depend>urdf</exec_depend>
+  <exec_depend>mock_components</exec_depend>
 
   <export>
     <build_type>ament_cmake</build_type>

diff --git a/iiwa_description/ros2_control/iiwa.r2c_hardware.xacro b/iiwa_description/ros2_control/iiwa.r2c_hardware.xacro
@@ -14,8 +14,8 @@
             <xacro:unless value="$(arg use_sim)">
                 <hardware>
                 <xacro:if value="${use_fake_hardware}">
-                    <plugin>fake_components/GenericSystem</plugin>
-                        <param name="state_following_offset">0.0</param>
+                    <plugin>mock_components/GenericSystem</plugin>
+                    <param name="calculate_dynamics">true</param>
                 </xacro:if>
                 <xacro:unless value="${use_fake_hardware}">
                     <plugin>iiwa_hardware/IiwaFRIHardwareInterface</plugin>
@@ -140,13 +140,27 @@
                 </state_interface>
             </joint>
             <sensor name="${prefix}external_torque_sensor">
-                <state_interface name="external_torque.joint_a1"/>
-                <state_interface name="external_torque.joint_a2"/>
-                <state_interface name="external_torque.joint_a3"/>
-                <state_interface name="external_torque.joint_a4"/>
-                <state_interface name="external_torque.joint_a5"/>
-                <state_interface name="external_torque.joint_a6"/>
-                <state_interface name="external_torque.joint_a7"/>
+                <state_interface name="external_torque.joint_a1">
+                    <param name="initial_value">0.0</param>
+                </state_interface>
+                <state_interface name="external_torque.joint_a2">
+                    <param name="initial_value">0.0</param>
+                </state_interface>
+                <state_interface name="external_torque.joint_a3">
+                    <param name="initial_value">0.0</param>
+                </state_interface>
+                <state_interface name="external_torque.joint_a4">
+                    <param name="initial_value">0.0</param>
+                </state_interface>
+                <state_interface name="external_torque.joint_a5">
+                    <param name="initial_value">0.0</param>
+                </state_interface>
+                <state_interface name="external_torque.joint_a6">
+                    <param name="initial_value">0.0</param>
+                </state_interface>
+                <state_interface name="external_torque.joint_a7">
+                    <param name="initial_value">0.0</param>
+                </state_interface>
             </sensor>
         </ros2_control>