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 a = limelight3.getTx();
double b = (limelight3.getTA()*100) / (Math.cos(90-limelight3.getTx())); double b = (limelight3.getTA()*100) / (Math.cos(90-limelight3.getTx()));
if(limelight3.getV() == true){ if(limelight3.getV() == true){
if(limelight3.getTA() > 1.2){
drivetrain.setControl(drive. drivetrain.setControl(drive.
withRotationalRate(a/20). withRotationalRate(a/20).
withVelocityX(0). withVelocityX(0).
withVelocityY( b/50)); withVelocityY( b/50));
System.out.println(b/50); System.out.println(b/50);
} }
}
else{ else{
drivetrain.setControl(drive. drivetrain.setControl(drive.
withRotationalRate(0). withRotationalRate(0).