Update ports to competition setup, minor bugfixes
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / Robot.java
1 package org.usfirst.frc.team3501.robot;
2
3 import org.usfirst.frc.team3501.robot.commands.driving.SetHighGear;
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;
9
10 import edu.wpi.first.wpilibj.IterativeRobot;
11 import edu.wpi.first.wpilibj.command.Scheduler;
12
13 public class Robot extends IterativeRobot {
14 public static OI oi;
15 public static DriveTrain driveTrain;
16 public static Shooter shooter;
17 public static IntakeArm intakeArm;
18
19 @Override
20 public void robotInit() {
21 driveTrain = new DriveTrain();
22 shooter = new Shooter();
23 intakeArm = new IntakeArm();
24
25 oi = new OI();
26 }
27
28 @Override
29 public void autonomousInit() {
30 }
31
32 @Override
33 public void autonomousPeriodic() {
34 Scheduler.getInstance().run();
35 }
36
37 @Override
38 public void teleopInit() {
39 Scheduler.getInstance().add(new SetHighGear());
40 Scheduler.getInstance().add(new ResetCatapult());
41 Scheduler.getInstance().add(new MoveIntakeArm(Constants.IntakeArm.EXTEND));
42 }
43
44 @Override
45 public void teleopPeriodic() {
46 Scheduler.getInstance().run();
47 }
48
49 }