2 Commits

Author SHA1 Message Date
Antoine PerreaultE
da6bd598b0 Merge branch 'main' of https://git.demerso.net/PLS5618/Reefscape-2025 2025-11-10 18:06:11 -05:00
Antoine PerreaultE
38a0fc3413 avance 2025-11-10 18:06:08 -05:00
2 changed files with 4 additions and 1 deletions

View File

@@ -50,12 +50,15 @@ public class AprilTag3 extends Command {
double a = limelight3.getTx();
double b = (limelight3.getTA()*100) / (Math.cos(90-limelight3.getTx()));
if(limelight3.getV() == true){
if(limelight3.getTA() > 1.2){
drivetrain.setControl(drive.
withRotationalRate(a/20).
withVelocityX(0).
withVelocityY( b/50));
System.out.println(b/50);
}
}
else{
drivetrain.setControl(drive.
withRotationalRate(0).