From eece0f47fa9071b3ea8b7d3022152c2a0e79d3f6 Mon Sep 17 00:00:00 2001 From: Antoine PerreaultE Date: Wed, 29 Jan 2025 18:43:31 -0500 Subject: [PATCH] pince et elevateur --- src/main/java/frc/robot/command/Depart.java | 9 +++++++++ 1 file changed, 9 insertions(+) diff --git a/src/main/java/frc/robot/command/Depart.java b/src/main/java/frc/robot/command/Depart.java index 4d101e9..0980101 100644 --- a/src/main/java/frc/robot/command/Depart.java +++ b/src/main/java/frc/robot/command/Depart.java @@ -10,8 +10,10 @@ import frc.robot.subsystems.Elevateur; /* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */ public class Depart extends Command { private Elevateur elevateur; + private Pince pince; /** Creates a new L2. */ public Depart(Elevateur elevateur) { + this.elevateur = elevateur; addRequirements(elevateur); // Use addRequirements() here to declare subsystem dependencies. @@ -31,6 +33,13 @@ public class Depart extends Command { else{ elevateur.vitesse(-.5); } + if(pince.position()==true){ + pince.pivote(0); + pince.reset(); + } + else{ + pince.pivote(.5); + } } // Called once the command ends or is interrupted.