forked from ros-industrial/universal_robot
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathur5_controllers.yaml
36 lines (34 loc) · 1.28 KB
/
ur5_controllers.yaml
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
joint_state_controller:
type: joint_state_controller/JointStateController
publish_rate: &loop_hz 125
eff_joint_traj_controller:
type: effort_controllers/JointTrajectoryController
joints: &robot_joints
- shoulder_pan_joint
- shoulder_lift_joint
- elbow_joint
- wrist_1_joint
- wrist_2_joint
- wrist_3_joint
gains: # Required because we're controlling an effort interface
shoulder_pan_joint: {p: 4000, d: 200, i: 1, i_clamp: 1}
shoulder_lift_joint: {p: 10000, d: 200, i: 1, i_clamp: 1}
elbow_joint: {p: 2000, d: 20, i: 1, i_clamp: 1}
wrist_1_joint: {p: 500, d: 1, i: 1, i_clamp: 1}
wrist_2_joint: {p: 500, d: 1, i: 1, i_clamp: 1}
wrist_3_joint: {p: 10, d: 0.1, i: 0, i_clamp: 1}
constraints:
goal_time: 0.6
stopped_velocity_tolerance: 0.05
shoulder_pan_joint: {trajectory: 0.1, goal: 0.1}
shoulder_lift_joint: {trajectory: 0.1, goal: 0.1}
elbow_joint: {trajectory: 0.1, goal: 0.1}
wrist_1_joint: {trajectory: 0.1, goal: 0.1}
wrist_2_joint: {trajectory: 0.1, goal: 0.1}
wrist_3_joint: {trajectory: 0.1, goal: 0.1}
stop_trajectory_duration: 0.5
state_publish_rate: *loop_hz
action_monitor_rate: 10
joint_group_eff_controller:
type: effort_controllers/JointGroupEffortController
joints: *robot_joints