1 package org
.usfirst
.frc
.team3501
.robot
;
3 import org
.usfirst
.frc
.team3501
.robot
.commands
.auton
.Auton
;
4 import org
.usfirst
.frc
.team3501
.robot
.commands
.driving
.SetLowGear
;
5 import org
.usfirst
.frc
.team3501
.robot
.subsystems
.DriveTrain
;
6 import org
.usfirst
.frc
.team3501
.robot
.subsystems
.IntakeArm
;
7 import org
.usfirst
.frc
.team3501
.robot
.subsystems
.Shooter
;
9 import edu
.wpi
.first
.wpilibj
.CameraServer
;
10 import edu
.wpi
.first
.wpilibj
.IterativeRobot
;
11 import edu
.wpi
.first
.wpilibj
.command
.Scheduler
;
12 import edu
.wpi
.first
.wpilibj
.smartdashboard
.SendableChooser
;
14 public class Robot
extends IterativeRobot
{
16 public static DriveTrain driveTrain
;
17 public static Shooter shooter
;
18 public static IntakeArm intakeArm
;
20 // Sendable Choosers send a drop down menu to the Smart Dashboard.
21 private static SendableChooser frontChooser
;
22 private static CameraServer camera
;
25 public void robotInit() {
26 driveTrain
= new DriveTrain();
27 shooter
= new Shooter();
28 intakeArm
= new IntakeArm();
32 camera
= CameraServer
.getInstance();
34 camera
.startAutomaticCapture("cam0");
38 public void autonomousInit() {
40 // Scheduler.getInstance().add(new
41 // MoveIntakeArm(Constants.IntakeArm.RETRACT));
42 // Scheduler.getInstance().add(new TimeDrive(1, .6));
43 // Scheduler.getInstance().add(new WaitCommand(1));
44 // Scheduler.getInstance().add(new
45 // MoveIntakeArm(Constants.IntakeArm.EXTEND));
46 Scheduler
.getInstance().add(new Auton());
50 public void autonomousPeriodic() {
51 Scheduler
.getInstance().run();
55 public void teleopInit() {
56 Scheduler
.getInstance().add(new SetLowGear());
60 public void teleopPeriodic() {
61 Scheduler
.getInstance().run();