77import edu .wpi .first .math .geometry .Rotation3d ;
88import edu .wpi .first .math .geometry .Transform3d ;
99import edu .wpi .first .wpilibj2 .command .SubsystemBase ;
10- import frc .lib .team2930 .LoggerEntry ;
11- import frc .lib .team2930 .LoggerGroup ;
1210import frc .lib .team2930 .TunableNumberGroup ;
1311import frc .lib .team6328 .LoggedTunableNumber ;
1412import frc .robot .Constants .VisionConstants ;
1715public class USBVision extends SubsystemBase {
1816 // Logging
1917
20- private static final LoggerGroup logGroup = LoggerGroup .build (VisionConstants .ROOT_TABLE );
18+ // private static final LoggerGroup logGroup = LoggerGroup.build(VisionConstants.ROOT_TABLE);
2119
22- private static final LoggerEntry .DecimalArray logToTarget =
23- logGroup .buildDecimalArray ("OffsetFromTarget" );
24- private static final LoggerEntry .Decimal logDistX = logGroup .buildDecimal ("DistX" );
25- private static final LoggerEntry .Decimal logDistY = logGroup .buildDecimal ("DistY" );
26- private static final LoggerEntry .Decimal logDistZ = logGroup .buildDecimal ("DistZ" );
27-
28- private static final LoggerEntry .Decimal logRotX = logGroup .buildDecimal ("RotX" );
29- private static final LoggerEntry .Decimal logRotY = logGroup .buildDecimal ("RotY" );
30- private static final LoggerEntry .Decimal logRotZ = logGroup .buildDecimal ("RotZ" );
3120 // private static final LoggerEntry.Bool logOnTarget = logGroup.buildBoolean("onTarget");
3221
3322 // Tunable numbers
@@ -40,9 +29,6 @@ public class USBVision extends SubsystemBase {
4029 private final USBVisionIO io ;
4130 private final USBVisionInputsAutoLogged inputs = new USBVisionInputsAutoLogged ();
4231
43- // private boolean onTarget = false;
44- // private Angle angleToTarget = Units.Radians.zero();
45-
4632 /** Creates a new Vision Subsystem. */
4733 public USBVision (USBVisionIO io ) {
4834 this .io = io ;
0 commit comments