diff --git a/Main/src/main/java/com/chameleonvision/vision/camera/USBCameraCapture.java b/Main/src/main/java/com/chameleonvision/vision/camera/USBCameraCapture.java
index 8a950acf1..7113fbf4f 100644
--- a/Main/src/main/java/com/chameleonvision/vision/camera/USBCameraCapture.java
+++ b/Main/src/main/java/com/chameleonvision/vision/camera/USBCameraCapture.java
@@ -20,7 +20,8 @@ public class USBCameraCapture implements CameraCapture {
         cvSink = CameraServer.getInstance().getVideo(baseCamera);
         properties = new USBCameraProperties(baseCamera, config);
 
-        setVideoMode(properties.videoModes.get(0));
+        int videoMode = properties.videoModes.size() - 1 <= config.videomode ? config.videomode : 0;
+        setVideoMode(videoMode);
     }
 
     @Override