added speedometer velocity readings on smartdashboard

Team334 · Apr 1, 2024 · 5e1f7b0 · 5e1f7b0
1 parent 95c71a9
commit 5e1f7b0
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/src/main/java/frc/robot/subsystems/SwerveDriveSubsystem.java b/src/main/java/frc/robot/subsystems/SwerveDriveSubsystem.java
@@ -169,6 +169,9 @@ public void initSendable(SendableBuilder builder) {
     });
 
     SmartDashboard.putNumber("SWERVE TRIM", _swerveTrim);
+    SmartDashboard.putNumber("SPEEDOMETER X", _gyro.getVelocityX()); // Velocity read by the gyro (I added all three bc the axis might be different for the gyro)
+    SmartDashboard.putNumber("SPEEDOMETER Y", _gyro.getVelocityY());
+    SmartDashboard.putNumber("SPEEDOMETER Z", _gyro.getVelocityZ());
   }
 
   @Override