Added auto constant file #BESTLG-22

Monarch-Robotics-1245 · Oct 23, 2024 · ed9e19e · ed9e19e
1 parent 46711a7
commit ed9e19e
Show file tree

Hide file tree

Showing 2 changed files with 13 additions and 1 deletion.
diff --git a/constants/auto.py b/constants/auto.py
@@ -0,0 +1,9 @@
+TURRET_START_A = 0
+TURRET_START_B = 0
+GRIPPER_OPEN = 0
+BACK_SPEED = 0
+WRIST_START = 0
+TURRET_ROTATION = 0
+WRIST_END = 0
+GRIPPER_CLOSE = 0
+FWD_SPEED = 0
diff --git a/subsystems/wrist.py b/subsystems/wrist.py
@@ -27,15 +27,18 @@
 
 import constants.wrist
 
-
+servoTwo = 0
 
 def wristUp():
+    global servoTwo
     servoTwo += constants.wrist.ROTATE_INCREMENT
 
 
 def wristDown():
+    global servoTwo
     servoTwo -= constants.wrist.ROTATE_INCREMENT
 
 
 def setWrist(value):
+    global servoTwo
     servoTwo = value