Grattedebug
This commit is contained in:
@ -18,8 +18,10 @@ public class DescendrePivotBras extends SequentialCommandGroup {
|
||||
// Add your commands in the addCommands() call, e.g.
|
||||
// addCommands(new FooCommand(), new BarCommand());
|
||||
addCommands(
|
||||
|
||||
new Bougerbras(brasTelescopique, distanceBras),
|
||||
new Bougerpivot(pivot, distancePivot)
|
||||
|
||||
);
|
||||
}
|
||||
}
|
||||
|
@ -4,7 +4,7 @@
|
||||
|
||||
package frc.robot.commands.bras;
|
||||
|
||||
import edu.wpi.first.wpilibj2.command.Commands;
|
||||
|
||||
import edu.wpi.first.wpilibj2.command.ParallelCommandGroup;
|
||||
import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;
|
||||
import frc.robot.subsystems.bras.BrasTelescopique;
|
||||
@ -13,15 +13,17 @@ import frc.robot.subsystems.bras.Pivot;
|
||||
// NOTE: Consider using this command inline, rather than writing a subclass. For more
|
||||
// information, see:
|
||||
// https://docs.wpilib.org/en/stable/docs/software/commandbased/convenience-features.html
|
||||
public class MonterPivotBras extends ParallelCommandGroup {
|
||||
public class MonterPivotBras extends SequentialCommandGroup {
|
||||
/** Creates a new Sequancepivotbras. */
|
||||
public MonterPivotBras(BrasTelescopique brasTelescopique, Pivot pivot, double distanceBras, double distancePivot) {
|
||||
|
||||
// Add your commands in the addCommands() call, e.g.
|
||||
// addCommands(new FooCommand(), new BarCommand());
|
||||
addCommands(
|
||||
new SequentialCommandGroup(Commands.waitUntil(()->pivot.distance()>8),new Bougerbras(brasTelescopique, distanceBras)),
|
||||
new Bougerpivot(pivot, distancePivot)
|
||||
new Bougerpivot(pivot, 10).unless(()->pivot.distance()>10),
|
||||
new ParallelCommandGroup(new Bougerpivot(pivot, distancePivot)),
|
||||
new ParallelCommandGroup(new Bougerbras(brasTelescopique, distanceBras))
|
||||
|
||||
|
||||
);
|
||||
}
|
||||
|
@ -29,11 +29,11 @@ public class PivoteBrasMilieux extends CommandBase {
|
||||
// Called every time the scheduler runs while the command is scheduled.
|
||||
@Override
|
||||
public void execute() {
|
||||
if(brasTelescopique.distance()>-12.5){
|
||||
if(brasTelescopique.distance()>-11){
|
||||
brasTelescopique.AvanceRecule(-0.15);
|
||||
brasTelescopique.fermer();
|
||||
}
|
||||
else if(brasTelescopique.distance()<-13.5) {
|
||||
else if(brasTelescopique.distance()<-13) {
|
||||
brasTelescopique.AvanceRecule(0.15);
|
||||
}
|
||||
else {
|
||||
|
Reference in New Issue
Block a user