double x = drivepose.getX(); // compared as meters
double y = drivepose.getY();
System.out.println("X: " + Units.metersToInches(x) + "Y: " + Units.metersToInches(y));
- if (FieldConstants.underTrench(x, y)) {
- hood.forceHoodDown(true);
- System.out.println("Hood forced down");
- } else {
- hood.forceHoodDown(false);
- System.out.println("Hood forced up");
- }
+ // if (FieldConstants.underTrench(x, y)) {
+ // hood.forceHoodDown(true);
+ // System.out.println("Hood forced down");
+ // } else {
+ // hood.forceHoodDown(false);
+ // System.out.println("Hood forced up");
+ // }
shooter.setShooter(-ShotInterpolation.shooterVelocityMap.get(distanceFromTarget));
Logger.recordOutput("Distance From Target", distanceFromTarget);
//shooter.setShooter(-ShotInterpolation.exitVelocityMap.get(goalState.exitVel()));