real-stanford/scalingup

The yellow square did not load in the image.

Closed this issue · 1 comments

When I run the hierachical_actions.py, I noticed that the yellow block is loaded below the base of the robotic arm, causing it to fail every time. Is there any solution to this issue?

and here is the output:
ERROR [GraspLinkAction] all candidates failed GraspLinkAction(link='yellow_block'):[GraspLinkPoseAction] Grasp core.py:4439
EndEffectorAction(Pose(pos=(0.24114,0.28418,0.13585),rot=(-0.91141,-0.53540,-1.18026)), grip=True, contact=True) doesn't touch
yellow_block/|yellow_block/yellow_block,[GraspLinkPoseAction] 0th action failed: [EndEffectorAction]
EndEffectorAction(Pose(pos=(0.26120,0.31592,0.11133),rot=(-0.99687,-0.24358,-0.95836)), grip=False, contact=False) collision:
yellow_block/yellow_block (20) and ur5e/wsg50/left_finger (14),[GraspLinkPoseAction] Grasp
EndEffectorAction(Pose(pos=(0.26337,0.31465,0.10856),rot=(-0.64779,0.84897,-0.02235)), grip=True, contact=True) doesn't touch
yellow_block/|yellow_block/yellow_block
WARNING [GraspLinkAction] all candidates failed GraspLinkAction(link='yellow_block'):[GraspLinkPoseAction] Grasp core.py:4489
EndEffectorAction(Pose(pos=(0.24114,0.28418,0.13585),rot=(-0.91141,-0.53540,-1.18026)), grip=True, contact=True) doesn't touch
yellow_block/|yellow_block/yellow_block,[GraspLinkPoseAction] 0th action failed: [EndEffectorAction]
EndEffectorAction(Pose(pos=(0.26120,0.31592,0.11133),rot=(-0.99687,-0.24358,-0.95836)), grip=False, contact=False) collision:
yellow_block/yellow_block (20) and ur5e/wsg50/left_finger (14),[GraspLinkPoseAction] Grasp
EndEffectorAction(Pose(pos=(0.26337,0.31465,0.10856),rot=(-0.64779,0.84897,-0.02235)), grip=True, contact=True) doesn't touch
yellow_block/|yellow_block/yellow_block|