2020-02-22 11:23:57 -07:00
|
|
|
/*----------------------------------------------------------------------------*/
|
|
|
|
|
/* Copyright (c) 2019 FIRST. All Rights Reserved. */
|
|
|
|
|
/* Open Source Software - may be modified and shared by FRC teams. The code */
|
|
|
|
|
/* must be accompanied by the FIRST BSD license file in the root directory of */
|
|
|
|
|
/* the project. */
|
|
|
|
|
/*----------------------------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
package frc4388.robot.commands;
|
|
|
|
|
|
|
|
|
|
import edu.wpi.first.wpilibj2.command.ParallelRaceGroup;
|
2020-02-22 12:06:14 -07:00
|
|
|
import edu.wpi.first.wpilibj2.command.RunCommand;
|
|
|
|
|
import frc4388.robot.subsystems.Shooter;
|
|
|
|
|
import frc4388.robot.subsystems.ShooterAim;
|
|
|
|
|
import frc4388.robot.subsystems.Storage;
|
2020-02-22 11:23:57 -07:00
|
|
|
|
|
|
|
|
// 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 ShootFireGroup extends ParallelRaceGroup {
|
|
|
|
|
/**
|
|
|
|
|
* Creates a new ShootFireGroup.
|
|
|
|
|
*/
|
2020-02-22 12:06:14 -07:00
|
|
|
public ShootFireGroup(Shooter m_shooter, ShooterAim m_shooterAim, Storage m_storage) {
|
|
|
|
|
|
2020-02-22 11:23:57 -07:00
|
|
|
// Add your commands in the super() call, e.g.
|
|
|
|
|
// super(new FooCommand(), new BarCommand());
|
2020-02-22 12:06:14 -07:00
|
|
|
super(
|
|
|
|
|
new ShooterVelocityControlPID(m_shooter, m_shooter.addFireVel()),
|
|
|
|
|
new RunCommand(() -> m_shooter.runAngleAdjustPID(m_shooter.addFireAngle())),
|
|
|
|
|
new TrackTarget(m_shooter, m_shooterAim),
|
|
|
|
|
new
|
|
|
|
|
);
|
2020-02-22 11:23:57 -07:00
|
|
|
}
|
|
|
|
|
}
|