mirror of
https://github.com/Team4388/2019-Hit-or-Miss.git
synced 2026-06-09 00:28:05 -06:00
Add a climber retract to mapped to the left driver trigger
This commit is contained in:
@@ -62,9 +62,11 @@ public class OI
|
|||||||
|
|
||||||
|
|
||||||
JoystickButton climbUp = new JoystickButton(m_driverXbox.getJoyStick(), XboxController.RIGHT_TRIGGER_AXIS);
|
JoystickButton climbUp = new JoystickButton(m_driverXbox.getJoyStick(), XboxController.RIGHT_TRIGGER_AXIS);
|
||||||
double speed = m_driverXbox.getRightTriggerAxis();
|
JoystickButton climbDown = new JoystickButton(m_driverXbox.getJoyStick(), XboxController.LEFT_TRIGGER_AXIS);
|
||||||
climbUp.whenPressed(new InitiateClimber(speed));
|
|
||||||
climbUp.whenReleased(new InitiateClimber(0));
|
double speed = m_driverXbox.getRightTriggerAxis() - m_driverXbox.getLeftTriggerAxis();
|
||||||
|
climbUp.whileActive(new InitiateClimber(speed));
|
||||||
|
climbDown.whileActive(new InitiateClimber(speed));
|
||||||
|
|
||||||
JoystickButton ratchetFlip = new JoystickButton(m_driverXbox.getJoyStick(), XboxController.Y_BUTTON);
|
JoystickButton ratchetFlip = new JoystickButton(m_driverXbox.getJoyStick(), XboxController.Y_BUTTON);
|
||||||
ratchetFlip.whenPressed(new ratchetFlip(0.5));
|
ratchetFlip.whenPressed(new ratchetFlip(0.5));
|
||||||
|
|||||||
@@ -87,11 +87,15 @@ public class Climber extends Subsystem{
|
|||||||
|
|
||||||
public void setClimbSpeed(double speed) {
|
public void setClimbSpeed(double speed) {
|
||||||
if (safetySwitch) {
|
if (safetySwitch) {
|
||||||
if(isPressed.isFwdLimitSwitchClosed()){ //If leg at max height
|
if (isPressed.isRevLimitSwitchClosed() && speed < 0){ //If leg at min height, and the input would retract the leg
|
||||||
|
climberBack.set(0);
|
||||||
|
climberFront.set(0);
|
||||||
|
}
|
||||||
|
if(isPressed.isFwdLimitSwitchClosed() && speed > 0){ //If leg at max height, and the input would extend the leg
|
||||||
climberBack.set(0);
|
climberBack.set(0);
|
||||||
climberFront.set(FRONT_FREQ * speed);
|
climberFront.set(FRONT_FREQ * speed);
|
||||||
}
|
}
|
||||||
else if (!isPressed.isFwdLimitSwitchClosed()){ //If leg not at max height
|
else { //If leg not at max height
|
||||||
climberBack.set(BACK_FREQ * speed);
|
climberBack.set(BACK_FREQ * speed);
|
||||||
climberFront.set(FRONT_FREQ * speed);
|
climberFront.set(FRONT_FREQ * speed);
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user