werobot/ftc2024-robotcode
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Merge branch 'master' of github.com:GZod01/ftc2024-robotcode

Browse source
This commit is contained in:
GZod01 2024-02-11 17:12:39 +01:00
commit f43822b675
1 changed files with 8 additions and 3 deletions
Download patch file Download diff file Expand all files Collapse all files

11
ftc2024-autonome.java
View file

@ -92,6 +92,8 @@ public class ftc2024_autonome extends LinearOpMode {
double Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double Pitch = robotOrientation.getPitch(AngleUnit.DEGREES);
double Roll = robotOrientation.getRoll(AngleUnit.DEGREES);
double yaw_sortie;
// Wait for the game to start (driver presses PLAY)
waitForStart();
@ -102,14 +104,17 @@ public class ftc2024_autonome extends LinearOpMode {
while (opModeIsActive() && Yaw <= 90.0) {
lm.setPower(0.5);
rm.setPower(-0.5);
robotOrientation = imu.getRobotYawPitchRollAngles();
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
telemetry.addData("Leg 1", runtime.seconds());
telemetry.addData("Yaw : ", Yaw);
telemetry.update();
yaw_sortie = Yaw;
}
telemetry.addData("yaw_sortie", yaw_sortie)
runtime.reset();
while (opModeIsActive() && (runtime.seconds() <= 121.92e-2/speed)) {
lm.setPower(1);
rm.setPower(1);
lm.setPower(0.1);
rm.setPower(0.1);
telemetry.addData("Leg 2", runtime.seconds());
telemetry.update();
}