diff --git a/src/main/java/frc/robot/Robot.java b/src/main/java/frc/robot/Robot.java index 49c427f3..bbfefc6a 100644 --- a/src/main/java/frc/robot/Robot.java +++ b/src/main/java/frc/robot/Robot.java @@ -13,6 +13,7 @@ import frc.robot.commands.deployer.RaiseDeployer; import frc.robot.commands.drivetrain.ResetGyro; import frc.robot.commands.drivetrain.WheelAlign; +import frc.robot.commands.ramp.RampMove; import frc.robot.commands.ramp.ResetRamp; import frc.robot.constants.Constants; import frc.robot.utils.diag.Diagnostics; @@ -75,6 +76,7 @@ public void teleopInit() { autonomousCommand.cancel(); } new RaiseDeployer(robotContainer.getDeployer()).schedule(); + new RampMove(robotContainer.getRamp(), ()->0).schedule(); } @Override diff --git a/src/main/java/frc/robot/constants/Constants2023.java b/src/main/java/frc/robot/constants/Constants2023.java index a3c239dc..98c93d40 100644 --- a/src/main/java/frc/robot/constants/Constants2023.java +++ b/src/main/java/frc/robot/constants/Constants2023.java @@ -4,10 +4,10 @@ public class Constants2023 extends GameConstants { - //Amp + //Amp public static final int AMP_ID = 5; - + //RAMP public static final double RAMP_ERROR_RANGE = 0.00; public static final double RAMP_POS = 0.0; diff --git a/src/main/java/frc/robot/constants/Constants2024.java b/src/main/java/frc/robot/constants/Constants2024.java index fcd25996..9cd667e2 100644 --- a/src/main/java/frc/robot/constants/Constants2024.java +++ b/src/main/java/frc/robot/constants/Constants2024.java @@ -4,9 +4,9 @@ public class Constants2024 extends GameConstants { - //AMP + //AMP public static final int AMP_ID = 5; - + //RAMP public static final double RAMP_ERROR_RANGE = 0.00; diff --git a/src/main/java/frc/robot/constants/ConstantsTestbed.java b/src/main/java/frc/robot/constants/ConstantsTestbed.java index d428a023..4047f578 100644 --- a/src/main/java/frc/robot/constants/ConstantsTestbed.java +++ b/src/main/java/frc/robot/constants/ConstantsTestbed.java @@ -7,7 +7,7 @@ public class ConstantsTestbed extends GameConstants { //AMP public static final int AMP_ID = 5; - + //RAMP public static final double RAMP_ERROR_RANGE = 0.00; public static final double RAMP_POS = 0.0;