+ climber = Climber.getClimber();
+
+ autonChooser = new SendableChooser();
+ autonChooser.addDefault("Middle Gear", new AutonMiddleGear());
+ autonChooser.addObject("Red Boiler Gear",
+ new AutonSideGear("RED", "BOILER"));
+ autonChooser.addObject("Red Retrieval Gear",
+ new AutonSideGear("RED", "RETRIEVAL"));
+ autonChooser.addObject("Blue Boiler Gear",
+ new AutonSideGear("BLUE", "BOILER"));
+ autonChooser.addObject("Blue Retrieval Gear",
+ new AutonSideGear("BLUE", "RETRIEVAL"));
+ SmartDashboard.putData("Autonomous Chooser", autonChooser);
+
+ CameraServer server = CameraServer.getInstance();
+ UsbCamera climberCam = server.startAutomaticCapture("climbercam", 0);
+ UsbCamera intakeCam = server.startAutomaticCapture("intakecam", 1);