auto chooser + slightly reworked autos

This commit is contained in:
aarav18
2022-04-07 15:13:24 -06:00
parent 096019bee5
commit c7f4ab8514
3 changed files with 163 additions and 243 deletions
@@ -56,7 +56,6 @@ public class RunCommandForTime extends CommandBase {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
System.out.println("RUNNING");
this.elapsed = System.currentTimeMillis() - this.start;
this.command.execute();
}
@@ -71,8 +70,6 @@ public class RunCommandForTime extends CommandBase {
@Override
public boolean isFinished() {
if (this.override) {
System.out.println("Duration: " + duration);
System.out.println("Elapsed: " + elapsed);
return (this.elapsed >= this.duration);
} else {
return (this.command.isFinished() && (this.elapsed >= this.duration));