Minor edit
[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / CameraFeeds.java
1 package org.usfirst.frc.team3501.robot;
2
3 import edu.wpi.cscore.AxisCamera;
4 import edu.wpi.cscore.UsbCamera;
5 import edu.wpi.cscore.VideoSource;
6 import edu.wpi.first.wpilibj.CameraServer;
7
8 public class CameraFeeds {
9 // private final int intakeCam;
10 // private final int climberCam;
11 private VideoSource curCam;
12 private CameraServer server;
13 private static UsbCamera intakeCam;
14 private static AxisCamera climberCam;
15 private static String usbCamName;
16 private static String axisCamName;
17 private static CameraFeeds cameraFeeds = null;
18
19 @SuppressWarnings("deprecation")
20 private CameraFeeds(/* Joystick Button */) {
21 System.out.println("Enter CameraFeeds constructor");
22 server = CameraServer.getInstance();
23 climberCam = server.addAxisCamera("ClimberCam", "10.35.1.11");
24 // intakeCam = server.startAutomaticCapture();
25 usbCamName = intakeCam.getName();
26 axisCamName = climberCam.getName();
27 curCam = climberCam;
28 changeCam(curCam);
29 }
30
31 public static CameraFeeds getCameraFeeds() {
32 if (cameraFeeds == null) {
33 cameraFeeds = new CameraFeeds();
34 }
35 return cameraFeeds;
36
37 }
38
39 public void init() {
40 // changeCam(climberCam);
41 }
42
43 public void toggleCamera() {
44 System.out.println("enter toggleCamera");
45 if (curCam.equals(intakeCam)) {
46 changeCam(climberCam);
47 curCam = climberCam;
48 System.out
49 .println("Switching to climber camera, curCam = " + curCam.getName());
50 } else if (curCam.equals(climberCam)) {
51 changeCam(intakeCam);
52 curCam = intakeCam;
53 System.out
54 .println("Switching to intake camera, curCam = " + curCam.getName());
55 }
56 }
57
58 /**
59 *
60 * Change the camera to get image from to a different one
61 *
62 * newId for camera
63 */
64 public void changeCam(VideoSource cam) {
65 server.removeCamera(curCam.getName());
66 }
67 }