88
99import com .ctre .phoenix6 .hardware .Pigeon2 ;
1010import com .ctre .phoenix6 .swerve .SwerveDrivetrain .SwerveDriveState ;
11- import com .ctre .phoenix6 .swerve .SwerveRequest ;
1211import edu .wpi .first .epilogue .Logged ;
1312import edu .wpi .first .wpilibj2 .command .Command ;
1413import edu .wpi .first .wpilibj2 .command .Commands ;
@@ -28,21 +27,12 @@ public class RobotContainer {
2827 private Kicker kicker = new Kicker ();
2928 private CommandXboxController controller = new CommandXboxController (0 );
3029 private SwerveDriveState driveState = new SwerveDriveState ();
31- private final SwerveRequest .FieldCentric drive = new SwerveRequest .FieldCentric ();
32- private double MaxSpeed = TunerConstants .kSpeedAt12Volts .in (MetersPerSecond );
33- private double MaxAngularRate = RotationsPerSecond .of (0.75 ).in (RadiansPerSecond );
34-
35- // Should I move these to a config file?
3630
3731 public RobotContainer () {
3832 configureBindings ();
3933 }
4034
4135 private void configureBindings () {
42- // Default Commands + Drivetrain
43- flywheel .setDefaultCommand (
44- new FlywheelCommand (flywheel , FlywheelCommand .Position .DEFAULT_SHOT , drivetrain ));
45-
4636 // Drivetrain Teleop drive with controller inputs
4737 drivetrain .setDefaultCommand (
4838 new DrivetrainCommand (
@@ -70,7 +60,7 @@ private void configureBindings() {
7060 controller
7161 .rightStick ()
7262 .toggleOnTrue (new HopperCommand (hopper , HopperCommand .Position .EXTEND_RETRACT ));
73- // Right Trigger = Climb Extend
63+ // Right Trigger = Climb Retract
7464 controller
7565 .rightTrigger ()
7666 .whileTrue (new ClimbCommand (climb , ClimbCommand .Position .DIRECTIONAL_CLIMB ));
@@ -93,9 +83,9 @@ private void configureBindings() {
9383
9484 public Command getAutonomousCommand () {
9585 // Not finished yet
96- // Does withDeadline work here?
97- return ( Commands . run (() -> flywheel . getDefaultCommand (), flywheel ))
98- . withDeadline ( Commands .waitSeconds ( 5 ) );
86+ // return (new FlywheelCommand(flywheel, FlywheelCommand.Position.DEFAULT_SHOT, drivetrain)));
87+ // Placeholder
88+ return Commands .print ( "No autonomous command configured" );
9989 }
10090
10191 public static void zeroPigeon () {
0 commit comments