Allow use of photogate as an option in shoot.java command group

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / shooter / Shoot.java

package org.usfirst.frc.team3501.robot.commands.shooter;
import org.usfirst.frc.team3501.robot.Robot;
import org.usfirst.frc.team3501.robot.commands.auton.AimAndAlign;

import edu.wpi.first.wpilibj.command.CommandGroup;
import edu.wpi.first.wpilibj.command.WaitCommand;

public class Shoot extends CommandGroup {

  public boolean usePhotogate;

  public Shoot() {
    addSequential(new AimAndAlign());
    addSequential(new WaitCommand(3.0));
    addSequential(new runShooter());
    addSequential(new WaitCommand(3.0));
    if (Robot.shooter.usePhotogate()) {
      if (Robot.shooter.isBallInside()) {
        addSequential(new ExtendPunch());
        addSequential(new WaitCommand(5.0));
        addSequential(new RetractPunch());
      }
    } else {
      addSequential(new ExtendPunch());
      addSequential(new WaitCommand(5.0));
      addSequential(new RetractPunch());
    }

  }
}