diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java index c4aff39..265cf7d 100644 --- a/src/main/java/frc/robot/RobotContainer.java +++ b/src/main/java/frc/robot/RobotContainer.java @@ -40,6 +40,8 @@ import frc.robot.commands.GratteMonte; import frc.robot.commands.Gyro; import frc.robot.commands.Reculer; import frc.robot.commands.Tape; +import frc.robot.commands.bras.Bougerbras; +import frc.robot.commands.bras.Bougerpivot; import frc.robot.commands.bras.BrasManuel; import frc.robot.commands.bras.DescendrePivotBras; import frc.robot.commands.bras.FermePince; @@ -149,6 +151,8 @@ public class RobotContainer { Map.entry(aumilieux, creerCommandBras(9, -14)), Map.entry(enbas, creerCommandBras(44, -17)), Map.entry(nulpart, creerCommandBras(0, 0))), chooser::getSelected), + creerCommandBras(49, 40).unless(() -> chooser.getSelected().equals(enhaut)), + creerCommandBras(51, 40).unless(() -> chooser.getSelected().equals(enhaut)), new OuvrePince(pince).unless(() -> chooser.getSelected().equals(nulpart)), Commands.waitSeconds(1), new FermePince(pince).unless(() -> chooser.getSelected().equals(nulpart)),