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){
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)));
}
}
withVelocityX(2-botx).
withVelocityY(2-botz));
}
}
else{
drivetrain.setControl(drive.
withRotationalRate(0).