get reset yaw angle from nt value

FRC-1721 · Mar 17, 2024 · f545fe7 · f545fe7
1 parent 8ff8704
commit f545fe7
Showing 1 changed file with 7 additions and 2 deletions.
diff --git a/rio/commands/ResetYaw.py b/rio/commands/ResetYaw.py
@@ -2,6 +2,7 @@
 import logging
 
 from subsystems.drivesubsystem import DriveSubsystem
+from ntcore import NetworkTableInstance
 
 
 class ResetYaw(commands2.Command):
@@ -12,12 +13,16 @@ def __init__(
     ):
         super().__init__()
 
+        # Configure networktables
+        self.nt = NetworkTableInstance.getDefault()
+        self.sd = self.nt.getTable("SmartDashboard")
+
         # local subsystem instance
         self.subsystem = _drivetrain
-        self.angle = angle
 
     def initialize(self):
-        self.subsystem.resetYaw(self.angle)
+        print("i b setn' 0 t' " + str(self.sd.getNumber("Auto/Angle", 1)))
+        self.subsystem.resetYaw(self.sd.getNumber("Auto/Angle", 1))
 
     def execute(self):
         pass