chooser) {
- mCurrentCommand = chooser.getSelected();
- SmartDashboard.putString("Current Auto", mCurrentCommand.getName());
- }
-
- /**
- * Gets the selected active command from the auto folders.
- * @return Selected Command
- * @see Command
- */
- public Command getSelected() {
- return mCurrentCommand;
- }
-}
diff --git a/2025-Robot-Code/src/main/java/frc/robot/Constants.java b/2025-Robot-Code/src/main/java/frc/robot/Constants.java
deleted file mode 100644
index de8265d..0000000
--- a/2025-Robot-Code/src/main/java/frc/robot/Constants.java
+++ /dev/null
@@ -1,154 +0,0 @@
-// Copyright (c) FIRST and other WPILib contributors.
-// Open Source Software; you can modify and/or share it under the terms of
-// the WPILib BSD license file in the root directory of this project.
-
-package frc.robot;
-
-import java.util.HashMap;
-import java.util.List;
-
-import com.ctre.phoenix6.CANBus;
-import com.pathplanner.lib.path.PathConstraints;
-
-import edu.wpi.first.math.geometry.Rotation3d;
-import edu.wpi.first.math.geometry.Transform3d;
-import edu.wpi.first.math.geometry.Translation3d;
-import edu.wpi.first.math.util.Units;
-
-
-/**
- * The Constants class provides a convenient place for teams to hold robot-wide
- * numerical or boolean
- * constants. This class should not be used for any other purpose. All constants
- * should be declared
- * globally (i.e. public static). Do not put anything functional in this class.
- *
- *
- * It is advised to statically import this class (or one of its inner classes)
- * wherever the
- * constants are needed, to reduce verbosity.
- */
-public final class Constants {
- public static class OperatorConstants {
- public static final int kDriverControllerPort = 0;
- public static final int kOperatorControllerPort = 1;
- public static final double kCoralRumbleStrength = 0.5;
- public static final double kBargeRumbleStrength = 0.9;
- public static final double kJoystickDeadband = 0.1;
- }
-
- public static class ElevatorConstants {
- // Motor ports
- public static final int kMotorAPort = 13;
- public static final int kMotorBPort = 14;
- // Height setpoints
- public static final double kStowedHeight = 0;
- public static final double kL1Height = 0.9;
- public static final double kL2Height = 1.67;
- public static final double kL3Height = 2.82;
- public static final double kL4Height = 4.67;
- public static final double kLowAlgaeHeight = 0.35;
- public static final double kHighAlgaeHeight = 1.625;
- // Configuration details
- public static final CANBus kMotorBus = new CANBus("canivore0");
- public static final double kSensorToMechanismRatio = 9.0;
- public static final double kMaxSpeed = 11;
- public static final double kMaxAcceleration = 20.0;
- public static final double kMaxJerk = 100.0;
- public static final double kPositionTolerance = 0.3;
- // PID constants
- public static final double kG = 0.64;
- public static final double kS = 0.25;
- public static final double kV = 1.58;
- public static final double kA = 0.07;
- public static final double kP = 60.0;
- public static final double kI = 0.0;
- public static final double kD = 0.5;
- // Current limits
- public static final double kStatorCurrentLimit = 70;
- public static final double kSupplyCurrentLimit = 120;
- }
-
- public static class DriveConstants {
- // Distance between centers of right and left wheels on robot
- public static final double kTrackWidthMeters = Units.inchesToMeters(23.72921);
- // Distance between front and back wheels on robot
- public static final double kWheelBaseMeters = Units.inchesToMeters(23.72921);
-
- public static final PathConstraints kScoringConstraints = new PathConstraints(3.0, 3.0, 2 * Math.PI, 4 * Math.PI);
-
- public static final PathConstraints kMobilityConstraints = new PathConstraints(3.0, 3.0, 2 * Math.PI, 4 * Math.PI);
-
- public static final double kL1Speed = 1.5;
- }
-
- public static class AutoConstants {
- public static final double kTranslationP = 3;
- public static final double kTranslationI = 0;
- public static final double kTranslationD = 0;
-
- public static final double kRotationP = 5.5;
- public static final double kRotationI = 0;
- public static final double kRotationD = 0;
-
- /** Map of folder names to lists of auto command names */
- public static final HashMap> kAutoFolders = new HashMap<>() {{
- put("Test Autos", List.of(
- "Test Auto",
- "Test Auto 2",
- "Test Auto 3"
- ));
-
- put("Basic Autos", List.of(
- "Do Nothing",
- "1"
- ));
- }};
- }
-
- public static class VisionConstants {
- public static String kCamera1Name = "Left";
- public static String kCamera2Name = "Right";
-
- public static final Transform3d kRobotToCam1 =
- new Transform3d(
- new Translation3d(Units.inchesToMeters(11.58), Units.inchesToMeters(11.189), Units.inchesToMeters(8.25)),
- new Rotation3d(0, Units.degreesToRadians(-15.0), Units.degreesToRadians(-20.0)));
-
- public static final Transform3d kRobotToCam2 =
- new Transform3d(
- new Translation3d(Units.inchesToMeters(11.58), Units.inchesToMeters(-11.189), Units.inchesToMeters(8.25)),
- new Rotation3d(0, Units.degreesToRadians(-15.0), Units.degreesToRadians(15.0)));
- }
-
- public static class AlgaeConstants {
- public static final int kAlgaeMotorPort = 21;
- public static final double kAlgaeMotorSpeed = 1.0;
- public static final double kAlgaeExtendedRotation = 0.25;
- public static final double kAlgaeStowedRotation = 0;
- public static final double kSensorToMechanismRatio = 25.0;
- }
-
- public static class EndEffectorConstants {
- public static final int kMotorPort = 20;
- public static final int kEntranceBreakerPort = 1;
- public static final int kExitBreakerPort = 0;
-
- public static final double kFastEjectSpeed = 0.9;
- public static final double kAutoEjectSpeed = 1;
- public static final double kDefaultEjectSpeed = 0.2;
- public static final double kL1EjectSpeed = 0.3;
- public static final double kAlgaeBargeSpeed = 1.0;
- public static final double kAlgaeProcessorSpeed = 0.3;
-
- public static final double kIdleSpeed = 0.225;
- public static final double kIntakeSpeed = 0.125;
- public static final double kDriveBackSpeed = 0.08;
-
- public static final double kSensorToMechanismRatio = 25.0;
- }
-
- public static class ClimberConstants {
- public static final double kHopperFallAngle = 120.0;
- }
-}
diff --git a/2025-Robot-Code/src/main/java/frc/robot/FieldConstants.java b/2025-Robot-Code/src/main/java/frc/robot/FieldConstants.java
deleted file mode 100644
index 2dbffde..0000000
--- a/2025-Robot-Code/src/main/java/frc/robot/FieldConstants.java
+++ /dev/null
@@ -1,222 +0,0 @@
-// Copyright (c) 2025 FRC 6328
-// http://github.com/Mechanical-Advantage
-//
-// Use of this source code is governed by an MIT-style
-// license that can be found in the LICENSE file at
-// the root directory of this project.
-
-package frc.robot;
-
-import edu.wpi.first.math.geometry.*;
-import edu.wpi.first.math.util.Units;
-import java.util.ArrayList;
-import java.util.HashMap;
-import java.util.List;
-import java.util.Map;
-
-/**
- * Contains various field dimensions and useful reference points. All units are
- * in meters and poses
- * have a blue alliance origin.
- */
-public class FieldConstants {
- public static final double fieldLength = Units.inchesToMeters(690.876);
- public static final double fieldWidth = Units.inchesToMeters(317);
- public static final Translation2d fieldCenter = new Translation2d(fieldLength / 2, fieldWidth / 2);
- public static final double startingLineX = Units.inchesToMeters(299.438); // Measured from the inside of starting
- // line
-
- public static class Processor {
- public static final Pose2d centerFace = new Pose2d(Units.inchesToMeters(235.726), 0,
- Rotation2d.fromDegrees(90));
- }
-
- public static class Barge {
- public static final Translation2d farCage = new Translation2d(Units.inchesToMeters(345.428),
- Units.inchesToMeters(286.779));
- public static final Translation2d middleCage = new Translation2d(Units.inchesToMeters(345.428),
- Units.inchesToMeters(242.855));
- public static final Translation2d closeCage = new Translation2d(Units.inchesToMeters(345.428),
- Units.inchesToMeters(199.947));
-
- // Measured from floor to bottom of cage
- public static final double deepHeight = Units.inchesToMeters(3.125);
- public static final double shallowHeight = Units.inchesToMeters(30.125);
- }
-
- public static class CoralStation {
- public static final Pose2d leftCenterFace = new Pose2d(
- Units.inchesToMeters(33.526),
- Units.inchesToMeters(291.176),
- Rotation2d.fromDegrees(90 - 144.011));
- public static final Pose2d rightCenterFace = new Pose2d(
- Units.inchesToMeters(33.526),
- Units.inchesToMeters(25.824),
- Rotation2d.fromDegrees(144.011 - 90));
- }
-
- public static class Reef {
- public static final Translation2d centerOfReef = new Translation2d(Units.inchesToMeters(176.746),
- Units.inchesToMeters(158.501));
- public static final double faceToZoneLine = Units.inchesToMeters(12); // Side of the reef to the inside of the
- // reef zone line
-
- public static final Pose2d[] centerFaces = new Pose2d[12]; // Starting facing the driver station in clockwise
- // order
- public static final List