Closed yck011522 closed 2 years ago
So only gripper_aligned pickup station can meaningfully benefit from a saved config.
If the beam is aligned to the pickup station table. Then the pickup configuration is different everytime. If it would be possible to specify a few joint values for creating the IK of those pickup it would be helpful to maintain high repeatability. But the interface to pathplan and get IK will need to change and will be quite complicated.
As per discussion with @yijiangh
gripper_tcp_frame_at_pickup
and robot_config_at_pickup
will be refactored to be stored in the GripperAlignedPickupStation Class. Each tool_id can have its own gripper_tcp_frame_at_pickup
and robot_config_at_pickup
, if left unset, a default pickup frame is used and the robot config will be set to None (unconstrained)
This will allow each tool that can be used as a Gripper to have a different taught config for pickup.
Currently nine_piece_process cannot pass check_state.py