diff --git a/src/main/java/frc/robot/subsystems/SwerveDriveSubsystem.java b/src/main/java/frc/robot/subsystems/SwerveDriveSubsystem.java index 0aabdab..aab5b90 100644 --- 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