diff --git a/src/main/java/frc/robot/commands/TestDrivePID.java b/src/main/java/frc/robot/commands/TestDrivePID.java deleted file mode 100644 index b06c9a2..0000000 --- a/src/main/java/frc/robot/commands/TestDrivePID.java +++ /dev/null @@ -1,41 +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.commands; - -import edu.wpi.first.wpilibj2.command.CommandBase; -import frc.robot.Constants; -import frc.robot.subsystems.Drive; - -public class TestDrivePID extends CommandBase { - private final Drive drive; - - /** Creates a new TestDrivePID. */ - public TestDrivePID(Drive drive) { - // Use addRequirements() here to declare subsystem dependencies. - this.drive = drive; - } - - // Called when the command is initially scheduled. - @Override - public void initialize() {} - - // Called every time the scheduler runs while the command is scheduled. - @Override - public void execute() { - drive.setVelocity(Constants.Drive.TEST_PID_SETPOINT, Constants.Drive.TEST_PID_SETPOINT); - } - - // Called once the command ends or is interrupted. - @Override - public void end(boolean interrupted) { - drive.setVelocity(0, 0); - } - - // Returns true when the command should end. - @Override - public boolean isFinished() { - return false; - } -} diff --git a/src/main/java/frc/robot/subsystems/Drive.java b/src/main/java/frc/robot/subsystems/Drive.java index 2ad5ce8..b9c5237 100644 --- a/src/main/java/frc/robot/subsystems/Drive.java +++ b/src/main/java/frc/robot/subsystems/Drive.java @@ -412,8 +412,5 @@ public void periodic() { whereTheHeckAreWe.addVisionMeasurement(limelight.getBotpose2d(), Timer.getFPGATimestamp()); } } - - /* TODO: REMOVE IN PROD */ - // updatePIDValuesFromSmartDash(); } }