|
|
@ -100,20 +100,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(-manette1.getLeftY()*manette1.getLeftY()*MaxSpeed, 0.1)) // Drive forward with negative Y (forward)
|
|
|
|
drive.withVelocityX(MathUtil.applyDeadband(Math.pow(-manette1.getLeftX(), 2)*MaxSpeed, 0.1)) // Drive forward with negative Y (forward)
|
|
|
|
.withVelocityY(MathUtil.applyDeadband(-manette1.getLeftX()*manette1.getLeftX()*MaxSpeed, 0.10000)) // Drive left with negative X (left)
|
|
|
|
.withVelocityY(MathUtil.applyDeadband(Math.pow(-manette1.getLeftY(), 2)*MaxSpeed, 0.10000)) // Drive left with negative X (left)
|
|
|
|
.withRotationalRate(MathUtil.applyDeadband(-manette1.getRightX()*manette1.getRightX()*MaxAngularRate, 0.1)) // Drive counterclockwise with negative X (left)
|
|
|
|
.withRotationalRate(MathUtil.applyDeadband(Math.pow(-manette1.getRightX(), 2)*manette1.getRightX()*MaxAngularRate, 0.1)) // 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(()->{
|
|
|
|
elevateur.vitesse(MathUtil.applyDeadband(manette2.getLeftY()*manette2.getLeftY(), 0.1));
|
|
|
|
elevateur.vitesse(MathUtil.applyDeadband(manette2.getLeftY(), 0.1));
|
|
|
|
}, elevateur));
|
|
|
|
}, elevateur));
|
|
|
|
|
|
|
|
|
|
|
|
//Pince manuel
|
|
|
|
//Pince manuel
|
|
|
|
pince.setDefaultCommand(new RunCommand(()->{
|
|
|
|
pince.setDefaultCommand(new RunCommand(()->{
|
|
|
|
pince.pivote(MathUtil.applyDeadband(manette2.getRightY()*manette2.getRightY(), 0.1));
|
|
|
|
pince.pivote(MathUtil.applyDeadband(manette2.getRightY(), 0.1));
|
|
|
|
}, pince));
|
|
|
|
}, pince));
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|