auto shtuff

This commit is contained in:
Aarav
2023-02-25 12:30:20 -07:00
parent cdb91f6831
commit 22b930d621
5 changed files with 1553 additions and 9 deletions
@@ -35,7 +35,7 @@ public class AutoBalance extends PelvicInflammatoryDisease {
public void runWithOutput(double output) {
double out2 = MathUtil.clamp(output / 40, -.5, .5);
if (Math.abs(getError()) < 3) out2 = 0;
drive.driveWithInput(new Translation2d(0, out2), new Translation2d(), true);
drive.driveWithInput(new Translation2d(0, out2), new Translation2d(), false);
}
@Override