diff --git a/src/main/java/frc4388/robot/RobotContainer.java b/src/main/java/frc4388/robot/RobotContainer.java index 1d50f0b..ebb4656 100644 --- a/src/main/java/frc4388/robot/RobotContainer.java +++ b/src/main/java/frc4388/robot/RobotContainer.java @@ -19,6 +19,7 @@ import edu.wpi.first.wpilibj2.command.ConditionalCommand; import edu.wpi.first.wpilibj2.command.InstantCommand; import edu.wpi.first.wpilibj2.command.RunCommand; import edu.wpi.first.wpilibj2.command.SequentialCommandGroup; +import edu.wpi.first.wpilibj2.command.WaitCommand; import edu.wpi.first.wpilibj2.command.button.JoystickButton; import edu.wpi.first.wpilibj2.command.button.POVButton; import frc4388.robot.Constants.*; @@ -165,9 +166,10 @@ public class RobotContainer { private SequentialCommandGroup placeConeMid = new SequentialCommandGroup( new PivotCommand(m_robotArm, 189), - new TeleCommand(m_robotArm, 34500), - toggleClaw.asProxy(), - armToHome.asProxy() + new WaitCommand(0.3), + new TeleCommand(m_robotArm, 34000) + // toggleClaw.asProxy(), + // armToHome.asProxy() ); private SequentialCommandGroup placeLow = new SequentialCommandGroup( diff --git a/src/main/java/frc4388/robot/commands/Wait.java b/src/main/java/frc4388/robot/commands/Wait.java new file mode 100644 index 0000000..f123fd1 --- /dev/null +++ b/src/main/java/frc4388/robot/commands/Wait.java @@ -0,0 +1,32 @@ +// Copyright (c) FIRST and other WPILib contributors. +// Open Source Software; you can modify and/or share it under the terms of +// the WPILib BSD license file in the root directory of this project. + +package frc4388.robot.commands; + +import edu.wpi.first.wpilibj2.command.CommandBase; + +public class Wait extends CommandBase { + /** Creates a new Wait. */ + public Wait() { + // Use addRequirements() here to declare subsystem dependencies. + } + + // Called when the command is initially scheduled. + @Override + public void initialize() {} + + // Called every time the scheduler runs while the command is scheduled. + @Override + public void execute() {} + + // Called once the command ends or is interrupted. + @Override + public void end(boolean interrupted) {} + + // Returns true when the command should end. + @Override + public boolean isFinished() { + return false; + } +}