Add autos

This commit is contained in:
Shikhar
2026-02-27 19:37:21 -07:00
parent 73b7160205
commit 836a98815a
17 changed files with 521 additions and 80 deletions
@@ -343,7 +343,12 @@ public class SwerveDrive extends SubsystemBase implements Queryable {
Rotation2d heading = new Rotation2d(rightStick.getX(), rightStick.getY());//.r otateBy(Rotation2d.fromDegrees(90));
heading = heading.rotateBy(Rotation2d.fromDegrees(-90));
if(TimesNegativeOne.isRed) {
heading = heading.rotateBy(Rotation2d.fromDegrees(-90));
} else {
heading = heading.rotateBy(Rotation2d.fromDegrees(90));
}
rotTarget = heading.getDegrees();
driveFieldAngle(leftStick, heading);