crystal-technologies commited on
Commit
7898742
·
1 Parent(s): fe568fe

Update robot.py

Browse files
Files changed (1) hide show
  1. robot.py +1 -1
robot.py CHANGED
@@ -63,7 +63,7 @@ def grab():
63
 
64
  elbow = angle_B-elbow_origin*2.1
65
  wrist = angle_C - 90
66
- shoulder_displacement = 90-(180-(90-servo_angle))
67
  shoulder = ((angle_A + shoulder_displacement)-shoulder_origin)*2.1
68
 
69
 
 
63
 
64
  elbow = angle_B-elbow_origin*2.1
65
  wrist = angle_C - 90
66
+ shoulder_displacement = 90-(180-angle_D-(90-servo_angle))
67
  shoulder = ((angle_A + shoulder_displacement)-shoulder_origin)*2.1
68
 
69