This commit is contained in:
Samuel
2025-11-12 18:57:29 -05:00
5 changed files with 41 additions and 27 deletions

View File

@@ -63,22 +63,10 @@ public class AprilTag3 extends Command {
}
else if(Botyaw >90 && Botyaw <=180){
drivetrain.setControl(drive.
withRotationalRate(tx/20).
withVelocityX(MathUtil.clamp(-x/4, -1, 1)).
withVelocityY(MathUtil.clamp(z/4, -1, 1)));
}
else if(Botyaw >-90 && Botyaw <=0){
drivetrain.setControl(drive.
withRotationalRate(tx/20).
withVelocityX(MathUtil.clamp(-x/4, -1, 1)).
withVelocityY(MathUtil.clamp(-z/4, -1, 1)));
}
else if(Botyaw >-180 && Botyaw <=-90){
drivetrain.setControl(drive.
withRotationalRate(tx/20).
withVelocityX(MathUtil.clamp(x/4, -1, 1)).
withVelocityY(MathUtil.clamp(-z/4, -1, 1)));
}
withRotationalRate(a/20).
withVelocityX(0).
withVelocityY( b/50));
System.out.println(b/50);
}
else{
drivetrain.setControl(drive.

View File

@@ -31,7 +31,7 @@ public class Algue_inspire extends Command {
@Override
public void execute() {
if(pince.emperagealgue()>60){
if(pince.emperagealgue()>90){
pince.aspirealgue(0);
bougie.Bleu();
}

View File

@@ -32,7 +32,7 @@ public class CoralExpire extends Command {
}
*/
pince.aspirecoral(-.5);
bougie.Jaune();
bougie.Rouge();
}
// Called once the command ends or is interrupted.