diff --git a/TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java b/TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java index 43901c2..3a02556 100644 --- a/TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java +++ b/TeamCode/src/main/java/org/timecrafters/testing/states/PrototypeTeleOPState.java @@ -90,8 +90,6 @@ public class PrototypeTeleOPState extends CyberarmState { robot.frontRightDrive.setPower(-frontRightPower); robot.backRightDrive.setPower(backRightPower); - - robot.armMotor.setPower(engine.gamepad2.left_stick_y * 0.5); @@ -181,5 +179,19 @@ public class PrototypeTeleOPState extends CyberarmState { // .5's are originally .13's. } + if (engine.gamepad2.right_stick_y > 0.1) { + + robot.RackRiserRight.setPosition(+ 1); + robot.RackRiserLeft.setPosition(+ 1); + + } + + if (engine.gamepad2.right_stick_y < -0.1) { + + robot.RackRiserLeft.setPosition(- 1); + robot.RackRiserRight.setPosition(- 1); + + } + } } \ No newline at end of file