climber

2026-03-05 19:34:24 +08:00
parent f7eb1d7d26
commit 0da9ee5f36
4 changed files with 75 additions and 1 deletions
@@ -145,6 +145,7 @@ public class DriveControls {
                autoControlNetworkTable.getEntry("autoRotationRate").setDouble(Double.NaN);
                break;
            case Climbing:
+                drivetrain.driveToAprilTag();
                break;
            case CrossingBump:
                double differenceBump = calculateDifferenceToTwoTarget(drivetrain.getState().Pose.getY(), Constants.AutoPositioning.bumpY[0], Constants.AutoPositioning.bumpY[1]);