Fix offset model

This commit is contained in:
mimigamin
2026-03-15 11:17:55 -06:00
parent f4a42f02ee
commit d5f316b0c1
3 changed files with 31 additions and 28 deletions
+14 -13
View File
@@ -254,20 +254,21 @@ public class RobotContainer {
// IF the driver is holding the aim button, aim the robot towards the hub and shooter ready
new Trigger(() -> getDeadbandedDriverController().getRightTriggerAxis() >= 0.5)
.whileTrue(new RunCommand(() -> m_robotSwerveDrive.driveFacingPosition(
getDeadbandedDriverController().getLeft(),
FieldPositions.HUB_POSITION,
ShooterConstants.AIM_LEAD_TIME.get()
), m_robotSwerveDrive)
// () -> {
// m_robotSwerveDrive.driveFacingVelocity(
// getDeadbandedDriverController().getLeft(),
.whileTrue(new RunCommand(
// () -> m_robotSwerveDrive.driveFacingPosition(
// getDeadbandedDriverController().getLeft(),
// FieldPositions.HUB_POSITION,
// ShooterConstants.AIM_LEAD_TIME.get(),
// m_robotShooter.getBallVelocity(),
// m_robotShooter.getDistanceToHub()
// );
// }, m_robotSwerveDrive)
// ShooterConstants.AIM_LEAD_TIME.get()
// ), m_robotSwerveDrive)
() -> {
m_robotSwerveDrive.driveFacingVelocity(
getDeadbandedDriverController().getLeft(),
FieldPositions.HUB_POSITION,
ShooterConstants.AIM_LEAD_TIME.get(),
m_robotShooter.getBallVelocity(),
m_robotShooter.getDistanceToHub()
);
}, m_robotSwerveDrive)
);
// D-PAD fine alignment