Commit
·
7898742
1
Parent(s):
fe568fe
Update robot.py
Browse files
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 |
|