mode auto

This commit is contained in:
Antoine PerreaultE
2026-04-01 19:27:12 -04:00
parent 56b28100df
commit b0ad34519e
5 changed files with 49 additions and 34 deletions

View File

@@ -20,6 +20,7 @@ import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.generated.TunerConstants;
import frc.robot.subsystems.CommandSwerveDrivetrain;
import frc.robot.subsystems.LimeLight3;
import frc.robot.subsystems.Limelight3G;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class GrimperMur extends Command {
@@ -57,6 +58,7 @@ public class GrimperMur extends Command {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
if(limeLight3.getV()){
BotPose = limeLight3.getBotPoseBlue();
botx = BotPose[0];
boty = BotPose[1];
@@ -96,7 +98,7 @@ public class GrimperMur extends Command {
}
}
}
}
}
// Called once the command ends or is interrupted.