diff --git a/config/arm/v10/control_gains.yaml b/config/arm/v10/control_gains.yaml index 7364f59..54452fd 100644 --- a/config/arm/v10/control_gains.yaml +++ b/config/arm/v10/control_gains.yaml @@ -39,3 +39,7 @@ joint6: joint7: kp: 10.0 kd: 0.5 + +hand: + kp: 5.0 + kd: 0.1 diff --git a/urdf/ros2_control/openarm.bimanual.ros2_control.xacro b/urdf/ros2_control/openarm.bimanual.ros2_control.xacro index 56916e5..9fa9364 100644 --- a/urdf/ros2_control/openarm.bimanual.ros2_control.xacro +++ b/urdf/ros2_control/openarm.bimanual.ros2_control.xacro @@ -42,6 +42,10 @@ ${control_gains['joint5']['kd']} ${control_gains['joint6']['kd']} ${control_gains['joint7']['kd']} + + ${control_gains['hand']['kp']} + ${control_gains['hand']['kd']} + @@ -107,6 +111,10 @@ ${control_gains['joint5']['kd']} ${control_gains['joint6']['kd']} ${control_gains['joint7']['kd']} + + ${control_gains['hand']['kp']} + ${control_gains['hand']['kd']} + diff --git a/urdf/ros2_control/openarm.ros2_control.xacro b/urdf/ros2_control/openarm.ros2_control.xacro index 223c331..1c0ec6b 100644 --- a/urdf/ros2_control/openarm.ros2_control.xacro +++ b/urdf/ros2_control/openarm.ros2_control.xacro @@ -42,6 +42,10 @@ ${control_gains['joint5']['kd']} ${control_gains['joint6']['kd']} ${control_gains['joint7']['kd']} + + ${control_gains['hand']['kp']} + ${control_gains['hand']['kd']} +