Skip to content

Commit 43684fc

Browse files
committed
add controller configuration yaml for ROBOTIQ
1 parent 098678b commit 43684fc

File tree

3 files changed

+87
-0
lines changed

3 files changed

+87
-0
lines changed
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,40 @@
1+
hrpsys_gazebo_configuration:
2+
publish_joint_state:
3+
topic: /joint_states
4+
step: 25
5+
## velocity feedback for joint control, use parameter gains/joint_name/p_v
6+
# use_velocity_feedback: true
7+
## synchronized hrpsys and gazebo
8+
# use_synchronized_command: false
9+
# name of robot (using for namespace)
10+
robotname: L_ROBOTIQ
11+
# joint_id (order) conversion from gazebo to hrpsys, joint_id_list[gazebo_id] := hrpsys_id
12+
joint_id_list: [0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11]
13+
# joints list used in gazebo, sizeof(joint_id_list) == sizeof(joints)
14+
joints:
15+
- L_finger_1_joint_1
16+
- L_finger_1_joint_2
17+
- L_finger_1_joint_3
18+
- L_finger_2_joint_1
19+
- L_finger_2_joint_2
20+
- L_finger_2_joint_3
21+
- L_finger_middle_joint_1
22+
- L_finger_middle_joint_2
23+
- L_finger_middle_joint_3
24+
- L_palm_finger_1_joint
25+
- L_palm_finger_2_joint
26+
- L_palm_finger_middle_joint
27+
## jointid:
28+
gains:
29+
L_finger_1_joint_1 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
30+
L_finger_1_joint_2 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
31+
L_finger_1_joint_3 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
32+
L_finger_2_joint_1 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
33+
L_finger_2_joint_2 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
34+
L_finger_2_joint_3 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
35+
L_finger_middle_joint_1 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
36+
L_finger_middle_joint_2 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
37+
L_finger_middle_joint_3 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
38+
L_palm_finger_1_joint : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
39+
L_palm_finger_2_joint : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
40+
L_palm_finger_middle_joint : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,40 @@
1+
hrpsys_gazebo_configuration:
2+
publish_joint_state:
3+
topic: /joint_states
4+
step: 25
5+
## velocity feedback for joint control, use parameter gains/joint_name/p_v
6+
# use_velocity_feedback: true
7+
## synchronized hrpsys and gazebo
8+
# use_synchronized_command: false
9+
# name of robot (using for namespace)
10+
robotname: R_ROBOTIQ
11+
# joint_id (order) conversion from gazebo to hrpsys, joint_id_list[gazebo_id] := hrpsys_id
12+
joint_id_list: [0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11]
13+
# joints list used in gazebo, sizeof(joint_id_list) == sizeof(joints)
14+
joints:
15+
- R_finger_1_joint_1
16+
- R_finger_1_joint_2
17+
- R_finger_1_joint_3
18+
- R_finger_2_joint_1
19+
- R_finger_2_joint_2
20+
- R_finger_2_joint_3
21+
- R_finger_middle_joint_1
22+
- R_finger_middle_joint_2
23+
- R_finger_middle_joint_3
24+
- R_palm_finger_1_joint
25+
- R_palm_finger_2_joint
26+
- R_palm_finger_middle_joint
27+
## jointid:
28+
gains:
29+
R_finger_1_joint_1 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
30+
R_finger_1_joint_2 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
31+
R_finger_1_joint_3 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
32+
R_finger_2_joint_1 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
33+
R_finger_2_joint_2 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
34+
R_finger_2_joint_3 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
35+
R_finger_middle_joint_1 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
36+
R_finger_middle_joint_2 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
37+
R_finger_middle_joint_3 : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
38+
R_palm_finger_1_joint : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
39+
R_palm_finger_2_joint : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}
40+
R_palm_finger_middle_joint : {p: 10.0, d: 0.01, i: 0.0, i_clamp: 0.0, p_v: 10.0}

hrpsys_gazebo_tutorials/launch/gazebo_staro_no_controllers.launch

+7
Original file line numberDiff line numberDiff line change
@@ -7,6 +7,13 @@
77

88
<arg if="$(arg USE_HAND)"
99
name="USE_MODEL" value="$(find hrpsys_gazebo_tutorials)/robot_models/STARO/STARO_with_hand.urdf.xacro" />
10+
<rosparam if="$(arg USE_HAND)"
11+
command="load"
12+
file="$(find hrpsys_gazebo_tutorials)/config/L_ROBOTIQ.yaml" ns="L_ROBOTIQ" />
13+
<rosparam if="$(arg USE_HAND)"
14+
command="load"
15+
file="$(find hrpsys_gazebo_tutorials)/config/R_ROBOTIQ.yaml" ns="R_ROBOTIQ" />
16+
1017
<arg unless="$(arg USE_HAND)"
1118
name="USE_MODEL" value="$(find hrpsys_gazebo_tutorials)/robot_models/STARO/STARO.urdf.xacro" />
1219

0 commit comments

Comments
 (0)