KeshavAnandCode/FTCDecodeMain
1
0
Fork 0
Code Issues Pull Requests 1 Actions Packages Projects Releases Wiki Activity

Gate Auto Opne once WIP

Browse Source
This commit is contained in:
Keshav Anand
2026-01-30 22:56:21 -06:00
parent 4f58438b9e
commit dff98b0dd5
3 changed files with 1120 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

1106
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/autonomous/Auto_LT_Close_GateOpen.java Normal file
View File

File diff suppressed because it is too large Load Diff

7
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/constants/Poses.java
View File

@@ -16,11 +16,14 @@ public class Poses {
public static double rx1 = 20, ry1 = 0.5, rh1 = Math.toRadians(0.1);
public static double rx2a = 41, ry2a = 18, rh2a = Math.toRadians(140);
public static double rx2b = 23, ry2b = 36, rh2b = Math.toRadians(140.1);
public static double rx2b = 19, ry2b = 40, rh2b = Math.toRadians(140.1);
public static double rx2c = 34, ry2c = 50, rh2c = Math.toRadians(140);
public static double rx3a = 55, ry3a = 39, rh3a = Math.toRadians(140);
public static double rx3aG = 60, ry3aG = 34, rh3aG = Math.toRadians(140);
public static double rx3b = 38, ry3b = 56, rh3b = Math.toRadians(140.1);
public static double rx4a = 75, ry4a = 53, rh4a = Math.toRadians(140);
@@ -32,6 +35,8 @@ public class Poses {
public static double bx2c = 34, by2c = -50, bh2c = Math.toRadians(-140);
public static double bx3a = 55, by3a = -43, bh3a = Math.toRadians(-140);
public static double bx3aG = 55, by3aG = -43, bh3aG = Math.toRadians(-140);
public static double bx3b = 37, by3b = -61, bh3b = Math.toRadians(-140);
public static double bx4a = 72, by4a = -55, bh4a = Math.toRadians(-140);

8
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/constants/Poses_V2.java
View File

@@ -20,6 +20,10 @@ public class Poses_V2 {
public static double rx2c = 34, ry2c = 50, rh2c = Math.toRadians(140), rt2c = Math.toRadians(Math.PI/2);
public static double rXGateA = 27, rYGateA = 56, rHGateA = Math.toRadians(160);
public static double rXGateB = 40, rYGateB = 43, rHGateB = Math.toRadians(159);
public static double rXGate = 30, rYGate = 63, rHGate = Math.toRadians(179);
public static double rx3a = 55, ry3a = 39, rh3a = Math.toRadians(140);
@@ -36,6 +40,10 @@ public class Poses_V2 {
public static double rShootX = 40, rShootY = 7, rShootH = Math.toRadians(140);
public static double bShootX = 20, bShootY = 30, bShootH = Math.toRadians(140);
public static double bXGateA = 33, bYGateA = 61, bHGateA = Math.toRadians(165);
public static double bXGateB = 33, bYGateB = 61, bHGateB = Math.toRadians(165);
public static double bXGate = 25, bYGate = 69, bHGate = Math.toRadians(165);