44
55package frc .robot ;
66
7- import edu .wpi .first .math .geometry .Pose2d ;
87import edu .wpi .first .math .geometry .Rotation2d ;
98import edu .wpi .first .networktables .GenericEntry ;
109import edu .wpi .first .wpilibj .DriverStation .Alliance ;
3635import frc .robot .commands .drive .DriveTeleopCommand ;
3736import frc .robot .commands .drive .LockZeroCommand ;
3837import frc .robot .commands .drive .ResetGyroCommand ;
39- import frc .robot .commands .drive .SetGyroOffsetCommand ;
4038import frc .robot .commands .drive .ToggleVisionUpdatesCommand ;
4139import frc .robot .commands .drive .XLockCommand ;
42- import frc .robot .commands .drive .setAngleOffsetCommand ;
4340import frc .robot .commands .elbow .ClosedLoopElbowCommand ;
4441import frc .robot .commands .elbow .HoldElbowCommand ;
4542import frc .robot .commands .elbow .JogElbowClosedLoopCommand ;
5148import frc .robot .commands .robotState .ClimbCommand ;
5249import frc .robot .commands .robotState .ClimbTrapDecendCommand ;
5350import frc .robot .commands .robotState .DecendCommand ;
54- import frc .robot .commands .robotState .DistanceShootCommand ;
5551import frc .robot .commands .robotState .FullTrapClimbCommand ;
5652import frc .robot .commands .robotState .IntakeCommand ;
5753import frc .robot .commands .robotState .PodiumCommand ;
58- import frc .robot .commands .robotState .PositionShootCommand ;
5954import frc .robot .commands .robotState .PostClimbStowCommand ;
6055import frc .robot .commands .robotState .PrepClimbCommand ;
6156import frc .robot .commands .robotState .ReleaseNoteCommand ;
62- import frc .robot .commands .robotState .ScoreTrapCommand ;
6357import frc .robot .commands .robotState .StowCommand ;
6458import frc .robot .commands .robotState .SubWooferCommand ;
6559import frc .robot .commands .robotState .ToggleDefenseCommand ;
66- import frc .robot .commands .robotState .TrapCommand ;
6760import frc .robot .commands .robotState .TunedShotCommand ;
6861import frc .robot .commands .robotState .TuningOffCommand ;
6962import frc .robot .commands .robotState .TuningShootCommand ;
7063import frc .robot .commands .robotState .VisionShootCommand ;
7164import frc .robot .commands .wrist .ClosedLoopWristCommand ;
7265import frc .robot .commands .wrist .OpenLoopWristCommand ;
73- import frc .robot .constants .AutonConstants ;
7466import frc .robot .constants .RobotConstants ;
7567import frc .robot .controllers .FlyskyJoystick ;
7668import frc .robot .controllers .FlyskyJoystick .Button ;
@@ -282,9 +274,12 @@ public void configurePitDashboard() {
282274 .withSize (1 , 1 )
283275 .withPosition (2 , 0 );
284276
285- Shuffleboard .getTab ("Pit" ).add ("Wrist Pos Zero" , new ClosedLoopWristCommand (wristSubsystem , 0 )).withSize (1 , 1 ).withPosition (3 , 0 );
277+ Shuffleboard .getTab ("Pit" )
278+ .add ("Wrist Pos Zero" , new ClosedLoopWristCommand (wristSubsystem , 0 ))
279+ .withSize (1 , 1 )
280+ .withPosition (3 , 0 );
286281
287- Shuffleboard .getTab ("Pit" )
282+ Shuffleboard .getTab ("Pit" )
288283 .add ("Zero Climb" , new ZeroClimbCommand (climbSubsystem ))
289284 .withSize (1 , 1 )
290285 .withPosition (4 , 0 );
@@ -299,20 +294,20 @@ public void configurePitDashboard() {
299294 .withSize (1 , 1 )
300295 .withPosition (1 , 1 );
301296
302- Shuffleboard .getTab ("Pit" )
297+ Shuffleboard .getTab ("Pit" )
303298 .add ("Lock Wheels Zero" , new LockZeroCommand (driveSubsystem ))
304299 .withSize (1 , 1 )
305300 .withPosition (3 , 1 );
306- // Shuffleboard.getTab("Pit")
307- // .add("Elbow to zero", new ClosedLoopElbowCommand(elbowSubsystem, 0))
308- // .withSize(1, 1)
309- // .withPosition(2, 0);
310-
301+ // Shuffleboard.getTab("Pit")
302+ // .add("Elbow to zero", new ClosedLoopElbowCommand(elbowSubsystem, 0))
303+ // .withSize(1, 1)
304+ // .withPosition(2, 0);
311305
312306 // // Climb buttons
313307 // Shuffleboard.getTab("Pit")
314308 // .add(
315- // "Prep Climb", new PrepClimbCommand(robotStateSubsystem, climbSubsystem, superStructure))
309+ // "Prep Climb", new PrepClimbCommand(robotStateSubsystem, climbSubsystem,
310+ // superStructure))
316311 // .withSize(1, 1)
317312 // .withPosition(0, 2);
318313 // Shuffleboard.getTab("Pit")
@@ -363,16 +358,13 @@ public void configurePitDashboard() {
363358 // .withSize(1, 1)
364359 // .withPosition(0, 1);
365360
366-
367361 // Shuffleboard.getTab("Pit")
368362 // .add(
369363 // "Set Gyro offset -50",
370364 // new SetGyroOffsetCommand(driveSubsystem, Rotation2d.fromDegrees(-50)))
371365 // .withSize(1, 1)
372366 // .withPosition(3, 0);
373367
374-
375-
376368 // Shuffleboard.getTab("Pit")
377369 // .add(
378370 // "DistanceShoot",
@@ -392,8 +384,6 @@ public void configurePitDashboard() {
392384 // .withSize(1, 1)
393385 // .withPosition(7, 2);
394386
395-
396-
397387 // Shuffleboard.getTab("Pit")
398388 // .add(
399389 // "PositionShoot",
@@ -470,9 +460,18 @@ private void configureMatchDashboard() {
470460 }
471461
472462 public void configureDebugDashboard () {
473- Shuffleboard .getTab ("Debug" ).add (new DecendCommand (robotStateSubsystem , climbSubsystem , superStructure )).withSize (1 , 1 ).withPosition (0 , 0 );
474- Shuffleboard .getTab ("Debug" ).add (new ZeroClimbCommand (climbSubsystem )).withSize (1 , 1 ).withPosition (1 , 0 );
475- Shuffleboard .getTab ("Debug" ).add (new ZeroRecoveryElbowCommand (elbowSubsystem )).withSize (1 , 1 ).withPosition (2 , 0 );
463+ Shuffleboard .getTab ("Debug" )
464+ .add (new DecendCommand (robotStateSubsystem , climbSubsystem , superStructure ))
465+ .withSize (1 , 1 )
466+ .withPosition (0 , 0 );
467+ Shuffleboard .getTab ("Debug" )
468+ .add (new ZeroClimbCommand (climbSubsystem ))
469+ .withSize (1 , 1 )
470+ .withPosition (1 , 0 );
471+ Shuffleboard .getTab ("Debug" )
472+ .add (new ZeroRecoveryElbowCommand (elbowSubsystem ))
473+ .withSize (1 , 1 )
474+ .withPosition (2 , 0 );
476475 }
477476
478477 public void configureTuningDashboard () {
0 commit comments