]> git.taranathan.com Git - FRC2026.git/commitdiff
idk i give up temporarily
authorWesleyWong-972 <wesleycwong@gmail.com>
Sun, 22 Mar 2026 17:52:08 +0000 (10:52 -0700)
committerWesleyWong-972 <wesleycwong@gmail.com>
Sun, 22 Mar 2026 17:52:08 +0000 (10:52 -0700)
src/main/java/frc/robot/commands/gpm/Superstructure.java

index ce016372131404c5030f54212a9689b8f33adbef..bb169086dcd807b2a03f650348b4bdb53e13b0a3 100644 (file)
@@ -227,7 +227,10 @@ public class Superstructure extends Command {
             // }
 
             hood.setFieldRelativeTarget(Rotation2d.fromDegrees(ShotInterpolation.newHoodMap.get(distanceFromTarget)), hoodVelocity);
-            if (FieldConstants.underTrench(drivepose.getX(), drivepose.getY())) {
+            double x = drivepose.getX(); // compared as meters
+            double y = drivepose.getY();
+            System.out.println("X: " + x + "Y: " + y);
+            if (FieldConstants.underTrench(x, y)) {
                 hood.forceHoodDown(true);
             } else {
                 hood.forceHoodDown(false);