import edu.wpi.first.math.geometry.Rotation2d;
import edu.wpi.first.math.util.Units;
import edu.wpi.first.wpilibj2.command.Command;
-import frc.robot.controls.BaseDriverConfig;
+import frc.robot.controls.PS5ControllerDriverConfig;
import frc.robot.subsystems.turret.Turret;
public class TurretJoyStickAim extends Command{
private Turret turret;
- private BaseDriverConfig driver;
+ private PS5ControllerDriverConfig driver;
public TurretJoyStickAim(Turret turret){
this.turret = turret;
driver.get(PS5Button.CROSS).onTrue(
new InstantCommand(()->{
- turretAutoShoot = new TurretAutoShoot(turret, getDrivetrain());
- CommandScheduler.getInstance().schedule(turretAutoShoot);
+ if (turretJoyStickAim == null || !turretJoyStickAim.isScheduled()){
+ turretJoyStickAim = new TurretJoyStickAim(turret, this.driver);
+ CommandScheduler.getInstance().schedule(turretAutoShoot);
+ }
})
).onFalse(
new InstantCommand(()->{
- turretAutoShoot.cancel();
+ turretJoyStickAim.cancel();
})
);
}