Initial regression test program for video(4).

2 files changed, 693 insertions, 0 deletions

diff --git a/regress/sys/dev/video/Makefile b/regress/sys/dev/video/Makefile
new file mode 100644
index 00000000000..1c4336a90a9
--- /dev/null
+++ b/regress/sys/dev/video/Makefile
@@ -0,0 +1,8 @@
+#	$OpenBSD: Makefile,v 1.1 2010/07/22 11:53:24 mglocker Exp $
+
+PROG=videotest
+SRCS=videotest.c
+CFLAGS+=-Wall -Wstrict-prototypes -Wmissing-prototypes
+CLEANFILES+=*.jpg *.raw
+
+.include <bsd.regress.mk>
diff --git a/regress/sys/dev/video/videotest.c b/regress/sys/dev/video/videotest.c
new file mode 100644
index 00000000000..63a9a56e43b
--- /dev/null
+++ b/regress/sys/dev/video/videotest.c
@@ -0,0 +1,685 @@
+/*	$OpenBSD: videotest.c,v 1.1 2010/07/22 11:53:24 mglocker Exp $ */
+
+/*
+ * Copyright (c) 2010 Marcus Glocker <mglocker@openbsd.org>
+ *
+ * Permission to use, copy, modify, and distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+/*
+ * Regression test program for the video(4) interface.
+ *
+ * TODO:
+ * - Add test for VIDIOC_ENUM_FRAMEINTERVALS ioctl.
+ * - Add test for VIDIOC_ENUMINPUT ioctl.
+ * - Add test for VIDIOC_S_INPUT ioctl.
+ * - Add test for VIDIOC_TRY_FMT ioctl.
+ * - Add test for VIDIOC_QUERYCTRL ioctl.
+ * - Add test for VIDIOC_G_CTRL ioctl.
+ * - Add test for VIDIOC_S_CTRL ioctl.
+ */
+
+#include <sys/ioctl.h>
+#include <sys/mman.h>
+#include <sys/types.h>
+#include <sys/videoio.h>
+
+#include <err.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <poll.h>
+#include <unistd.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+
+/*
+ * Defines.
+ */
+#define DEV_CHECK_NR		128
+#define	DEV_PATH		"/dev/"
+
+/*
+ * Some devices need a hell of time to initialize and stop (e.g. the
+ * Logitech Pro 9000).  If we don't give them that time, they will stall
+ * at some point in the open / close cycle and will require a cold reset
+ * (detach / attach) to operate again.
+ */
+#define WAIT_INIT		5		/* seconds */
+#define WAIT_STOP		15		/* seconds */
+
+#define POLL_NO			0
+#define	POLL_YES		1
+#define POLL_TIMEOUT		2000		/* milliseconds */
+
+#define	ACCESS_READ		0
+#define ACCESS_MMAP		1
+
+#define MMAP_QUEUE_NR		4
+
+/*
+ * Prototypes.
+ */
+int	 test_ioctl_querycap(int);
+int	 test_ioctl_g_fmt(int);
+int	 test_ioctl_enum_fmt(int);
+int	 test_ioctl_enum_fsizes(int, uint32_t, int);
+int	 test_capture(char *, char *, int, int);
+int	 test_capture_read(int, char *, int, int);
+int	 test_capture_mmap(int, char *, int, int);
+void	 jpeg_insert_dht(uint8_t *, int, uint8_t *, int *);
+char	*print_pixelformat(uint32_t, int);
+
+/*
+ * Structures.
+ */
+struct frame_buffer {
+	uint8_t		*buf;
+	int		 len;
+};
+
+struct sizes {
+	uint32_t	width;
+	uint32_t	height;
+};
+
+/*
+ * Global variables.
+ */
+struct fmt_sizes {
+	uint32_t	pixelformat;
+	struct sizes	s[32];
+} dev_fmts[8];
+
+/*
+ * Main program.
+ */
+int
+main(void)
+{
+	int	i, fd, r;
+	char	dev_name[32], dev_full[32];
+
+	for (i = 0; i < DEV_CHECK_NR; i++) {
+		/* assemble device name and path */
+		snprintf(dev_name, sizeof(dev_name), "video%d", i);
+		snprintf(dev_full, sizeof(dev_full), "%s%s",
+		    DEV_PATH, dev_name);
+
+		/* open video device */
+		fd = open(dev_full, O_RDWR, 0);
+		if (fd == -1) {
+			warn("%s", dev_full);
+			break;
+		}
+
+		/* run some ioctl tests */
+		r = test_ioctl_querycap(fd);
+		if (r == -1)
+			err(1, "ioctl_querycap");
+
+		r = test_ioctl_g_fmt(fd);
+		if (r == -1)
+			err(1, "ioctl_g_fmt");
+
+		r = test_ioctl_enum_fmt(fd);
+		if (r == -1)
+			err(1, "ioctl_enum_fmt");
+
+		/* close video device */
+		close(fd);
+
+		/* run frame capture tests */
+		r = test_capture(dev_name, dev_full, ACCESS_READ, POLL_NO);
+		if (r == -1)
+			err(1, "test_capture");
+
+		r = test_capture(dev_name, dev_full, ACCESS_READ, POLL_YES);
+		if (r == -1)
+			err(1, "test_capture");
+
+		r = test_capture(dev_name, dev_full, ACCESS_MMAP, POLL_NO);
+		if (r == -1)
+			err(1, "test_capture");
+
+		r = test_capture(dev_name, dev_full, ACCESS_MMAP, POLL_YES);
+		if (r == -1)
+			err(1, "test_capture");
+	}
+
+	return (0);
+}
+
+int
+test_ioctl_querycap(int fd)
+{
+	int			r;
+	struct v4l2_capability	caps;
+
+	printf("[ Calling VIDIOC_QUERYCAP ioctl ]\n\n");
+
+	memset(&caps, 0, sizeof(struct v4l2_capability));
+	r = ioctl(fd, VIDIOC_QUERYCAP, &caps);
+	if (r == -1)
+		return (-1);
+
+	printf("Driver       : %s\n", caps.driver);
+	printf("Card         : %s\n", caps.card);
+	printf("Bus Info     : %s\n", caps.bus_info);
+	printf("Version      : %d\n", caps.version);
+	printf("Capabilities : ");
+	if (caps.capabilities & V4L2_CAP_VIDEO_CAPTURE)
+		printf("CAPTURE ");
+	if (caps.capabilities & V4L2_CAP_STREAMING)
+		printf("STREAMING ");
+	if (caps.capabilities & V4L2_CAP_READWRITE)
+		printf("READWRITE ");
+	printf("\n");
+
+	printf("\n");
+
+	return (0);
+}
+
+int
+test_ioctl_g_fmt(int fd)
+{
+	int			r;
+	struct v4l2_format	fmt;
+
+	printf("[ Calling VIDIOC_G_FMT ioctl ]\n\n");
+
+	memset(&fmt, 0, sizeof(struct v4l2_format));
+	fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+	r = ioctl(fd, VIDIOC_G_FMT, &fmt);
+	if (r == -1)
+		return (r);
+
+	printf("Current format         : %s\n",
+	    print_pixelformat(fmt.fmt.pix.pixelformat, 0));
+	printf("Current width          : %u pixels\n", fmt.fmt.pix.width);
+	printf("Current height         : %u pixels\n", fmt.fmt.pix.height);
+	printf("Current max. framesize : %u bytes\n", fmt.fmt.pix.sizeimage);
+
+	printf("\n");
+
+	return (0);
+}
+
+int
+test_ioctl_enum_fmt(int fd)
+{
+	int			r;
+	struct v4l2_fmtdesc	fmtdesc;
+
+	printf("[ Calling VIDIOC_ENUM_FMT|VIDIOC_ENUM_FRAMESIZES ioctl ]\n\n");
+
+	memset(&fmtdesc, 0, sizeof(struct v4l2_fmtdesc));
+	fmtdesc.index = 0;
+	fmtdesc.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+	while ((r = ioctl(fd, VIDIOC_ENUM_FMT, &fmtdesc)) == 0) {
+		printf("Pixelformat '%s' ", fmtdesc.description);
+
+		(void)test_ioctl_enum_fsizes(fd, fmtdesc.pixelformat,
+		    fmtdesc.index);
+
+		fmtdesc.index++;
+	}
+	if (errno != EINVAL)
+		return (-1);
+
+	return (0);
+}
+
+int
+test_ioctl_enum_fsizes(int fd, uint32_t pixelformat, int index)
+{
+	int			r;
+	struct v4l2_frmsizeenum	fsizes;
+
+	printf("supports following sizes:\n");
+
+	memset(&fsizes, 0, sizeof(struct v4l2_frmsizeenum));
+	fsizes.index = 0;
+	fsizes.pixel_format = pixelformat;
+	while ((r = ioctl(fd, VIDIOC_ENUM_FRAMESIZES, &fsizes)) == 0) {
+		if (fsizes.type == V4L2_FRMSIZE_TYPE_DISCRETE) {
+			printf("discrete width = %u, height = %u\n",
+			    fsizes.discrete.width,
+			    fsizes.discrete.height);
+
+			/* save format and sizes for later use */
+			dev_fmts[index].pixelformat = pixelformat;
+			dev_fmts[index].s[fsizes.index].width =
+			    fsizes.discrete.width;
+			dev_fmts[index].s[fsizes.index].height =
+			    fsizes.discrete.height;
+		}
+
+		fsizes.index++;
+	}
+	if (errno != EINVAL)
+		return (-1);
+
+	printf("\n");
+
+	return (0);
+}
+
+int
+test_capture(char *dev_name, char *dev_full, int access, int use_poll)
+{
+	ssize_t			 n1, n2;
+	int			 fd1, fd2;
+	int			 i, j, r;
+	int			 buf_size, img_size, img_len;
+	char			 filename[64];
+	uint8_t			*buf, *img;
+	uint32_t		 last_pixelformat;
+	struct v4l2_format	 fmt;
+
+	fd1 = last_pixelformat = n1 = 0;
+	img = buf = NULL;
+
+	printf("[ Testing %s access type %s]\n\n",
+	    access == ACCESS_READ ? "READ" : "MMAP",
+	    use_poll ? "with poll " : "");
+
+	for (i = 0; i < 8; i++) {
+		/* did we reach end of formats? */
+		if (dev_fmts[i].pixelformat == 0)
+			return (0);
+
+		/* some devices have duplicate format descriptors */
+		if (last_pixelformat == dev_fmts[i].pixelformat)
+			continue;
+		else
+			last_pixelformat = dev_fmts[i].pixelformat;
+
+		for (j = 0; j < 32; j++) {
+			/* did we reach end of sizes? */
+			if (dev_fmts[i].s[j].width == 0) {
+				if (buf != NULL) {
+					free(buf);
+					buf = NULL;
+				}
+				if (img != NULL) {
+					free(img);
+					img = NULL;
+				}
+				break;
+			}
+
+			/* open device */
+			fd1 = open(dev_full, O_RDWR, 0);
+			if (fd1 == -1)
+				err(1, "open");
+			sleep(WAIT_INIT);	/* let device initialize */
+
+			/* set format */
+			printf("Set format to %s-%ux%u ... ",
+			    print_pixelformat(dev_fmts[i].pixelformat, 0),
+			    dev_fmts[i].s[j].width,
+			    dev_fmts[i].s[j].height);
+
+			memset(&fmt, 0, sizeof(struct v4l2_format));
+			fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+			fmt.fmt.pix.width = dev_fmts[i].s[j].width;
+			fmt.fmt.pix.height = dev_fmts[i].s[j].height;
+			fmt.fmt.pix.pixelformat = dev_fmts[i].pixelformat;
+			fmt.fmt.pix.field = V4L2_FIELD_ANY;
+			r = ioctl(fd1, VIDIOC_S_FMT, &fmt);
+			if (r == -1)
+				goto error;
+
+			printf("results in %u bytes max. framesize.\n",
+			    fmt.fmt.pix.sizeimage);
+
+			/* allocate frame and image buffer */
+			if (buf != NULL) {
+				free(buf);
+				buf = NULL;
+			}
+			if (img != NULL) {
+				free(img);
+				img = NULL;
+			}
+
+			buf_size = fmt.fmt.pix.sizeimage;
+			buf = malloc(buf_size);
+			if (buf == NULL)
+				goto error;
+			memset(buf, 0, buf_size);
+
+			img_size = fmt.fmt.pix.sizeimage + 1024;
+			img = malloc(img_size);
+			if (img == NULL)
+				goto error;
+			memset(img, 0, img_size);
+
+			/* get frame */
+			if (access == ACCESS_READ)
+				n1 = test_capture_read(fd1, buf, buf_size,
+				    use_poll);
+			else
+				n1 = test_capture_mmap(fd1, buf, buf_size,
+				    use_poll);
+			if (n1 == -1)
+				goto error;
+
+			/*
+			 * Convert frame to JPEG image.
+			 *
+			 * TODO:
+			 * For now just MJPEG convertion is supported.
+			 */
+			snprintf(filename, sizeof(filename),
+			    "%s_img_%s_%ux%u%s%s",
+			    dev_name,
+			    print_pixelformat(dev_fmts[i].pixelformat, 1),
+			    fmt.fmt.pix.width,
+			    fmt.fmt.pix.height,
+			    access == ACCESS_READ ? "_read" : "_mmap",
+			    use_poll ? "_poll" : "");
+
+			switch (dev_fmts[i].pixelformat) {
+			case V4L2_PIX_FMT_MJPEG:
+				printf("Converting MJPEG to JPEG.\n");
+
+				/* insert dynamic huffmann table to mjpeg */
+				jpeg_insert_dht(buf, n1, img, &img_len);
+
+				strncat(filename, ".jpg", 4);
+				break;
+			case V4L2_PIX_FMT_YUYV:
+				printf("Convertion for YUYV not supported!\n");
+
+				img_len = n1;
+				memcpy(img, buf, img_len);
+
+				strncat(filename, ".raw", 4);
+				break;
+			default:
+				break;
+			}
+
+			/* write image file */
+			fd2 = open(filename, O_RDWR|O_CREAT|O_TRUNC, 0644);
+			if (fd2 == -1)
+				goto error;
+			n2 = write(fd2, img, img_len);
+			if (n2 == -1)
+				goto error;
+			printf("Saving image to '%s'.\n\n", filename);
+			close(fd2);
+
+			/* shutdown device */
+			close(fd1);
+			sleep(WAIT_STOP);	/* let device stop */
+		}
+	}
+error:
+	if (buf != NULL) {
+		free(buf);
+		buf = NULL;
+	}
+	if (img != NULL) {
+		free(img);
+		img = NULL;
+	}
+	close(fd1);
+
+	printf("\n");
+
+	return (-1);
+}
+
+int
+test_capture_read(int fd, char *buf, int buf_size, int use_poll)
+{
+	ssize_t		n1;
+	int		i, r;
+	struct pollfd	pfds[1];
+
+	n1 = 0;
+
+	/*
+	 * Read frame data.
+	 *
+	 * Some devices need a while until they start
+	 * sending a sane image.  Therefore skip the
+	 * first few frames.
+	 */
+	printf("Reading frame data ... ");
+
+	for (i = 0; i < 3; i++) {
+		if (use_poll) {
+			pfds[0].fd = fd;
+			pfds[0].events = POLLIN;
+
+			r = poll(pfds, 1, POLL_TIMEOUT);
+			if (r == -1)
+				return (-1);
+			if (r == 0) {
+				printf("poll timeout (%d seconds)!\n",
+				    POLL_TIMEOUT / 1000);
+				continue;
+			}
+		}
+
+		n1 = read(fd, buf, buf_size);
+		if (n1 == -1)
+			return (-1);
+	}
+	printf("%ld bytes read.\n", n1);
+
+	return (n1);
+}
+
+int
+test_capture_mmap(int fd, char *buf, int buf_size, int use_poll)
+{
+	int				 i, r, type;
+	struct v4l2_requestbuffers	 reqbufs;
+	struct v4l2_buffer		 buffer;
+	struct frame_buffer		 fbuffer[MMAP_QUEUE_NR];
+	struct pollfd			 pfds[1];
+
+	/* request buffers */
+	memset(&reqbufs, 0, sizeof(struct v4l2_requestbuffers));
+	reqbufs.count = MMAP_QUEUE_NR;
+	reqbufs.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+	reqbufs.memory = V4L2_MEMORY_MMAP;
+	r = ioctl(fd, VIDIOC_REQBUFS, &reqbufs);
+	if (r == -1)
+		return (-1);
+
+	/* map the buffers */
+	for (i = 0; i < MMAP_QUEUE_NR; i++) {
+		memset(&buffer, 0, sizeof(struct v4l2_buffer));
+		buffer.index = i;
+		buffer.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+		buffer.memory = V4L2_MEMORY_MMAP;
+		r = ioctl(fd, VIDIOC_QUERYBUF, &buffer);
+		if (r == -1)
+			return (-1);
+
+		fbuffer[i].buf =
+		    mmap(0, buffer.length, PROT_READ, MAP_SHARED, fd,
+		        buffer.m.offset);
+		if (fbuffer[i].buf == MAP_FAILED)
+			return (-1);
+		fbuffer[i].len = buffer.length;
+	}
+
+	/* queue the buffers */
+	for (i = 0; i < MMAP_QUEUE_NR; i++) {
+		memset(&buffer, 0, sizeof(struct v4l2_buffer));
+		buffer.index = i;
+		buffer.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+		buffer.memory = V4L2_MEMORY_MMAP;
+		r = ioctl(fd, VIDIOC_QBUF, &buffer);
+		if (r == -1)
+			return (-1);
+	}
+
+	/* turn on stream */
+	type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+	r = ioctl(fd, VIDIOC_STREAMON, &type);
+	if (r == -1)
+		return (-1);
+
+	/* dequeue buffers */
+	printf("Dequeue frame data ... ");
+
+	for (i = 0; i < MMAP_QUEUE_NR; i++) {
+		if (use_poll) {
+			pfds[0].fd = fd;
+			pfds[0].events = POLLIN;
+
+			r = poll(pfds, 1, POLL_TIMEOUT);
+			if (r == -1)
+				return (-1);
+			if (r == 0) {
+				printf("poll timeout (%d seconds)!\n",
+				    POLL_TIMEOUT / 1000);
+				return (-1);
+			}
+		}
+
+		memset(&buffer, 0, sizeof(struct v4l2_buffer));
+		buffer.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+		buffer.memory = V4L2_MEMORY_MMAP;
+		r = ioctl(fd, VIDIOC_DQBUF, &buffer);
+		if (r == -1)
+			return (-1);
+	}
+	printf("%d bytes dequeued.\n", buffer.bytesused);
+	memcpy(buf, fbuffer[buffer.index].buf, buffer.bytesused);
+
+	/* turn off stream */
+	type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+	r = ioctl(fd, VIDIOC_STREAMOFF, &type);
+	if (r == -1)
+		return (-1);
+
+	/* unmap buffers */
+	for (i = 0; i < MMAP_QUEUE_NR; i++) {
+		r = munmap(fbuffer[i].buf, fbuffer[i].len);
+		if (r == -1)
+			return (-1);
+	}
+
+	return (buffer.bytesused);
+}
+
+void
+jpeg_insert_dht(uint8_t *src, int src_len, uint8_t *dst, int *dst_len)
+{
+	int	 i;
+	uint8_t	*p;
+
+	static unsigned char dht[] = {
+	    0xff, 0xc4, 0x01, 0xa2, 0x00, 0x00, 0x01, 0x05, 0x01, 0x01,
+	    0x01, 0x01, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+	    0x00, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08,
+	    0x09, 0x0a, 0x0b, 0x10, 0x00, 0x02, 0x01, 0x03, 0x03, 0x02,
+	    0x04, 0x03, 0x05, 0x05, 0x04, 0x04, 0x00, 0x00, 0x01, 0x7d,
+	    0x01, 0x02, 0x03, 0x00, 0x04, 0x11, 0x05, 0x12, 0x21, 0x31,
+	    0x41, 0x06, 0x13, 0x51, 0x61, 0x07, 0x22, 0x71, 0x14, 0x32,
+	    0x81, 0x91, 0xa1, 0x08, 0x23, 0x42, 0xb1, 0xc1, 0x15, 0x52,
+	    0xd1, 0xf0, 0x24, 0x33, 0x62, 0x72, 0x82, 0x09, 0x0a, 0x16,
+	    0x17, 0x18, 0x19, 0x1a, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2a,
+	    0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3a, 0x43, 0x44, 0x45,
+	    0x46, 0x47, 0x48, 0x49, 0x4a, 0x53, 0x54, 0x55, 0x56, 0x57,
+	    0x58, 0x59, 0x5a, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69,
+	    0x6a, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7a, 0x83,
+	    0x84, 0x85, 0x86, 0x87, 0x88, 0x89, 0x8a, 0x92, 0x93, 0x94,
+	    0x95, 0x96, 0x97, 0x98, 0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5,
+	    0xa6, 0xa7, 0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4, 0xb5, 0xb6,
+	    0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3, 0xc4, 0xc5, 0xc6, 0xc7,
+	    0xc8, 0xc9, 0xca, 0xd2, 0xd3, 0xd4, 0xd5, 0xd6, 0xd7, 0xd8,
+	    0xd9, 0xda, 0xe1, 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8,
+	    0xe9, 0xea, 0xf1, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8,
+	    0xf9, 0xfa, 0x01, 0x00, 0x03, 0x01, 0x01, 0x01, 0x01, 0x01,
+	    0x01, 0x01, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+	    0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a,
+	    0x0b, 0x11, 0x00, 0x02, 0x01, 0x02, 0x04, 0x04, 0x03, 0x04,
+	    0x07, 0x05, 0x04, 0x04, 0x00, 0x01, 0x02, 0x77, 0x00, 0x01,
+	    0x02, 0x03, 0x11, 0x04, 0x05, 0x21, 0x31, 0x06, 0x12, 0x41,
+	    0x51, 0x07, 0x61, 0x71, 0x13, 0x22, 0x32, 0x81, 0x08, 0x14,
+	    0x42, 0x91, 0xa1, 0xb1, 0xc1, 0x09, 0x23, 0x33, 0x52, 0xf0,
+	    0x15, 0x62, 0x72, 0xd1, 0x0a, 0x16, 0x24, 0x34, 0xe1, 0x25,
+	    0xf1, 0x17, 0x18, 0x19, 0x1a, 0x26, 0x27, 0x28, 0x29, 0x2a,
+	    0x35, 0x36, 0x37, 0x38, 0x39, 0x3a, 0x43, 0x44, 0x45, 0x46,
+	    0x47, 0x48, 0x49, 0x4a, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58,
+	    0x59, 0x5a, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69, 0x6a,
+	    0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7a, 0x82, 0x83,
+	    0x84, 0x85, 0x86, 0x87, 0x88, 0x89, 0x8a, 0x92, 0x93, 0x94,
+	    0x95, 0x96, 0x97, 0x98, 0x99, 0x9a, 0xa2, 0xa3, 0xa4, 0xa5,
+	    0xa6, 0xa7, 0xa8, 0xa9, 0xaa, 0xb2, 0xb3, 0xb4, 0xb5, 0xb6,
+	    0xb7, 0xb8, 0xb9, 0xba, 0xc2, 0xc3, 0xc4, 0xc5, 0xc6, 0xc7,
+	    0xc8, 0xc9, 0xca, 0xd2, 0xd3, 0xd4, 0xd5, 0xd6, 0xd7, 0xd8,
+	    0xd9, 0xda, 0xe2, 0xe3, 0xe4, 0xe5, 0xe6, 0xe7, 0xe8, 0xe9,
+	    0xea, 0xf2, 0xf3, 0xf4, 0xf5, 0xf6, 0xf7, 0xf8, 0xf9, 0xfa
+	};
+
+	p = src;
+	for (i = 0; i < src_len; i++, p++) {
+		if (*p != 0xff)
+			continue;
+
+		p++;
+		if (*p == 0xda)
+			break;
+		else
+			i++;
+	}
+
+	memcpy(dst, src, i);
+	dst += i;
+	memcpy(dst, dht, sizeof(dht));
+	dst += sizeof(dht);
+	src += i;
+	memcpy(dst, src, src_len - i);
+
+	*dst_len = src_len + sizeof(dht);
+}
+
+char *
+print_pixelformat(uint32_t pixelformat, int lowercase)
+{
+	static char	pformat[8];
+
+	memset(pformat, 0, sizeof(pformat));
+
+	switch (pixelformat) {
+	case V4L2_PIX_FMT_MJPEG:
+		if (lowercase)
+			memcpy(pformat, "mjpeg", 5);
+		else
+			memcpy(pformat, "MJPEG", 5);
+		break;
+	case V4L2_PIX_FMT_YUYV:
+		if (lowercase)
+			memcpy(pformat, "yuyv", 4);
+		else
+			memcpy(pformat, "YUYV", 4);
+		break;
+	default:
+		memcpy(pformat, "unknown", 7);
+		break;
+	}
+
+	return (pformat);
+}