From 823ff57d2232c1e97077ff7257250c6f24c36a31 Mon Sep 17 00:00:00 2001
From: Heggiehog <nizcat5@gmail.com>
Date: Tue, 28 Nov 2023 17:41:44 -0800
Subject: [PATCH] Uses shuffleboard

---
 src/main/java/frc/robot/subsystems/WristSubsystem.java | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/src/main/java/frc/robot/subsystems/WristSubsystem.java b/src/main/java/frc/robot/subsystems/WristSubsystem.java
index f8224e5..a380e67 100644
--- 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) {