da4d82076860145cf7d0648703ad9bd0a51ed2f5
[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / Robot.java
1 package org.usfirst.frc.team3501.robot;
2
3 import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
4 import org.usfirst.frc.team3501.robot.subsystems.Intake;
5 import org.usfirst.frc.team3501.robot.subsystems.Shooter;
6
7 import edu.wpi.first.wpilibj.IterativeRobot;
8 import edu.wpi.first.wpilibj.command.Scheduler;
9 import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
10
11 public class Robot extends IterativeRobot {
12 private static DriveTrain driveTrain;
13 private static Shooter shooter;
14 private static OI oi;
15 private static Intake intake;
16
17 @Override
18 public void robotInit() {
19 driveTrain = DriveTrain.getDriveTrain();
20 oi = OI.getOI();
21 shooter = Shooter.getShooter();
22 intake = Intake.getIntake();
23 }
24
25 public static DriveTrain getDriveTrain() {
26 return DriveTrain.getDriveTrain();
27 }
28
29 public static Shooter getShooter() {
30 return Shooter.getShooter();
31 }
32
33 public static OI getOI() {
34 return OI.getOI();
35 }
36
37 public static Intake getIntake() {
38 return Intake.getIntake();
39 }
40
41 // If the gear values do not match in the left and right piston, then they are
42 // both set to high gear
43 @Override
44 public void autonomousInit() {
45 driveTrain.setHighGear();
46 SmartDashboard.putNumber("I", -1);
47 }
48
49 @Override
50 public void autonomousPeriodic() {
51 Scheduler.getInstance().run();
52 DriveTrain.getDriveTrain().getDriveController().setConstants(
53
54 }
55
56 @Override
57 public void teleopInit() {
58
59 }
60
61 @Override
62 public void teleopPeriodic() {
63 Scheduler.getInstance().run();
64 }
65 }