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:01:15 +01:00
parent 6eafb98253
commit df33d5290c
1 changed files with 2 additions and 7 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

9
test.java
View file

@ -46,18 +46,13 @@ public class ftc2024_autonome_test extends LinearOpMode {
YawPitchRollAngles robotOrientation; YawPitchRollAngles robotOrientation;
double Yaw = robotOrientation.getYaw(AngleUnit.DEGREES); double Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double yaw_sortie; double yaw_sortie;
double a;
double a1;
double b;
double b1;
double k;
double k1;
waitForStart(); waitForStart();
while (opModeIsActive()){ while (opModeIsActive()){
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];
for(int i = 0; i< lm_p.length; i++){ for(int i = 0; i< lm_p.length; i++){
while (opModeIsActive() && Yaw < 90){ while (opModeIsActive() && Yaw < 90){
lm.setPower = lm_p[i]; lm.setPower = lm_p[i];
@ -70,7 +65,7 @@ public class ftc2024_autonome_test extends LinearOpMode {
telemetry.addData("Yaw sortie", yaw_sortie); telemetry.addData("Yaw sortie", yaw_sortie);
telemetry.update(); telemetry.update();
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES); Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
double [] x = Yaw - yaw_sortie; x [i]= Yaw - yaw_sortie;