private Command auto = new DoNothing();
// Controllers are defined here
- private PS5ControllerDriverConfig driver = null;
+ private BaseDriverConfig driver = null;
private Operator operator = null;
/**
*/
public class DefaultDriveCommand extends Command {
protected final Drivetrain swerve;
- protected final PS5ControllerDriverConfig driver;
+ protected final BaseDriverConfig driver;
public DefaultDriveCommand(
Drivetrain swerve,
- PS5ControllerDriverConfig driver) {
+ BaseDriverConfig driver) {
this.swerve = swerve;
this.driver = driver;
double forwardTranslation = driver.getForwardTranslation();
double sideTranslation = driver.getSideTranslation();
double rotation = -driver.getRotation();
- // if (swerve.getTrenchAssist()) {
- // sideTranslation = Math
- // .sqrt(driver.controller.get(PS5Axis.LEFT_X) * driver.controller.get(PS5Axis.LEFT_Y)
- // * driver.controller.get(PS5Axis.LEFT_X) * driver.controller.get(PS5Axis.LEFT_Y))
- // *
- // new Rotation2d(driver.controller.get(PS5Axis.LEFT_X), driver.controller.get(PS5Axis.LEFT_Y))
- // .rotateBy(swerve.getYaw()).getCos();
- // forwardTranslation = Math
- // .sqrt(driver.controller.get(PS5Axis.LEFT_X) * driver.controller.get(PS5Axis.LEFT_Y)
- // * driver.controller.get(PS5Axis.LEFT_X) * driver.controller.get(PS5Axis.LEFT_Y))
- // *
- // new Rotation2d(driver.controller.get(PS5Axis.LEFT_X), driver.controller.get(PS5Axis.LEFT_Y))
- // .rotateBy(swerve.getYaw()).getSin();
- // }
double slowFactor = driver.getIsSlowMode() ? DriveConstants.SLOW_DRIVE_FACTOR : 1;
private static DetectedObject cachedObject;
- public AimAtGamePiece(Drivetrain drive, PS5ControllerDriverConfig driver, Supplier<DetectedObject> objectSupplier){
+ public AimAtGamePiece(Drivetrain drive, BaseDriverConfig driver, Supplier<DetectedObject> objectSupplier){
super(drive, driver);
this.objectSupplier = objectSupplier;
}