93 lines
2.3 KiB
Plaintext
93 lines
2.3 KiB
Plaintext
arm {
|
|
robot_arms {
|
|
id: "right_arm"
|
|
|
|
motor {
|
|
motor_system_id: "ti5_motors"
|
|
motor_group_ids: "right_arm_can"
|
|
dof: 7
|
|
joint_names: "R_SHOULDER_P"
|
|
joint_names: "R_SHOULDER_R"
|
|
joint_names: "R_SHOULDER_Y"
|
|
joint_names: "R_ELBOW_R"
|
|
joint_names: "R_WRIST_P"
|
|
joint_names: "R_WRIST_Y"
|
|
joint_names: "R_WRIST_R"
|
|
upd_freq: 1000
|
|
buffer_size: 50
|
|
default_vel: 1.0
|
|
default_acc: 2.0
|
|
}
|
|
|
|
kinematics {
|
|
pinocchio_dls_ik_solver {
|
|
urdf_path: "model/xiaoyan_description/dual_arm.urdf"
|
|
base_frame_name: "PELVIS_S"
|
|
flange_frame_name: "R_WRIST_R_S"
|
|
tcp_frame_name: "R_FINGER_TIP_FIXED"
|
|
max_iters: 100
|
|
pos_eps: 1e-6
|
|
rot_eps: 1e-6
|
|
damping: 1e-6
|
|
joint_limits {
|
|
source: JOINT_LIMIT_SOURCE_URDF
|
|
}
|
|
joint_limit_avoidance {
|
|
enable: false
|
|
gain: 0.2
|
|
margin_ratio: 0.15
|
|
max_push: 0.25
|
|
}
|
|
}
|
|
}
|
|
|
|
motion {
|
|
move_j {
|
|
toppra_joint_motion_planner {
|
|
path_type: TOPPRA_PATH_TYPE_QUINTIC
|
|
sample_period_s: 0.001
|
|
grid_size: 150
|
|
high_grid_size: 300
|
|
}
|
|
}
|
|
|
|
move_l {
|
|
pinocchio_dls_cartesian_motion_planner {
|
|
sample_period_s: 0.001
|
|
position_gain: 4.0
|
|
rotation_gain: 4.0
|
|
}
|
|
}
|
|
|
|
speed_l {
|
|
pinocchio_dls_cartesian_motion_planner {
|
|
linear_velocity_max: 0.55
|
|
linear_acceleration_max: 5.0
|
|
linear_jerk_max: 10.0
|
|
angular_velocity_max: 1.0
|
|
angular_acceleration_max: 5.0
|
|
angular_jerk_max: 12.0
|
|
joint_acceleration_max: 8.0
|
|
linear_target_replan_threshold: 1e-4
|
|
angular_target_replan_threshold: 1e-4
|
|
linear_reverse_cos_threshold: -0.8660254037844386
|
|
linear_reverse_switch_speed_threshold: 1e-3
|
|
normal_direction_deviation_deg: 10.0
|
|
mild_direction_deviation_deg: 25.0
|
|
severe_direction_deviation_deg: 45.0
|
|
linear_min_speed_ratio: 0.2
|
|
}
|
|
|
|
speed_l_controller {
|
|
cartesian_velocity_controller {
|
|
control_period_s: 0.001
|
|
stop_twist_norm: 1e-9
|
|
stop_command_velocity_norm: 1e-3
|
|
stop_measured_velocity_norm: 1e-2
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|