PLS5618/Reefscape-2025
6
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

april tag

Browse Source
This commit is contained in:
Samuel
2025-11-12 18:57:51 -05:00
parent eef7ee3eed
commit 04718b8400
1 changed files with 16 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

20
src/main/java/frc/robot/commands/Limelight/AprilTag3.java
View File

@@ -63,10 +63,22 @@ public class AprilTag3 extends Command {
} }
else if(Botyaw >90 && Botyaw <=180){ else if(Botyaw >90 && Botyaw <=180){
drivetrain.setControl(drive. drivetrain.setControl(drive.
withRotationalRate(a/20). withRotationalRate(tx/20).
withVelocityX(0). withVelocityX(MathUtil.clamp(-x/4, -1, 1)).
withVelocityY( b/50)); withVelocityY(MathUtil.clamp(z/4, -1, 1)));
System.out.println(b/50); }
else if(Botyaw >-90 && Botyaw <=0){
drivetrain.setControl(drive.
withRotationalRate(tx/20).
withVelocityX(MathUtil.clamp(-x/4, -1, 1)).
withVelocityY(MathUtil.clamp(-z/4, -1, 1)));
}
else if(Botyaw >-180 && Botyaw <=-90){
drivetrain.setControl(drive.
withRotationalRate(tx/20).
withVelocityX(MathUtil.clamp(x/4, -1, 1)).
withVelocityY(MathUtil.clamp(-z/4, -1, 1)));
}
} }
else{ else{
drivetrain.setControl(drive. drivetrain.setControl(drive.