|
|
|
@ -162,7 +162,7 @@ class ArmController:
|
|
|
|
|
|
|
|
|
|
|
|
error = 35
|
|
|
|
error = 35
|
|
|
|
|
|
|
|
|
|
|
|
if np.deg2rad(180 - error)> angle_elbow_wirst_right > np.deg2rad(180 + error):
|
|
|
|
if np.deg2rad(180 - error) < angle_elbow_wirst_right < np.deg2rad(180 + error):
|
|
|
|
angular = 0
|
|
|
|
angular = 0
|
|
|
|
|
|
|
|
|
|
|
|
elif np.deg2rad(180 - error) > angle_elbow_wirst_right:
|
|
|
|
elif np.deg2rad(180 - error) > angle_elbow_wirst_right:
|
|
|
|
@ -176,6 +176,7 @@ class ArmController:
|
|
|
|
angular = 0
|
|
|
|
angular = 0
|
|
|
|
|
|
|
|
|
|
|
|
angular = angular / 2
|
|
|
|
angular = angular / 2
|
|
|
|
|
|
|
|
#print(f"Test: {angular} {angle_elbow_wirst_right}")
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#left_shoulder_y = landmarks[11][1]
|
|
|
|
#left_shoulder_y = landmarks[11][1]
|
|
|
|
|