Fix Shooter PID

This commit is contained in:
ryan123rudder
2020-01-31 21:39:51 -07:00
parent 8a95c8a8cc
commit 42db77fe6d
6 changed files with 16 additions and 151 deletions
@@ -31,10 +31,11 @@ public class ShooterVelocityControlPID extends CommandBase {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
if (m_shooter.m_shooterFalcon.getActiveTrajectoryVelocity() < 1000){
if (/*m_shooter.m_shooterFalcon.getActiveTrajectoryVelocity() < 1000*/false){
m_shooter.runDrumShooter(0.5);
System.err.println("Less than 1000: " + m_shooter.m_shooterFalcon.getActiveTrajectoryVelocity());
} else {
m_shooter.runDrumShooterVelocityPID(m_targetVel);
m_shooter.runDrumShooterVelocityPID(m_targetVel, m_shooter.m_shooterFalcon.getActiveTrajectoryVelocity());
}
}