mirror of
https://github.com/Team4388/2026KPopRobotHunters.git
synced 2026-06-09 00:38:03 -06:00
aim to hub pid fixes
drift correction for aim to hub
This commit is contained in:
@@ -282,6 +282,7 @@ public class SwerveDrive extends SubsystemBase implements Queryable {
|
|||||||
leftStick = leftStick.rotateBy(TimesNegativeOne.ForwardOffset);
|
leftStick = leftStick.rotateBy(TimesNegativeOne.ForwardOffset);
|
||||||
leftStick = TimesNegativeOne.invert(leftStick, TimesNegativeOne.XAxis, TimesNegativeOne.YAxis);
|
leftStick = TimesNegativeOne.invert(leftStick, TimesNegativeOne.XAxis, TimesNegativeOne.YAxis);
|
||||||
|
|
||||||
|
rotTarget = heading.getDegrees();
|
||||||
|
|
||||||
var ctrl = new SwerveRequest.FieldCentricFacingAngle()
|
var ctrl = new SwerveRequest.FieldCentricFacingAngle()
|
||||||
.withVelocityX(leftStick.getX() * speedAdjust)
|
.withVelocityX(leftStick.getX() * speedAdjust)
|
||||||
|
|||||||
@@ -162,7 +162,7 @@ public final class SwerveDriveConstants {
|
|||||||
|
|
||||||
|
|
||||||
// TODO: Replace this with a static constant
|
// TODO: Replace this with a static constant
|
||||||
public static final ConfigurableDouble AIM_kP = new ConfigurableDouble("Aim kP", 15);
|
public static final ConfigurableDouble AIM_kP = new ConfigurableDouble("Aim kP", 12);
|
||||||
public static final ConfigurableDouble AIM_kI = new ConfigurableDouble("Aim kI", 0);
|
public static final ConfigurableDouble AIM_kI = new ConfigurableDouble("Aim kI", 0);
|
||||||
public static final ConfigurableDouble AIM_kD = new ConfigurableDouble("Aim kD", 0.1);
|
public static final ConfigurableDouble AIM_kD = new ConfigurableDouble("Aim kD", 0.1);
|
||||||
// public static final Gains AIM_GAINS = new Gains(2.5, 0, 0.1);
|
// public static final Gains AIM_GAINS = new Gains(2.5, 0, 0.1);
|
||||||
|
|||||||
Reference in New Issue
Block a user