Function main

examples/Camera Telemetry/camera_telemetry.py:175–248

()

def main():
    args = parse_args()

    if not HAS_CV2:
        print("ERROR: opencv-python is not installed.")
        print("       Install with:  pip install opencv-python")
        sys.exit(1)

    use_camera = not args.no_camera
    cap = None

    if use_camera:
        cap = open_camera(args.camera, args.fps)
        if cap is None:
            print(
                f"WARNING: could not open camera {args.camera}, falling back to synthetic pattern."
            )
            use_camera = False

    sender = UDPSender(UDP_HOST, args.port)
    interval = 1.0 / args.fps

    print(
        f"Camera Telemetry → udp://{UDP_HOST}:{args.port}  @ {args.fps:.0f} Hz  quality={args.quality}"
    )
    print("Source:", f"camera {args.camera}" if use_camera else "synthetic pattern")
    print("Press Ctrl+C to stop.\n")
    print(f"{'Frame':>8}  {'FPS':>6}  {'JPEG kB':>8}")
    print("-" * 28)

    frame_count = 0
    t_start = time.monotonic()

    try:
        while True:
            t0 = time.monotonic()
            t = t0 - t_start

            if use_camera:
                ok, frame_bgr = cap.read()
                if not ok:
                    print("Camera read failed, switching to synthetic pattern.")
                    use_camera = False
                    frame_bgr = make_synthetic_frame(t)
            else:
                frame_bgr = make_synthetic_frame(t)

            frame_count += 1

            jpeg_bytes = encode_jpeg(frame_bgr, args.quality)
            if jpeg_bytes:
                sender.send(jpeg_bytes)

            fps_actual = frame_count / max(t, 0.001)
            sender.send(
                b"\xab\xcd\xef"
                + f"{fps_actual:.1f},{frame_count}".encode()
                + b"\xfe\xed"