From b46e68bd30eb45994b6fe3be0f25c33fb2ebb434 Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Alejandro=20L=C3=B3pez=20Gestoso?= <alopez@iri.upc.edu> Date: Mon, 23 Jan 2017 11:20:35 +0000 Subject: [PATCH] dynamixel_pan_tilt ROS driver -> Added a configuration file for the dynamixel RX64 servos. -> Updated the launch files to the latest changes. --- config/dyn_pan_tilt_config_RX64.xml | 23 +++++++++++++++++++++++ launch/pan_tilt_controller.launch | 12 ++++++------ launch/pan_tilt_controller_display.launch | 12 ++++++------ launch/pan_tilt_display.launch | 8 ++++---- launch/pan_tilt_solo.launch | 8 ++++---- 5 files changed, 43 insertions(+), 20 deletions(-) create mode 100644 config/dyn_pan_tilt_config_RX64.xml diff --git a/config/dyn_pan_tilt_config_RX64.xml b/config/dyn_pan_tilt_config_RX64.xml new file mode 100644 index 0000000..7c85bae --- /dev/null +++ b/config/dyn_pan_tilt_config_RX64.xml @@ -0,0 +1,23 @@ +<?xml version="1.0"?> + +<dynamixel_pan_tilt_config xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance" + xsi:noNamespaceSchemaLocation="dynamixel_pan_tilt_cfg_file.xsd"> + + <alarm_shtdwn>5</alarm_shtdwn> + <temp_limit>85</temp_limit> + <max_voltage>21</max_voltage> + <min_voltage>6</min_voltage> + <max_torque>50</max_torque> + <cw_comp_margin>2</cw_comp_margin> + <ccw_comp_margin>2</ccw_comp_margin> + <cw_comp_slope>64</cw_comp_slope> + <ccw_comp_slope>64</ccw_comp_slope> + <punch>32</punch> + <kp>0</kp> + <ki>0</ki> + <kd>0</kd> + <min_angle>-85</min_angle><!--PAN --> + <max_angle>85</max_angle><!--PAN --> + <min_angle>-110</min_angle><!--TILT --> + <max_angle>60</max_angle><!--TILT --> +</dynamixel_pan_tilt_config> diff --git a/launch/pan_tilt_controller.launch b/launch/pan_tilt_controller.launch index d23c86a..059fd44 100644 --- a/launch/pan_tilt_controller.launch +++ b/launch/pan_tilt_controller.launch @@ -23,9 +23,9 @@ value="$(find iri_dynamixel_pan_tilt)/config/dyn_server_ftdi_config.xml"/> </node> - <node pkg="iri_compliance_control_reconfigure" + <node pkg="helena_compliance_control_reconfigure" name="pan_comp_control_reconfig" - type="iri_compliance_control_reconfigure" + type="helena_compliance_control_reconfigure" output="screen"> <param name="cw_compliance_margin" type="double" @@ -48,9 +48,9 @@ to="/pan_tilt/set_pan_compliance_control"/> </node> - <node pkg="iri_compliance_control_reconfigure" + <node pkg="helena_compliance_control_reconfigure" name="tilt_comp_control_reconfig" - type="iri_compliance_control_reconfigure" + type="helena_compliance_control_reconfigure" output="screen"> <param name="cw_compliance_margin" type="double" @@ -83,9 +83,9 @@ name="PS3Joy" type="joy_node"/> - <node pkg="iri_dyn_pan_tilt_controller" + <node pkg="helena_dyn_pan_tilt_controller" name="pan_tilt_controller" - type="iri_dyn_pan_tilt_controller" + type="helena_dyn_pan_tilt_controller" output="screen"> <param name="invert_pan" type="bool" diff --git a/launch/pan_tilt_controller_display.launch b/launch/pan_tilt_controller_display.launch index 8f94cb0..8dc75d6 100644 --- a/launch/pan_tilt_controller_display.launch +++ b/launch/pan_tilt_controller_display.launch @@ -23,9 +23,9 @@ value="$(find iri_dynamixel_pan_tilt)/config/dyn_server_ftdi_config.xml"/> </node> - <node pkg="iri_compliance_control_reconfigure" + <node pkg="helena_compliance_control_reconfigure" name="pan_comp_control_reconfig" - type="iri_compliance_control_reconfigure" + type="helena_compliance_control_reconfigure" output="screen"> <param name="cw_compliance_margin" type="double" @@ -48,9 +48,9 @@ to="/pan_tilt/set_pan_compliance_control"/> </node> - <node pkg="iri_compliance_control_reconfigure" + <node pkg="helena_compliance_control_reconfigure" name="tilt_comp_control_reconfig" - type="iri_compliance_control_reconfigure" + type="helena_compliance_control_reconfigure" output="screen"> <param name="cw_compliance_margin" type="double" @@ -83,9 +83,9 @@ name="PS3Joy" type="joy_node"/> - <node pkg="iri_dyn_pan_tilt_controller" + <node pkg="helena_dyn_pan_tilt_controller" name="pan_tilt_controller" - type="iri_dyn_pan_tilt_controller" + type="helena_dyn_pan_tilt_controller" output="screen"> <param name="invert_pan" type="bool" diff --git a/launch/pan_tilt_display.launch b/launch/pan_tilt_display.launch index 7164080..d6d38a9 100644 --- a/launch/pan_tilt_display.launch +++ b/launch/pan_tilt_display.launch @@ -26,9 +26,9 @@ value="$(find iri_dynamixel_pan_tilt)/config/dyn_server_ftdi_config.xml"/> </node> - <node pkg="iri_compliance_control_reconfigure" + <node pkg="helena_compliance_control_reconfigure" name="pan_comp_control_reconfig" - type="iri_compliance_control_reconfigure" + type="helena_compliance_control_reconfigure" output="screen"> <param name="cw_compliance_margin" type="double" @@ -51,9 +51,9 @@ to="/pan_tilt/set_pan_compliance_control"/> </node> - <node pkg="iri_compliance_control_reconfigure" + <node pkg="helena_compliance_control_reconfigure" name="tilt_comp_control_reconfig" - type="iri_compliance_control_reconfigure" + type="helena_compliance_control_reconfigure" output="screen"> <param name="cw_compliance_margin" type="double" diff --git a/launch/pan_tilt_solo.launch b/launch/pan_tilt_solo.launch index ffcd4b9..9b7d2c7 100644 --- a/launch/pan_tilt_solo.launch +++ b/launch/pan_tilt_solo.launch @@ -26,9 +26,9 @@ value="$(find iri_dynamixel_pan_tilt)/config/dyn_server_ftdi_config.xml"/> </node> - <node pkg="iri_compliance_control_reconfigure" + <node pkg="helena_compliance_control_reconfigure" name="pan_comp_control_reconfig" - type="iri_compliance_control_reconfigure" + type="helena_compliance_control_reconfigure" output="screen"> <param name="cw_compliance_margin" type="double" @@ -51,9 +51,9 @@ to="/pan_tilt/set_pan_compliance_control"/> </node> - <node pkg="iri_compliance_control_reconfigure" + <node pkg="helena_compliance_control_reconfigure" name="tilt_comp_control_reconfig" - type="iri_compliance_control_reconfigure" + type="helena_compliance_control_reconfigure" output="screen"> <param name="cw_compliance_margin" type="double" -- GitLab