Compare commits

...

2 Commits

Author SHA1 Message Date
Antoine PerreaultE
bdffb48ece led 2026-04-01 19:35:55 -04:00
Antoine PerreaultE
5f44d5304a mode autonise mieux 2026-04-01 19:35:31 -04:00
3 changed files with 3 additions and 12 deletions

View File

@@ -46,22 +46,12 @@ public class BougerGaucheAuto extends Command {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
if(alliance.get() == Alliance.Blue){
if(timer.get() < 0.75){
if(timer.get() < 1.25){
drivetrain.setControl(drive.withVelocityY(1.5));
}
else{
drivetrain.setControl(drive.withVelocityY(0));
}
}
else{
if(timer.get() < 0.75){
drivetrain.setControl(drive.withVelocityY(1.5));
}
else{
drivetrain.setControl(drive.withVelocityY(0));
}
}
}
// Called once the command ends or is interrupted.

View File

@@ -73,7 +73,7 @@ public class GrimperReservoir extends Command {
x = 15.6;
angle = 180;
if(pigeonAngle< 190 && pigeonAngle> 170){
drivetrain.setControl(drive.withVelocityY(MathUtil.clamp((-(y-boty)*5.5), -2, 2)).withVelocityX(MathUtil.clamp((-(x-botx)*5.5),-2,2)));
drivetrain.setControl(drive.withVelocityY(MathUtil.clamp((-(y-boty)*6.5), -2, 2)).withVelocityX(MathUtil.clamp((-(x-botx)*6.5),-2,2)));
}
else{
if(pigeonAngle>180){

View File

@@ -68,6 +68,7 @@ public class LEDSubsystem extends SubsystemBase {
*/
public Command updateLEDs() {
double temps = DriverStation.getMatchTime();
System.out.println(temps);
return run(() -> {
if(Equipe()){
if(temps > 110){