fix ToggleCameraFeed command
[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.cscore.AxisCamera;
8 import edu.wpi.first.wpilibj.CameraServer;
9 import edu.wpi.first.wpilibj.IterativeRobot;
10 import edu.wpi.first.wpilibj.command.Scheduler;
11
12 public class Robot extends IterativeRobot {
13 private static DriveTrain driveTrain;
14 private static Shooter shooter;
15 private static OI oi;
16 private static Intake intake;
17 // private static UsbCamera usbCamera;
18 private static CameraServer cameraServer2;
19 private static AxisCamera axisCamera;
20 private static CameraFeeds cameraFeeds;
21
22 @Override
23 public void robotInit() {
24 driveTrain = DriveTrain.getDriveTrain();
25 oi = OI.getOI();
26 shooter = Shooter.getShooter();
27 intake = Intake.getIntake();
28
29 cameraFeeds = CameraFeeds.getCameraFeeds();
30
31 // usbCamera = CameraServer.getInstance().startAutomaticCapture();
32
33 // cameraServer2 = CameraServer;getInstance();
34 // axisCamera = cameraServer2.addAxisCamera("axisCamera", "10.35.1.11");
35
36 // cameraServer2 = CameraServer.getInstance();
37 // axisCamera = cameraServer2.addAxisCamera("axisCamera", "10.35.1.11");
38
39 // usbCamera = CameraServer.getInstance().startAutomaticCapture();
40 // CameraServer.getInstance().startAutomaticCapture();
41 // cameraServer2 = CameraServer.getInstance();
42 // axisCamera = cameraServer2.addAxisCamera("axisCamera", "10.35.1.11");
43
44 // cameraFeeds = new CameraFeeds();
45
46 }
47
48 public static DriveTrain getDriveTrain() {
49 return DriveTrain.getDriveTrain();
50 }
51
52 public static Shooter getShooter() {
53 return Shooter.getShooter();
54 }
55
56 public static CameraFeeds getCameraFeeds() {
57 return cameraFeeds;
58 }
59
60 public static OI getOI() {
61 return OI.getOI();
62 }
63
64 public static Intake getIntake() {
65 return Intake.getIntake();
66 }
67
68 // If the gear values do not match in the left and right piston, then they are
69 // both set to high gear
70 @Override
71 public void autonomousInit() {
72 driveTrain.setHighGear();
73 }
74
75 @Override
76 public void autonomousPeriodic() {
77 Scheduler.getInstance().run();
78
79 }
80
81 @Override
82 public void teleopInit() {
83
84 }
85
86 @Override
87 public void teleopPeriodic() {
88 Scheduler.getInstance().run();
89
90 }
91 }