Browse Source

Add hack for dex wrist height difference

pull/106/head
Binit Shah 1 year ago
parent
commit
eb85fa4f8f
1 changed files with 3 additions and 1 deletions
  1. +3
    -1
      stretch_demos/nodes/grasp_object

+ 3
- 1
stretch_demos/nodes/grasp_object View File

@ -103,7 +103,7 @@ class GraspObjectNode(hm.HelloNode):
self.stow_the_robot() self.stow_the_robot()
# 2. Scan surface and find grasp target # 2. Scan surface and find grasp target
self.look_at_surface(scan_time_s = 3.0)
self.look_at_surface(scan_time_s = 4.0)
grasp_target = self.manipulation_view.get_grasp_target(self.tf2_buffer) grasp_target = self.manipulation_view.get_grasp_target(self.tf2_buffer)
if grasp_target is None: if grasp_target is None:
return TriggerResponse( return TriggerResponse(
@ -113,6 +113,8 @@ class GraspObjectNode(hm.HelloNode):
# 3. Move to pregrasp pose # 3. Move to pregrasp pose
pregrasp_lift_m = self.manipulation_view.get_pregrasp_lift(grasp_target, self.tf2_buffer) pregrasp_lift_m = self.manipulation_view.get_pregrasp_lift(grasp_target, self.tf2_buffer)
if self.tool == "tool_stretch_dex_wrist":
pregrasp_lift_m += 0.02
if (self.lift_position is None): if (self.lift_position is None):
return TriggerResponse( return TriggerResponse(
success=False, success=False,

Loading…
Cancel
Save