Climber fix and robotContainer cleanup

2026-06-09 00:38:05 -06:00 · 2022-03-20 20:18:02 -06:00
parent 70e681c7d7
commit 00f6407a7f
4 changed files with 107 additions and 260 deletions
@@ -74,6 +74,7 @@ public class AimToCenter extends CommandBase {

  public static double angleToCenter(double x, double y, double gyro) {
    double angle = ((Math.atan2(y, x) * (180./Math.PI) - gyro) + 180. + (360. * 4)) % 360.; // Finds the angle between the gyro of the robot and the target (positive x is gyro 0)
+    // double angle = Math.toDegrees(Math.atan2(y, -x) - gyro);
    return (angle - 360);
  }