sdesharnais/Rebuilt-2026
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Lanceur re/gle/

Browse Source
This commit is contained in:
Antoine PerreaultE
2026-03-10 18:27:47 -04:00
parent 8dfcd65405
commit d81ff3db3d
2 changed files with 11 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
src/main/java/frc/robot/commands/Lancer.java
View File

@@ -23,7 +23,7 @@ public class Lancer extends Command {
private Led led;
private double temp;
/** Creates a new Lancer. */
public Lancer(Lanceur lanceur, LimeLight3 limeLight3, Balayeuse balayeuse,Led led) {
public Lancer(Lanceur lanceur, Limelight3G limeLight3G, Balayeuse balayeuse,Led led) {
this.lanceur = lanceur;
this.balayeuse = balayeuse;
this.led = led;
@@ -46,6 +46,10 @@ public class Lancer extends Command {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
double[] BotPose = new double[6];
BotPose = limeLight3G.getBotPoseBlue();
double botx = BotPose[0];
double boty = BotPose[1];
int nbFois = 0;
double moyenneAmp = 0;
@@ -65,7 +69,9 @@ public class Lancer extends Command {
led.Jaune2();
}
else{
double vitesse = (100-limeLight3G.getTA())/lanceur.Vitesse();
//pythagore |
// \/
double vitesse = Math.sqrt(Math.pow(Math.abs(4.625594-botx), 2) + Math.pow(Math.abs(4.034536-boty), 2));
double output = pidController.calculate(lanceur.Vitesse(),vitesse);
lanceur.Lancer(output);
if(lanceur.Vitesse() >= vitesse){