Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- package org.firstinspires.ftc.teamcode;
- import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
- import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
- import com.qualcomm.robotcore.hardware.Servo;
- import com.qualcomm.robotcore.util.ElapsedTime;
- /**
- * Created by FTC-computer on 12/22/10.
- */
- @Autonomous(name="Autonomous", group="tests")
- public class Autonomus extends LinearOpMode {
- private KEY keyDetcter = new KEY();
- private COLOR color = new COLOR();
- private DRIVE drive = new DRIVE();
- private ElapsedTime time = new ElapsedTime();
- private int work = 0;
- private Servo rightServo = null;
- private Servo leftServo = null;
- @Override
- public void runOpMode() {
- telemetry.addData("Status", "Initialized");
- telemetry.update();
- rightServo = hardwareMap.get(Servo.class, "right_servo");
- leftServo = hardwareMap.get(Servo.class, "left_servo");
- leftServo.setPosition(0.6);
- rightServo.setPosition(0.4);
- waitForStart();
- time.reset();
- while (opModeIsActive() && work == 0) {
- drive.driveForward(10, 1);
- work++;
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement