power-play/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/auto/AutonRight.java

41 lines
1.1 KiB
Java
Raw Normal View History

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;
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);
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);
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);
movement.move(-1, 0, 0, 0.4);
2022-11-17 17:23:01 -06:00
sleep(2500);
movement.stop();
}
}