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

17
ftc2024-autonome.java
View file

@ -97,7 +97,22 @@ public class ftc2024_autonome extends LinearOpMode {
telemetry.update();
}
}
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 = {
{-1.0,1.0}, // vectors
{1.0,1.0},