diff --git a/src/main/java/frc/robot/subsystems/DriveSubsystem.java b/src/main/java/frc/robot/subsystems/DriveSubsystem.java index cd73cb1..9d0a8d0 100644 --- a/src/main/java/frc/robot/subsystems/DriveSubsystem.java +++ b/src/main/java/frc/robot/subsystems/DriveSubsystem.java @@ -487,11 +487,11 @@ public void driveWithExtras( boolean fieldRelative, boolean rateLimit) { final double sens = OIConstants.kDriveSensitivity; // The rest will be added by "boost" - final var boostBy = (sens + (boost * (1 - sens))); + final var boostMultiplier = sens * (1 - boost) + boost; drive( - MathUtil.applyDeadband(xSpeed * boostBy, deadband), - MathUtil.applyDeadband(ySpeed * boostBy, deadband), - MathUtil.applyDeadband(rot * boostBy, deadband), + MathUtil.applyDeadband(xSpeed * boostMultiplier, deadband), + MathUtil.applyDeadband(ySpeed * boostMultiplier, deadband), + MathUtil.applyDeadband(rot * boostMultiplier, deadband), fieldRelative, rateLimit); SmartDashboard.putNumber("xSpeed: ", xSpeed);