diff --git a/gesture_control/arm_control.py b/gesture_control/arm_control.py index f7bcd75..a370eb8 100644 --- a/gesture_control/arm_control.py +++ b/gesture_control/arm_control.py @@ -93,6 +93,7 @@ class ArmController: disp = shoulder[1] - wrist[1] return disp / torso_height + ''' def compute_speeds(self, landmarks): if (landmarks[11][3] < 0.5 or landmarks[12][3] < 0.5 or landmarks[15][3] < 0.5 or landmarks[16][3] < 0.5): @@ -123,4 +124,25 @@ class ArmController: angular = ang_rel_clipped * self.config['max_speed_angular'] return linear, angular + ''' + def compute_speeds(self, w, h, landmarks): + linear = 0 + angular = 0 + if 3*w/5>landmarks[19][0]>2*w/5: + angular = 0 + if 3*w/5landmarks[19][1]>2*h/5: + linear = 0 + if 3*h/5