Add codes

This commit is contained in:
Michael Mikovsky
2025-02-19 21:28:28 -07:00
parent 2641abe8a4
commit c5c6dd2eed
5 changed files with 108 additions and 27 deletions
@@ -78,6 +78,8 @@ public class GotoLastApril extends Command {
youtput *= Math.abs(yerr) < AutoConstants.XY_TOLERANCE ? 0 : 1;
rotoutput *= Math.abs(roterr) < AutoConstants.ROT_TOLERANCE ? 0 : 1;
// System.out.println(xerr + ", " + yerr + ", " + roterr + ", " + rotoutput);
Translation2d leftStick = new Translation2d(
Math.max(Math.min(-youtput, 1), -1),
Math.max(Math.min(-xoutput, 1), -1)