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

feat:ftc2024-holonom.java

Browse source
This commit is contained in:
GZod01 2024-01-07 17:45:08 +01:00
parent 0e41831598
commit 604656e12f
1 changed files with 4 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

4
ftc2024-holonom.java
View file

@ -38,6 +38,7 @@ public class Werobot_FTC2024 extends LinearOpMode {
float x;
double y;
String mode;
boolean already_a = false;
int[] fr_angle = {1,1};
int[] fl_angle = {1,-1};
int[] bl_angle = {-1,-1};
@ -101,6 +102,9 @@ public class Werobot_FTC2024 extends LinearOpMode {
mode="normal";
}
}
if(!gamepad1.a && already_a){
already_a = false;
}
for(int i = 0; i<motors_angles.length; i++){
int[] cur_motor = motors_angles[i];
double cur_motor_norm = Math.pow(((Math.pow(cur_motor[0],2))+(Math.pow(cur_motor[1],2))),(1.0/2.0));