Merge branch 'swerve-drive' of https://github.com/Team4388/2023WayOfTheRobot into swerve-drive

This commit is contained in:
Abhi
2023-02-02 19:11:46 -07:00
7 changed files with 197 additions and 11 deletions
@@ -57,7 +57,7 @@ public class DriveWithInput extends CommandBase {
x = -xLimiter.calculate(MathUtil.applyDeadband(x * -0.3, 0.02) * Units.feetToMeters(SwerveDriveConstants.MAX_SPEED_FEET_PER_SECOND));
y = -yLimiter.calculate(MathUtil.applyDeadband(y * 0.3, 0.02) * Units.feetToMeters(SwerveDriveConstants.MAX_SPEED_FEET_PER_SECOND));
r = -rotLimiter.calculate(MathUtil.applyDeadband(r * 0.3, 0.02) * Units.feetToMeters(Math.PI));
r = -rotLimiter.calculate(MathUtil.applyDeadband(r * 0.3, 0.02) * Units.feetToMeters(5*Math.PI));
swerve.drive(x, y, r, fieldRelative);
}