import org.usfirst.frc.team3501.robot.subsystems.DefenseArm;
import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
import org.usfirst.frc.team3501.robot.subsystems.IntakeArm;
import org.usfirst.frc.team3501.robot.subsystems.Scaler;
import org.usfirst.frc.team3501.robot.subsystems.Shooter;
import org.usfirst.frc.team3501.robot.subsystems.DefenseArm;
import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
import org.usfirst.frc.team3501.robot.subsystems.IntakeArm;
import org.usfirst.frc.team3501.robot.subsystems.Scaler;
import org.usfirst.frc.team3501.robot.subsystems.Shooter;
import edu.wpi.first.wpilibj.IterativeRobot;
import edu.wpi.first.wpilibj.command.Scheduler;
import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
import edu.wpi.first.wpilibj.IterativeRobot;
import edu.wpi.first.wpilibj.command.Scheduler;
import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
SendableChooser positionOneDefense, positionTwoDefense, positionThreeDefense,
positionFourDefense, positionFiveDefense;
SendableChooser positionOneDefense, positionTwoDefense, positionThreeDefense,
positionFourDefense, positionFiveDefense;
addDefenseOptions(positionOneDefense);
addDefenseOptions(positionTwoDefense);
addDefenseOptions(positionThreeDefense);
addDefenseOptions(positionOneDefense);
addDefenseOptions(positionTwoDefense);
addDefenseOptions(positionThreeDefense);
SmartDashboard.putData("Position Four Defense Chooser",
positionFourDefense);
SmartDashboard.putData("Position Five Defense Chooser",
positionFiveDefense);
shooter = new Shooter();
SmartDashboard.putData("Position Four Defense Chooser",
positionFourDefense);
SmartDashboard.putData("Position Five Defense Chooser",
positionFiveDefense);
shooter = new Shooter();
System.out.println("Chosen Position: " + chosenPosition);
System.out.println("Chosen Defense: " + chosenDefense);
System.out.println("Chosen Position: " + chosenPosition);
System.out.println("Chosen Defense: " + chosenDefense);