@@ -86,12 +86,14 @@ def __init__(
8686 )
8787
8888 # Gripper range in degrees (for internal SDK communication)
89- self .GRIPPER_DEGREES_MIN = 0 .000
89+ self .GRIPPER_DEGREES_MIN = - 5 .000
9090 self .GRIPPER_DEGREES_MAX = 95.00
9191 self .GRIPPER_DEGREES_RANGE = self .GRIPPER_DEGREES_MAX - self .GRIPPER_DEGREES_MIN
9292
93- # Home gripper value in normalized form (53.8 / 95.0)
94- self .HOME_GRIPPER_OPEN_VALUE_DEGREES = 53.800
93+ # Home gripper value in degrees
94+ self .HOME_GRIPPER_OPEN_VALUE_DEGREES = (
95+ self .GRIPPER_DEGREES_RANGE / 2.0
96+ ) + self .GRIPPER_DEGREES_MIN
9597
9698 # End-effector target pose
9799 self ._target_pose = self .HOME_POSE .copy ()
@@ -351,7 +353,6 @@ def set_gripper_open_value(self, gripper_open_value: float) -> None:
351353 self ._gripper_open_value_degrees = (
352354 normalized * self .GRIPPER_DEGREES_RANGE + self .GRIPPER_DEGREES_MIN
353355 )
354-
355356 if self .debug_mode :
356357 print (f"Gripper updated: { normalized :.3f} (normalized)" )
357358
@@ -549,6 +550,7 @@ def _send_gripper_command(self, gripper_open_value_degrees: float) -> None:
549550 try :
550551 # Convert from degrees to piper SDK units (0.001degrees)
551552 gripper_value = round (gripper_open_value_degrees * 1000 )
553+
552554 self .piper .GripperCtrl (gripper_value , 1000 , 0x01 , 0 )
553555
554556 except Exception as e :
0 commit comments