made exponential drive work on diagonals

This commit is contained in:
NoahLacks63 2025-02-28 16:17:09 +00:00
parent c52a9ead0f
commit c6d1b96006

View File

@ -109,8 +109,8 @@ public class RobotContainer {
drivetrain.setDefaultCommand( drivetrain.setDefaultCommand(
drivetrain.drive( drivetrain.drive(
() -> Math.pow(driver.getLeftY(), 3), () -> driver.getLeftY() * Math.pow(Math.abs(driver.getLeftY()) + Math.abs(driver.getLeftX()), 3), //Math.pow(driver.getLeftY(), 3),
() -> Math.pow(driver.getLeftX(), 3), () -> driver.getLeftX() * Math.pow(Math.abs(driver.getLeftY()) + Math.abs(driver.getLeftX()), 3), // Math.pow(driver.getLeftX(), 3),
driver::getRightX, //Math.signum(driver.getRightX()) * Math.pow(driver.getRightX(), 3) driver::getRightX, //Math.signum(driver.getRightX()) * Math.pow(driver.getRightX(), 3)
() -> true () -> true
) )