Uses shuffleboard

Iron-Panthers · Nov 29, 2023 · 823ff57 · 823ff57
1 parent fafd13e
commit 823ff57
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/src/main/java/frc/robot/subsystems/WristSubsystem.java b/src/main/java/frc/robot/subsystems/WristSubsystem.java
@@ -42,6 +42,9 @@ public WristSubsystem() {
 
     pidController = new PIDController(0.1, 0, 0);
     WristTab.add(pidController);
+    WristTab.addNumber("Current Motor Position", wrist_motor::getSelectedSensorPosition);
+    WristTab.addBoolean("Is at target", this::nearTargetAngle);
+    WristTab.addNumber("Target Angle", () -> this.targetAngle);
 }
 
   public static double degreesToTicks(double angle) {