1 package org
.usfirst
.frc
.team3501
.robot
;
3 import org
.usfirst
.frc
.team3501
.robot
.commands
.driving
.SetLowGear
;
4 import org
.usfirst
.frc
.team3501
.robot
.commands
.intakearm
.MoveIntakeArm
;
5 import org
.usfirst
.frc
.team3501
.robot
.commands
.shooter
.ResetCatapult
;
6 import org
.usfirst
.frc
.team3501
.robot
.subsystems
.DriveTrain
;
7 import org
.usfirst
.frc
.team3501
.robot
.subsystems
.IntakeArm
;
8 import org
.usfirst
.frc
.team3501
.robot
.subsystems
.Shooter
;
10 import edu
.wpi
.first
.wpilibj
.IterativeRobot
;
11 import edu
.wpi
.first
.wpilibj
.command
.Scheduler
;
13 public class Robot
extends IterativeRobot
{
15 public static DriveTrain driveTrain
;
16 public static Shooter shooter
;
17 public static IntakeArm intakeArm
;
20 public void robotInit() {
21 driveTrain
= new DriveTrain();
24 shooter
= new Shooter();
25 intakeArm
= new IntakeArm();
29 public void autonomousInit() {
30 Scheduler
.getInstance().run();
34 public void autonomousPeriodic() {
35 Scheduler
.getInstance().run();
39 public void teleopInit() {
40 Scheduler
.getInstance().add(new SetLowGear()); // Start each match in low
42 Scheduler
.getInstance().add(new ResetCatapult()); // Reset catapult at start
45 Scheduler
.getInstance().add(new MoveIntakeArm(Constants
.IntakeArm
.EXTEND
));
46 // Start testing with intake arm extended TODO remove this
50 public void teleopPeriodic() {
51 Scheduler
.getInstance().run();