Degrees to raidans

DeepBlueRobotics · Mar 3, 2024 · 84db8ea · 84db8ea
1 parent 656e1ad
commit 84db8ea
Showing 1 changed file with 7 additions and 7 deletions.
diff --git a/src/main/java/org/carlmontrobotics/Constants.java b/src/main/java/org/carlmontrobotics/Constants.java
@@ -48,13 +48,13 @@ public static final class Arm {
 		//TODO: finish understand why this is broken public static final Measure<Angle> INTAKE_ANGLE = Degrees.to(-1);
 
 		// USE RADIANS FOR THE ARM
-		public static final double INTAKE_ANGLE = Math.toRadians(0);
-		public static final double AMP_ANGLE = Math.toRadians(105);
-		public static final double SUBWOFFER_ANGLE = Math.toRadians(24);
-		public static final double SAFE_ZONE_ANGLE = Math.toRadians(24);
-		public static final double PODIUM_ANGLE = Math.toRadians(24);
-		public static final double CLIMBER_UP_ANGLE = Math.toRadians(24);
-		public static final double CLIMBER_DOWN_ANGLE = Math.toRadians(24);
+		public static final double INTAKE_ANGLE = Units.degreesToRadians(0);
+		public static final double AMP_ANGLE = Units.degreesToRadians(105);
+		public static final double SUBWOFFER_ANGLE = Units.degreesToRadians(24);
+		public static final double SAFE_ZONE_ANGLE = Units.degreesToRadians(24);
+		public static final double PODIUM_ANGLE = Units.degreesToRadians(24);
+		public static final double CLIMBER_UP_ANGLE = Units.degreesToRadians(24);
+		public static final double CLIMBER_DOWN_ANGLE = Units.degreesToRadians(24);
 
 
 		//PID, Feedforward, Trapezoid