36 lines
1,021 B
Java
36 lines
1,021 B
Java
package org.firstinspires.ftc.teamcode.createdcode.oldthings;
|
|
|
|
import com.acmerobotics.roadrunner.geometry.Pose2d;
|
|
import com.acmerobotics.roadrunner.trajectory.Trajectory;
|
|
import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
|
|
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
|
|
import com.qualcomm.robotcore.eventloop.opmode.Disabled;
|
|
|
|
import org.firstinspires.ftc.teamcode.drive.*;
|
|
|
|
|
|
@Disabled
|
|
@Autonomous
|
|
public class RoadRunnerAutoTester extends LinearOpMode {
|
|
@Override
|
|
public void runOpMode() throws InterruptedException {
|
|
SampleMecanumDrive drive = new SampleMecanumDrive(hardwareMap);
|
|
|
|
Trajectory traj1 = drive.trajectoryBuilder(new Pose2d())
|
|
.strafeRight(10)
|
|
.build();
|
|
|
|
Trajectory traj2 = drive.trajectoryBuilder(traj1.end())
|
|
.forward(10)
|
|
.build();
|
|
|
|
|
|
waitForStart();
|
|
|
|
if (isStopRequested()) return;
|
|
|
|
drive.followTrajectory(traj1);
|
|
drive.followTrajectory(traj2);
|
|
}
|
|
}
|