idk i give up temporarily

diff --git a/src/main/java/frc/robot/commands/gpm/Superstructure.java b/src/main/java/frc/robot/commands/gpm/Superstructure.java
index ce016372131404c5030f54212a9689b8f33adbef..bb169086dcd807b2a03f650348b4bdb53e13b0a3 100644 (file)
--- a/src/main/java/frc/robot/commands/gpm/Superstructure.java
+++ b/src/main/java/frc/robot/commands/gpm/Superstructure.java
@@ -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);