2 Commits

View File

@ -95,25 +95,20 @@ public class RobotContainer {
drivetrain.setDefaultCommand( drivetrain.setDefaultCommand(
// Drivetrain will execute this command periodically // Drivetrain will execute this command periodically
drivetrain.applyRequest(() -> drivetrain.applyRequest(() ->
drive.withVelocityX(MathUtil.applyDeadband(Math.pow(-manette1.getLeftX(), 2)*MaxSpeed, 0.1)) // Drive forward with negative Y (forward) drive.withVelocityX(MathUtil.applyDeadband(-manette1.getLeftX()*manette1.getLeftX()*manette1.getLeftX()*MaxSpeed, 0.05)) // Drive forward with negative Y (forward)
.withVelocityY(MathUtil.applyDeadband(Math.pow(-manette1.getLeftY(), 2)*MaxSpeed, 0.10000)) // Drive left with negative X (left) .withVelocityY(MathUtil.applyDeadband(manette1.getLeftY()*manette1.getLeftY()*manette1.getLeftY()*MaxSpeed, 0.05)) // Drive left with negative X (left)
.withRotationalRate(MathUtil.applyDeadband(Math.pow(-manette1.getRightX(), 2)*manette1.getRightX()*MaxAngularRate, 0.1)) // Drive counterclockwise with negative X (left) .withRotationalRate(MathUtil.applyDeadband(-manette1.getRightX()*manette1.getRightX()*manette1.getRightX()*MaxAngularRate, 0.05)) // Drive counterclockwise with negative X (left)
) )
); );
// Elevateur manuel // Elevateur manuel
drivetrain.registerTelemetry(logger::telemeterize); drivetrain.registerTelemetry(logger::telemeterize);
elevateur.setDefaultCommand(new RunCommand(()->{ elevateur.setDefaultCommand(new RunCommand(()->{
if(elevateur.limit2()){ elevateur.vitesse(MathUtil.applyDeadband(manette2.getLeftY()*manette2.getLeftY()*manette2.getLeftY(), 0.05));
elevateur.vitesse(0);
}
else{
elevateur.vitesse(MathUtil.applyDeadband(manette2.getLeftX(), 0.1));
}
}, elevateur)); }, elevateur));
//Pince manuel //Pince manuel
pince.setDefaultCommand(new RunCommand(()->{ pince.setDefaultCommand(new RunCommand(()->{
pince.pivote(MathUtil.applyDeadband(manette2.getRightY(), 0.1)); pince.pivote(MathUtil.applyDeadband(manette2.getRightY()*manette2.getRightY()*manette2.getRightY(), 0.05));
}, pince)); }, pince));
@ -137,7 +132,7 @@ public class RobotContainer {
//pince //pince
manette2.a().whileTrue(new CorailAspir(pince)); manette2.a().whileTrue(new CorailAspir(pince));
manette2.start().whileTrue(new reset(elevateur, pince)); manette2.start().whileTrue(new reset(elevateur,pince));
manette2.b().whileTrue(new Algue_inspire(pince)); manette2.b().whileTrue(new Algue_inspire(pince));
manette2.start().whileTrue(new reset(elevateur,pince)); manette2.start().whileTrue(new reset(elevateur,pince));
manette2.leftTrigger().whileTrue(new AlgueExpire(pince, bougie)); manette2.leftTrigger().whileTrue(new AlgueExpire(pince, bougie));