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
@@ -22,7 +22,7 @@ public class ShooterConstants {
public static final ConfigurableDouble SHOOTER_FEED_VELOCITY = new ConfigurableDouble("Shooter Feed Velocity", -35);
// public static final ConfigurableDouble SHOOTER_RESTING_VELOCITY = new ConfigurableDouble("Shooter Resting Velocity", 0.0);
public static final ConfigurableDouble SHOOTER_IDLE_PERCENT_OUTPUT = new ConfigurableDouble("Shooter idle % output", 0.3);
public static final ConfigurableDouble SHOOTER_IDLE_PERCENT_OUTPUT = new ConfigurableDouble("Shooter idle % output", -0.3);
// public static final ConfigurableDouble SHOOTER_IDLE_TARGET_VEL = new ConfigurableDouble("Shooter idle target velocity", 20.);
// public static final ConfigurableDouble SHOOTER_IDLE_MAX_CURRENT = new ConfigurableDouble("Shooter Idle max current", 10);
@@ -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);