2023-01-23 23:52:26 -06:00
|
|
|
package org.firstinspires.ftc.teamcode.auto;
|
2022-11-17 17:23:01 -06:00
|
|
|
|
|
|
|
import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
|
|
|
|
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
|
|
|
|
|
2023-01-23 23:52:26 -06:00
|
|
|
import org.firstinspires.ftc.teamcode.Hardware;
|
|
|
|
import org.firstinspires.ftc.teamcode.MovementAPI;
|
|
|
|
import org.firstinspires.ftc.teamcode.Strings;
|
|
|
|
|
|
|
|
@Autonomous(name = "idk something right side", group = Strings.rightSideGroup, preselectTeleOp = Strings.mainOpModeName)
|
2022-11-17 17:23:01 -06:00
|
|
|
public class AutonRight extends LinearOpMode {
|
|
|
|
Hardware hardware;
|
|
|
|
MovementAPI movement;
|
|
|
|
|
|
|
|
@Override
|
|
|
|
public void runOpMode() {
|
|
|
|
hardware = new Hardware(this);
|
|
|
|
movement = new MovementAPI(hardware);
|
|
|
|
|
|
|
|
hardware.wrist.setPosition(0.5);
|
|
|
|
sleep(500);
|
2023-01-23 23:52:26 -06:00
|
|
|
hardware.setClawPosition(1);
|
2022-11-17 17:23:01 -06:00
|
|
|
|
|
|
|
waitForStart();
|
|
|
|
|
|
|
|
movement.move(0, 1, 0, 0.4);
|
|
|
|
sleep(1000);
|
|
|
|
movement.stop();
|
|
|
|
sleep(1000);
|
2023-01-23 23:52:26 -06:00
|
|
|
hardware.setClawPosition(0);
|
2022-11-17 17:23:01 -06:00
|
|
|
sleep(1000);
|
|
|
|
movement.move(0, -1, 0, 0.4);
|
|
|
|
sleep(1000);
|
|
|
|
movement.stop();
|
|
|
|
sleep(1000);
|
2023-01-23 23:52:26 -06:00
|
|
|
movement.move(-1, 0, 0, 0.4);
|
2022-11-17 17:23:01 -06:00
|
|
|
sleep(2500);
|
|
|
|
movement.stop();
|
|
|
|
}
|
|
|
|
}
|