FtcRobotController/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/AutonTwo.java

34 lines
988 B
Java

package org.firstinspires.ftc.teamcode;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
@Autonomous(name="Auton 2.0 maybe working?????", preselectTeleOp = "AAAAAAAAA")
public class AutonTwo extends LinearOpMode {
@Override
public void runOpMode() {
API.init(this);
API.print("Status", "Initializing, please wait");
MovementAPI.init();
GameMotor.LIFT.m.setDirection(API.Direction.REVERSE, false);
API.clear();
API.print("Press play to start");
waitForStart();
MovementAPI.move(-180, 0.4, true);
API.pause(0.8);
MovementAPI.stop();
GameMotor.LIFT.m.start(0.25);
API.pause(5);
GameMotor.LIFT.m.stop();
GameMotor.LIFT.m.start(-0.25);
API.pause(2.5);
GameMotor.LIFT.m.stop();
MovementAPI.move(-180, -0.4, true);
API.pause(0.8);
MovementAPI.stop();
}
}