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

update

Browse source
This commit is contained in:
Zelina974 2024-02-26 16:35:33 +01:00
parent 3f523e5e12
commit 5221daff7e
1 changed files with 17 additions and 67 deletions
Download patch file Download diff file Expand all files Collapse all files

84
ftc2024-autonome.java
View file

@ -53,13 +53,13 @@ public class ftc2024_autonome_test extends LinearOpMode {
double [] lm_p = {0.1,0.2,0.3,0.4,0.5,0.6,0.7,0.8,0.9,1}; double [] lm_p = {0.1,0.2,0.3,0.4,0.5,0.6,0.7,0.8,0.9,1};
double [] rm_p = {-0.1,-0.2,-0.3,-0.4,-0.5,-0.6,-0.7,-0.8,-0.9,-1}; double [] rm_p = {-0.1,-0.2,-0.3,-0.4,-0.5,-0.6,-0.7,-0.8,-0.9,-1};
double [] x = new double[lm_p.length]; double [] x = new double[lm_p.length];
for(int i = 0; i< lm_p.length; i++){ for(int i = 0; i< 9; i++){
while (opModeIsActive() && Yaw < 90){ while (opModeIsActive() && Yaw < 90){
lm.setPower(lm_p[i]); lm.setPower(lm_p[i]);
rm.setPower(rm_p[i]); rm.setPower(rm_p[i]);
robotOrientation = imu.getRobotYawPitchRollAngles(); robotOrientation = imu.getRobotYawPitchRollAngles();
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES); Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
telemetry.addData("Yaw : ", Yaw); telemetry.addData("Yaw ", Yaw);
telemetry.update(); telemetry.update();
yaw_sortie = Yaw; yaw_sortie = Yaw;
} }
@ -67,74 +67,24 @@ public class ftc2024_autonome_test extends LinearOpMode {
telemetry.update(); telemetry.update();
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES); Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
x [i]= Yaw - yaw_sortie; x [i]= Yaw - yaw_sortie;
/*if (i = 0) {
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
a = yaw_sortie;
a1 = Yaw;
}
if (i = 1){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
b = yaw_sortie;
b1 = Yaw;
}
if (i = 2){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double c = yaw_sortie;
double c1 = Yaw;
}
if (i = 3){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double d = yaw_sortie;
double d1 = Yaw;
}
if (i = 4){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double e = yaw_sortie;
double e1 = Yaw;
}
if (i = 5){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double f = yaw_sortie;
double f1 = Yaw;
}
if (i = 6){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double g = yaw_sortie;
double g1 = Yaw;
}
if (i = 7){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double h = yaw_sortie;
double h1 = Yaw;
}
if (i = 8){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double j = yaw_sortie;
double j1 = Yaw;
}
if (i = 9){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
k = yaw_sortie;
k1 = Yaw;
}
*/
imu.resetYaw(); imu.resetYaw();
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
telemetry.addData("Yaw", Yaw);
telemetry.update();
}
while (opModeIsActive()){
telemetry.addData("0.1", x[0]);
telemetry.addData("0.2", x[1]);
telemetry.addData("0.3", x[2]);
telemetry.addData("0.4", x[3]);
telemetry.addData("0.5", x[4]);
telemetry.addData("0.6", x[5]);
telemetry.addData("0.7", x[6]);
telemetry.addData("0.8", x[7]);
telemetry.addData("0.9", x[8]);
telemetry.addData("1", x[9]);
} }
telemetry.addData("0.1", x[0]);
telemetry.addData("0.2", x[1]);
telemetry.addData("0.3", x[2]);
telemetry.addData("0.4", x[3]);
telemetry.addData("0.5", x[4]);
telemetry.addData("0.6", x[5]);
telemetry.addData("0.7", x[6]);
telemetry.addData("0.8", x[7]);
telemetry.addData("0.9", x[8]);
telemetry.addData("1", x[9]);
} }
} }
} }