print(inf, '; Connected=%s' % conn)
# init
camera = Camera(1, 10)
camera.set(3, CAMERA_WIDTH)
camera.set(4, CAMERA_HEIGHT)
camera.set(5, 20)
NetworkTable.setIPAddress("roboRIO-6731-FRC.local")
NetworkTable.setClientMode()
NetworkTable.initialize()
vtable = NetworkTable.getTable("vision")
NetworkTable.addConnectionListener(connectionListener, immediateNotify=True)
if SHOW_IMAGE :
cv2.startWindowThread()
cv2.namedWindow("image")
cv2.imshow("image", camera.get_image())
# main
while True:
st = time.time()
img = camera.capture()
if USE_VISION:
img,a1,a2,c1,c2,ct = finder.findPoints(img, SHOW_IMAGE)
