Add Pinocchio and Coal based self-collision checking with collision-pair filtering and displacement-based sampling. Integrate a periodic safety task with warning and stop thresholds, plus the simplified collision URDF and runtime configuration.
25 lines
486 B
Plaintext
25 lines
486 B
Plaintext
self_collision_task {
|
|
id: "right_arm_self_collision"
|
|
arm_id: "mujoco_right_arm"
|
|
|
|
checker {
|
|
urdf_path: "model/xiaoyan_description/dual_arm_collision.urdf"
|
|
|
|
# Simplified compact-wrist bodies overlap in the normal assembled pose.
|
|
ignored_pairs {
|
|
first: "R_WRIST_P_S"
|
|
second: "R_WRIST_R_S"
|
|
}
|
|
}
|
|
|
|
sampling {
|
|
max_geometry_displacement_m: 0.002
|
|
max_check_period_s: 0.01
|
|
}
|
|
|
|
safety {
|
|
warning_distance_m: 0.02
|
|
stop_distance_m: 0.005
|
|
}
|
|
}
|