This commit is contained in:
Antoine PerreaultE
2025-11-10 18:06:08 -05:00
parent 34ea5ba46f
commit 38a0fc3413
2 changed files with 4 additions and 1 deletions

View File

@@ -151,7 +151,7 @@ public class RobotContainer {
elevateur.setDefaultCommand(new RunCommand(()->{
elevateur.vitesse(MathUtil.applyDeadband(manette2.getLeftY()*manette2.getLeftY()*manette2.getLeftY(), 0.05));
}, elevateur));
//Reset encodeur
manette2.start().whileTrue(new reset(elevateur, pince, requin));
}

View File

@@ -50,11 +50,14 @@ 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.