diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java index 0315ac8..4a5236f 100644 --- a/src/main/java/frc/robot/RobotContainer.java +++ b/src/main/java/frc/robot/RobotContainer.java @@ -33,6 +33,7 @@ import frc.robot.commands.BrakeOuvre; import frc.robot.commands.GratteBaisser; import frc.robot.commands.GratteMonte; import frc.robot.commands.Gyro; +import frc.robot.commands.Reculer; import frc.robot.commands.bras.FermePince; import frc.robot.commands.bras.OuvrePince; import frc.robot.commands.bras.PivotBrasRentre; @@ -84,6 +85,11 @@ public RobotContainer() { public Command getAutonomousCommand() { return Commands.print("No autonomous command configured"); - + return new SequentialCommandGroup( + new PivoteBrasMilieux(brasTelescopique, pivot), + new OuvrePince(pince), + new PivotBrasRentre(brasTelescopique, pivot).alongWith(new Reculer(basePilotable)), + new Gyro(basePilotable) + ); } }