From 9c003020fdec4c26700eb010477f340355120a5b Mon Sep 17 00:00:00 2001 From: Abhi <90010729+Abhishrek05@users.noreply.github.com> Date: Sat, 25 Feb 2023 09:52:33 -0700 Subject: [PATCH] yes --- src/main/java/frc4388/robot/commands/AutoBalance.java | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/src/main/java/frc4388/robot/commands/AutoBalance.java b/src/main/java/frc4388/robot/commands/AutoBalance.java index ffccee4..714221d 100644 --- a/src/main/java/frc4388/robot/commands/AutoBalance.java +++ b/src/main/java/frc4388/robot/commands/AutoBalance.java @@ -26,7 +26,7 @@ public class AutoBalance extends PelvicInflammatoryDisease { @Override public double getError() { - var pitch = gyro.getPitch(); + var pitch = gyro.getRoll(); SmartDashboard.putNumber("pitch", pitch); return pitch; } @@ -34,8 +34,8 @@ public class AutoBalance extends PelvicInflammatoryDisease { @Override public void runWithOutput(double output) { double out2 = MathUtil.clamp(output / 40, -.5, .5); - if (Math.abs(gyro.getPitch()) < 3) out2 = 0; - drive.driveWithInput(new Translation2d(0, out2), new Translation2d(), false); + if (Math.abs(getError()) < 3) out2 = 0; + drive.driveWithInput(new Translation2d(0, out2), new Translation2d(), true); } @Override