This commit is contained in:
Antoine PerreaultE
2025-11-17 18:17:26 -05:00
parent 55ff246629
commit 2b6839b686

View File

@@ -67,16 +67,10 @@ public class AprilTag3 extends Command {
if(tagId ==8){ if(tagId ==8){
drivetrain.setControl(drive. drivetrain.setControl(drive.
withRotationalRate(tx/20). withRotationalRate(tx/20).
withVelocityX(MathUtil.clamp(-x/4, -1, 1)). withVelocityX(2-botx).
withVelocityY(MathUtil.clamp(-z/4, -1, 1))); withVelocityY(2-botz));
} }
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.
withRotationalRate(0). withRotationalRate(0).