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
@@ -39,7 +39,7 @@ public class LidarAlign extends Command {
this.currentFinderTick = 0;
this.speed = 0.4; // TODO: find good speed for this
this.foundReef = false;
this.headedRight = !(GotoLastApril.tagRelativeXError < 0);
this.headedRight = (GotoLastApril.tagRelativeXError < 0);
}
@@ -52,7 +52,7 @@ public class LidarAlign extends Command {
return;
}
if (currentFinderTick > 100) { //arbutrary threshhold for now.
if (currentFinderTick > 40) { //arbutrary threshhold for now.
headedRight = !headedRight;
currentFinderTick *= -1;
}