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

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

Browse source
This commit is contained in:
Zelina974 2024-02-11 16:42:38 +01:00
commit 1f9fb4e807
1 changed files with 16 additions and 1 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

15
ftc2024-autonome.java
View file

@ -98,6 +98,21 @@ public class ftc2024_autonome extends LinearOpMode {
} }
} }
else{ else{
while(opModeIsActive()){
Yaw = robotOrientation.getYaw(AngleUnit.DEGREES);
if(Math.abs(Yaw-90.0)<=0.01){
break;
}
else if((Yaw - 90.0) <0){
lm.setPower((Math.abs(Yaw-90.0)/90)*0.5);
rm.setPower(-(Math.abs(Yaw-90.0)/90)*0.5);
}
else{
rm.setPower((Math.abs(Yaw-90.0)/90)*0.5);
lm.setPower(-(Math.abs(Yaw-90.0)/90)*0.5);
}
if(false){
double[][] operations = { double[][] operations = {
{-1.0,1.0}, // vectors {-1.0,1.0}, // vectors
{1.0,1.0}, {1.0,1.0},