Shooter PREP

This commit is contained in:
ryan123rudder
2020-02-22 13:01:50 -07:00
parent 5534ff6ef2
commit 77e536d2b1
6 changed files with 80 additions and 20 deletions
@@ -8,16 +8,24 @@
package frc4388.robot.commands;
import edu.wpi.first.wpilibj2.command.ParallelCommandGroup;
import edu.wpi.first.wpilibj2.command.RunCommand;
import frc4388.robot.subsystems.Shooter;
import frc4388.robot.subsystems.ShooterAim;
import frc4388.robot.subsystems.Storage;
// NOTE: Consider using this command inline, rather than writing a subclass. For more
// information, see:
// https://docs.wpilib.org/en/latest/docs/software/commandbased/convenience-features.html
public class ShootPrepGroup extends ParallelCommandGroup {
/**
* Creates a new ShootPrepGroup.
* Preps the Shooter to be fired
*/
public ShootPrepGroup() {
// Add your commands in the super() call, e.g.
// super(new FooCommand(), new BarCommand());super();
public ShootPrepGroup(Shooter m_shooter, ShooterAim m_shooterAim, Storage m_storage) {
super(
new TrackTarget(m_shooter, m_shooterAim),
new ShooterVelocityControlPID(m_shooter, m_shooter.addFireVel()),
new HoodAdjustPID(m_shooter),
new StoragePrepAim(m_storage)
);
}
}