Publishes current command information (#128)

* final command thing

* final command publishing (for passing check)

Author: UnSospiro123lol

src/main/java/frc/robot/Robot.java

@@ -129,7 +129,12 @@ public void robotPeriodic() {
     checkVision();
     SmartDashboard.putData("Driver Controller", driver.getHID());
     SmartDashboard.putData("Operator Controller", operator.getHID());
+    SmartDashboard.putData(CommandScheduler.getInstance());
+    SmartDashboard.putData(swerve);
+    SmartDashboard.putData(climber);
+    SmartDashboard.putData(leds);
     SmartDashboard.putData(powerDistribution);
+    elevator.periodic();
     SmartDashboard.putString(
         "Gamepiece", getLoadedGamepiece() == null ? "None" : getLoadedGamepiece().toString());
   }

src/main/java/frc/robot/elevator/Elevator.java

@@ -1,5 +1,6 @@
 package frc.robot.elevator;
 
+import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
 import edu.wpi.first.wpilibj2.command.Command;
 import edu.wpi.first.wpilibj2.command.Commands;
 import edu.wpi.first.wpilibj2.command.InstantCommand;
@@ -17,6 +18,14 @@ public class Elevator {
 
   public Elevator() {}
 
+  public void periodic() {
+    SmartDashboard.putData(lifter);
+    SmartDashboard.putData(coralWrist);
+    SmartDashboard.putData(coralRoller);
+    SmartDashboard.putData(algaeRoller);
+    SmartDashboard.putData(algaeWrist);
+  }
+
   public Lifter getLifter() {
     return lifter;
   }