This commit is contained in:
samuel desharnais
2026-03-28 14:42:07 -04:00
3 changed files with 12 additions and 8 deletions

View File

@@ -64,7 +64,7 @@ public class Lancer extends Command {
lanceur.Lancer(output); lanceur.Lancer(output);
if(lanceur.Vitesse() >= vitesse-800){ if(lanceur.Vitesse() >= vitesse-800){
timer.start(); timer.start();
if(timer.get() >0.5){ if(timer.get() >1){
lanceur.Demeler(1); lanceur.Demeler(1);
} }

View File

@@ -43,13 +43,14 @@ public class LancerAuto extends Command {
public void execute() { public void execute() {
double[] BotPose = new double[6]; double[] BotPose = new double[6];
if(limelight3g.getV()){ if(limelight3g.getV()){
if(alliance.isPresent()){
if(alliance.get() == Alliance.Blue){ if(alliance.get() == Alliance.Blue){
BotPose = limelight3g.getBotPoseBlue(); BotPose = limelight3g.getBotPoseBlue();
} }
else{ else{
BotPose = limelight3g.getBotPoseRed(); BotPose = limelight3g.getBotPoseRed();
} }
}
botx = BotPose[0]; botx = BotPose[0];
boty = BotPose[1]; boty = BotPose[1];
} }
@@ -62,7 +63,7 @@ public class LancerAuto extends Command {
lanceur.Lancer(output); lanceur.Lancer(output);
if(lanceur.Vitesse() >= vitesse-800){ if(lanceur.Vitesse() >= vitesse-800){
timer.start(); timer.start();
if(timer.get() >0.5){ if(timer.get() >1){
lanceur.Demeler(1); lanceur.Demeler(1);
} }

View File

@@ -45,21 +45,24 @@ public class LimelighterAuto extends Command {
// Called when the command is initially scheduled. // Called when the command is initially scheduled.
@Override @Override
public void initialize() {} public void initialize() {
}
// Called every time the scheduler runs while the command is scheduled. // Called every time the scheduler runs while the command is scheduled.
@Override @Override
public void execute() { public void execute() {
double[] BotPose = new double[6]; double[] BotPose = new double[6];
System.out.println("e"); System.out.println("a");
if (limelight3g.getV()) { if (limelight3g.getV()) {
if(alliance.isPresent()){
if(alliance.get() == Alliance.Blue){ if(alliance.get() == Alliance.Blue){
BotPose = limelight3g.getBotPoseBlue(); BotPose = limelight3g.getBotPoseBlue();
} }
else{ else{
BotPose = limelight3g.getBotPoseRed(); BotPose = limelight3g.getBotPoseRed();
} }
}
botx = BotPose[1]; botx = BotPose[1];
boty = BotPose[0]; boty = BotPose[0];
angle = drivetrain.getPigeon2().getYaw().getValueAsDouble(); angle = drivetrain.getPigeon2().getYaw().getValueAsDouble();