Minor edit

[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / CameraFeeds.java

diff --git a/src/org/usfirst/frc/team3501/robot/CameraFeeds.java b/src/org/usfirst/frc/team3501/robot/CameraFeeds.java
index e59b8ecc75257a1ec90282f66d6bf33b794fc0a8..b18fbca8cebb663f1f009ff0f4f718346fe77488 100755 (executable)
--- a/src/org/usfirst/frc/team3501/robot/CameraFeeds.java
+++ b/src/org/usfirst/frc/team3501/robot/CameraFeeds.java
@@ -15,58 +15,43 @@ public class CameraFeeds {
   private static String usbCamName;
   private static String axisCamName;
   private static CameraFeeds cameraFeeds = null;
- 
 
   @SuppressWarnings("deprecation")
-  public CameraFeeds(/* Joystick Button */) {
-    // Get camera id by supplying camera name example 'cam0', found on roborio web
-    // interface
-    /*
-     * intakeCam =
-     * NIVision.IMAQdxOpenCamera(Constants.CameraFeeds.camNameCenter,
-     * NIVision.IMAQdxCameraControlMode.CameraControlModeController); climberCam
-     * = NIVision.IMAQdxOpenCamera(Constants.CameraFeeds.camNameRight,
-     * NIVision.IMAQdxCameraControlMode.CameraControlModeController); curCam =
-     * intakeCam; // Image that will contain camera image frame =
-     * NIVision.imaqCreateImage(NIVision.ImageType.IMAGE_RGB, 0); // Server that
-     * we'll give the image to server = CameraServer.getInstance();
-     * server.setSize(Constants.CameraFeeds.imgQuality);
-     */
-
+  private CameraFeeds(/* Joystick Button */) {
+    System.out.println("Enter CameraFeeds constructor");
     server = CameraServer.getInstance();
-    climberCam = server.addAxisCamera("axisCamera", "10.35.1.11");
-    intakeCam = server.startAutomaticCapture();
-    curCam = intakeCam;
+    climberCam = server.addAxisCamera("ClimberCam", "10.35.1.11");
+    // intakeCam = server.startAutomaticCapture();
     usbCamName = intakeCam.getName();
     axisCamName = climberCam.getName();
-
-    // server = CameraServer.getInstance();
-    // axisCamera = cameraServer2.addAxisCamera("axisCamera", "10.35.1.11");
-    // cameraFeeds = new CameraFeeds();
+    curCam = climberCam;
+    changeCam(curCam);
   }
-  
+
   public static CameraFeeds getCameraFeeds() {
-         if (cameraFeeds == null) {
-                 cameraFeeds = new CameraFeeds();
-         }
-         return cameraFeeds;
-         
-         
+    if (cameraFeeds == null) {
+      cameraFeeds = new CameraFeeds();
+    }
+    return cameraFeeds;
+
   }
 
   public void init() {
-    changeCam(intakeCam);
+    // changeCam(climberCam);
   }
 
   public void toggleCamera() {
+    System.out.println("enter toggleCamera");
     if (curCam.equals(intakeCam)) {
       changeCam(climberCam);
       curCam = climberCam;
-    }
-
-    if (curCam.equals(climberCam)) {
+      System.out
+          .println("Switching to climber camera, curCam = " + curCam.getName());
+    } else if (curCam.equals(climberCam)) {
       changeCam(intakeCam);
       curCam = intakeCam;
+      System.out
+          .println("Switching to intake camera, curCam = " + curCam.getName());
     }
   }
 
@@ -74,12 +59,9 @@ public class CameraFeeds {
    *
    * Change the camera to get image from to a different one
    *
-   * newId
-   *          for camera
+   * newId for camera
    */
   public void changeCam(VideoSource cam) {
-    server.removeCamera(axisCamName);
-    server.removeCamera(usbCamName);
-    server.addCamera(cam);
+    server.removeCamera(curCam.getName());
   }
 }