2025-02-07 09:22:54 +00:00
|
|
|
<?xml version="1.0"?>
|
|
|
|
|
<robot xmlns:xacro="http://www.ros.org/wiki/xacro">
|
2025-04-10 09:31:15 +00:00
|
|
|
<xacro:macro name="openarm_ros2_control" params="name initial_positions_file prefix:='' can_device='can0'">
|
2025-02-07 09:22:54 +00:00
|
|
|
<xacro:property name="initial_positions" value="${xacro.load_yaml(initial_positions_file)['initial_positions']}"/>
|
|
|
|
|
|
2025-03-28 09:05:38 +00:00
|
|
|
<ros2_control name="${prefix}${name}" type="system">
|
2025-02-07 09:22:54 +00:00
|
|
|
<hardware>
|
|
|
|
|
<!-- By default, set up controllers for simulation. This won't work on real hardware -->
|
2025-04-10 09:31:15 +00:00
|
|
|
<!-- <plugin>mock_components/GenericSystem</plugin> -->
|
2025-03-28 09:05:38 +00:00
|
|
|
<plugin>openarm_hardware/OpenArmHW</plugin>
|
2025-04-10 09:31:15 +00:00
|
|
|
<param name="prefix">${prefix}</param>
|
|
|
|
|
<param name="can_device">${can_device}</param>
|
2025-02-07 09:22:54 +00:00
|
|
|
</hardware>
|
2025-03-28 09:05:38 +00:00
|
|
|
<joint name="${prefix}rev1">
|
2025-02-07 09:22:54 +00:00
|
|
|
<command_interface name="position"/>
|
|
|
|
|
<command_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<command_interface name="effort"/>
|
2025-04-10 09:31:15 +00:00
|
|
|
<state_interface name="position"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<state_interface name="effort"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
</joint>
|
2025-03-28 09:05:38 +00:00
|
|
|
<joint name="${prefix}rev2">
|
2025-02-07 09:22:54 +00:00
|
|
|
<command_interface name="position"/>
|
|
|
|
|
<command_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<command_interface name="effort"/>
|
2025-04-10 09:31:15 +00:00
|
|
|
<state_interface name="position"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<state_interface name="effort"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
</joint>
|
2025-03-28 09:05:38 +00:00
|
|
|
<joint name="${prefix}rev3">
|
2025-02-07 09:22:54 +00:00
|
|
|
<command_interface name="position"/>
|
|
|
|
|
<command_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<command_interface name="effort"/>
|
2025-04-10 09:31:15 +00:00
|
|
|
<state_interface name="position"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<state_interface name="effort"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
</joint>
|
2025-03-28 09:05:38 +00:00
|
|
|
<joint name="${prefix}rev4">
|
2025-02-07 09:22:54 +00:00
|
|
|
<command_interface name="position"/>
|
|
|
|
|
<command_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<command_interface name="effort"/>
|
2025-04-10 09:31:15 +00:00
|
|
|
<state_interface name="position"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<state_interface name="effort"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
</joint>
|
2025-03-28 09:05:38 +00:00
|
|
|
<joint name="${prefix}rev5">
|
2025-02-07 09:22:54 +00:00
|
|
|
<command_interface name="position"/>
|
|
|
|
|
<command_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<command_interface name="effort"/>
|
2025-04-10 09:31:15 +00:00
|
|
|
<state_interface name="position"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<state_interface name="effort"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
</joint>
|
2025-03-28 09:05:38 +00:00
|
|
|
<joint name="${prefix}rev6">
|
2025-02-07 09:22:54 +00:00
|
|
|
<command_interface name="position"/>
|
|
|
|
|
<command_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<command_interface name="effort"/>
|
2025-04-10 09:31:15 +00:00
|
|
|
<state_interface name="position"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<state_interface name="effort"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
</joint>
|
2025-03-28 09:05:38 +00:00
|
|
|
<joint name="${prefix}rev7">
|
2025-02-07 09:22:54 +00:00
|
|
|
<command_interface name="position"/>
|
|
|
|
|
<command_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<command_interface name="effort"/>
|
2025-04-10 09:31:15 +00:00
|
|
|
<state_interface name="position"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="velocity"/>
|
2025-03-28 09:05:38 +00:00
|
|
|
<state_interface name="effort"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
</joint>
|
2025-03-28 09:05:38 +00:00
|
|
|
<joint name="${prefix}left_pris1">
|
2025-02-07 09:22:54 +00:00
|
|
|
<command_interface name="position"/>
|
2025-04-10 09:31:15 +00:00
|
|
|
<state_interface name="position"/>
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="velocity"/>
|
|
|
|
|
</joint>
|
2025-03-28 09:05:38 +00:00
|
|
|
|
2025-04-10 09:31:15 +00:00
|
|
|
<!-- <joint name="${prefix}right_pris2">
|
2025-02-07 09:22:54 +00:00
|
|
|
<state_interface name="position">
|
2025-04-10 09:31:15 +00:00
|
|
|
<param name="initial_value">${initial_positions['right_pris2']}</param>
|
2025-02-07 09:22:54 +00:00
|
|
|
</state_interface>
|
2025-04-10 09:31:15 +00:00
|
|
|
</joint> -->
|
2025-02-07 09:22:54 +00:00
|
|
|
|
|
|
|
|
</ros2_control>
|
|
|
|
|
</xacro:macro>
|
|
|
|
|
</robot>
|