Spin up before engaging shooter pid

This commit is contained in:
aarav18
2020-01-21 16:45:29 -07:00
parent db5c15a452
commit 7f96cecc4d
4 changed files with 11 additions and 6 deletions
@@ -31,7 +31,11 @@ public class ShooterVelocityControlPID extends CommandBase {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
m_shooter.runDrumShooterVelocityPID(m_targetVel);
if (m_shooter.m_shooterFalcon.getActiveTrajectoryVelocity() < 1000){
m_shooter.runDrumShooter(0.5);
} else {
m_shooter.runDrumShooterVelocityPID(m_targetVel);
}
}
// Called once the command ends or is interrupted.