@Matt please take a look at this code
This commit is contained in:
@@ -587,18 +587,14 @@ public class TeleopV3 extends LinearOpMode {
|
|||||||
// }
|
// }
|
||||||
|
|
||||||
if (enableSpindexerManager) {
|
if (enableSpindexerManager) {
|
||||||
|
spindexer.processIntake();
|
||||||
|
|
||||||
// RIGHT_BUMPER
|
// RIGHT_BUMPER
|
||||||
if (gamepad1.right_bumper && intakeTicker > resetSpinTicks) {
|
if (gamepad1.right_bumper && intakeTicker > resetSpinTicks) {
|
||||||
robot.intake.setPower(1);
|
robot.intake.setPower(1);
|
||||||
spindexer.processIntake();
|
|
||||||
} else {
|
} else {
|
||||||
robot.intake.setPower(0);
|
robot.intake.setPower(0);
|
||||||
if (spindexer.isFull() && intakeTicker > resetSpinTicks*5){
|
|
||||||
robot.spin1.setPosition(spinStartPos);
|
|
||||||
robot.spin2.setPosition(1-spinStartPos);
|
|
||||||
} else {
|
|
||||||
spindexer.processIntake();
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// LEFT_BUMPER
|
// LEFT_BUMPER
|
||||||
@@ -618,7 +614,7 @@ public class TeleopV3 extends LinearOpMode {
|
|||||||
intake = false;
|
intake = false;
|
||||||
reject = false;
|
reject = false;
|
||||||
|
|
||||||
if (servo.getSpinPos() < spindexer_outtakeBall2 + 0.4 || shooterTicker == 0) {
|
if (servo.getSpinPos() < spindexer_outtakeBall2 + 0.4) {
|
||||||
|
|
||||||
if (shooterTicker == 0){
|
if (shooterTicker == 0){
|
||||||
robot.transferServo.setPosition(transferServo_out);
|
robot.transferServo.setPosition(transferServo_out);
|
||||||
|
|||||||
Reference in New Issue
Block a user