Compare commits
2 Commits
master
...
brad_contr
Author | SHA1 | Date | |
---|---|---|---|
b58e4dc975 | |||
d8bb8cfd05 |
@ -132,26 +132,6 @@ public class RobotContainer {
|
||||
)
|
||||
);
|
||||
|
||||
//intake.setDefaultCommand(intake.intakeUpCommand());
|
||||
intake.setDefaultCommand(intake.manualPivot(operator::getLeftY, driver::getLeftTriggerAxis));
|
||||
|
||||
// shooter.setDefaultCommand(shooter.angleSpeedsSetpoints(ShooterConstants.kShooterLoadAngle, 0.0, 0.0));
|
||||
shooter.setDefaultCommand(shooter.manualPivot(operator::getRightY, operator::getLeftTriggerAxis));
|
||||
|
||||
climber.setDefaultCommand(climber.stop());
|
||||
|
||||
indexer.setDefaultCommand(indexer.shootNote(operator::getRightTriggerAxis));
|
||||
|
||||
driver.povCenter().onFalse(
|
||||
drivetrain.driveCardinal(
|
||||
driver::getLeftY,
|
||||
driver::getLeftX,
|
||||
driver.getHID()::getPOV,
|
||||
OIConstants.kTeleopDriveDeadband).until(
|
||||
() -> MathUtil.applyDeadband(driver.getRightX(), OIConstants.kTeleopDriveDeadband) != 0
|
||||
)
|
||||
);
|
||||
|
||||
// Lock on to the appropriate Amp AprilTag while still being able to strafe and drive forward and back
|
||||
driver.a().onTrue(
|
||||
drivetrain.driveAprilTagLock(
|
||||
@ -188,6 +168,17 @@ public class RobotContainer {
|
||||
)
|
||||
);
|
||||
|
||||
driver.povCenter().onFalse(
|
||||
drivetrain.driveCardinal(
|
||||
driver::getLeftY,
|
||||
driver::getLeftX,
|
||||
driver.getHID()::getPOV,
|
||||
OIConstants.kTeleopDriveDeadband
|
||||
).until(
|
||||
() -> MathUtil.applyDeadband(driver.getRightX(), OIConstants.kTeleopDriveDeadband) != 0
|
||||
)
|
||||
);
|
||||
|
||||
// This was originally a run while held, not sure that's really necessary, change it if need be
|
||||
driver.y().onTrue(drivetrain.zeroHeadingCommand());
|
||||
|
||||
@ -205,9 +196,48 @@ public class RobotContainer {
|
||||
*/
|
||||
driver.start().onTrue(drivetrain.toggleFieldRelativeControl());
|
||||
|
||||
driver.leftBumper().toggleOnTrue(intake.intakeDownCommand());
|
||||
//intake.setDefaultCommand(intake.intakeUpCommand());
|
||||
//Intake rollers intentionally disabled at the moment
|
||||
intake.setDefaultCommand(
|
||||
intake.manualPivot(
|
||||
() -> { return operator.getRightY() / 2; },
|
||||
() -> { return 0; }
|
||||
)
|
||||
);
|
||||
|
||||
operator.y().onTrue(climber.setSpeedWithSupplier(operator::getRightTriggerAxis));
|
||||
// shooter.setDefaultCommand(shooter.angleSpeedsSetpoints(ShooterConstants.kShooterLoadAngle, 0.0, 0.0));
|
||||
shooter.setDefaultCommand(
|
||||
shooter.manualPivot(
|
||||
() -> { return operator.getLeftY() / 2; },
|
||||
() -> {
|
||||
if (MathUtil.applyDeadband(driver.getLeftTriggerAxis(), OIConstants.kTeleopDriveDeadband) != 0) {
|
||||
return driver.getLeftTriggerAxis();
|
||||
} else {
|
||||
return -operator.getLeftTriggerAxis();
|
||||
}
|
||||
}
|
||||
)
|
||||
);
|
||||
|
||||
indexer.setDefaultCommand(
|
||||
indexer.shootNote(
|
||||
() -> {
|
||||
if (MathUtil.applyDeadband(driver.getLeftTriggerAxis(), OIConstants.kTeleopDriveDeadband) != 0) {
|
||||
return driver.getLeftTriggerAxis();
|
||||
} else {
|
||||
return -operator.getLeftTriggerAxis();
|
||||
}
|
||||
}
|
||||
)
|
||||
);
|
||||
|
||||
climber.setDefaultCommand(climber.stop());
|
||||
|
||||
operator.rightBumper().whileTrue(
|
||||
climber.setSpeedWithSupplier(
|
||||
operator::getRightTriggerAxis
|
||||
)
|
||||
);
|
||||
|
||||
}
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user