public abstract class TeleOp_Base extends LinearOpMode {
public ElapsedTime timer = new ElapsedTime();
public Servo servo;
public void init_hardware() {
servo = hardwareMap.get(Servo.class, "servo");
}
}
public class TeleOpMode extends TeleOp_Base {
boolean right_trigger = false;
@Override
public void runOpMode() throws InterruptedException {
init_hardware();
waitForStart();
while(opModeIsActive()) {
if(gamepad1.right_trigger > 0.1) {
servo.setPosition(0.5);
right_trigger = true;
timer.reset();
}
if(timer.milliseconds() >= 1000 && timer.milliseconds() < 1200 && right_trigger) {
servo.setPosition(1);
}
else if(timer.milliseconds() >= 2000 && timer.milliseconds() < 2200 && right_trigger) {
servo.setPosition(0);
right_trigger = false;
}
}
}
}