diff --git a/src/main/java/hardware/Swerve.java b/src/main/java/hardware/Swerve.java index d980f52b..64b6d6a1 100644 --- a/src/main/java/hardware/Swerve.java +++ b/src/main/java/hardware/Swerve.java @@ -283,7 +283,7 @@ public ChassisSpeeds discretize(ChassisSpeeds speeds) { Poofdy = twist.dy; Poofdtheta = twist.dtheta; - return new ChassisSpeeds((twist.dx / dt), (twist.dy / dt), (twist.dtheta / dt)); + return new ChassisSpeeds((twist.dx / dt), (twist.dy / dt), (speeds.omegaRadiansPerSecond)); }