merge: http://linuxtv.org/hg/~mkrufky/lgdt330x

From: Mauro Carvalho Chehab <mchehab@infradead.org>

Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>

1 files changed, 577 insertions, 0 deletions

diff --git a/v4l2-apps/lib/v4l2_driver.c b/v4l2-apps/lib/v4l2_driver.c
new file mode 100644
index 000000000..e656a550d
--- /dev/null
+++ b/v4l2-apps/lib/v4l2_driver.c
@@ -0,0 +1,577 @@
+/*
+   Copyright (C) 2006 Mauro Carvalho Chehab <mchehab@infradead.org>
+
+   The GNU C Library is free software; you can redistribute it and/or
+   modify it under the terms of the GNU Lesser General Public
+   License as published by the Free Software Foundation; either
+   version 2.1 of the License, or (at your option) any later version.
+
+   The GNU C Library is distributed in the hope that it will be useful,
+   but WITHOUT ANY WARRANTY; without even the implied warranty of
+   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+   Lesser General Public License for more details.
+  */
+
+#include <assert.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <malloc.h>
+#include <stdio.h>
+#include <string.h>
+#include <unistd.h>
+#include <sys/ioctl.h>
+#include <sys/mman.h>
+#include <sys/stat.h>
+#include <sys/types.h>
+
+#include "v4l2_driver.h"
+
+/****************************************************************************
+	Auxiliary routines
+ ****************************************************************************/
+static void free_list(struct drv_list **list_ptr)
+{
+	struct drv_list *prev,*cur;
+
+	if (list_ptr==NULL)
+		return;
+
+	prev=*list_ptr;
+	if (prev==NULL)
+		return;
+
+	do {
+		cur=prev->next;
+		if (prev->curr)
+			free (prev->curr);	// Free data
+		free (prev);			// Free list
+		prev=cur;
+	} while (prev);
+
+	*list_ptr=NULL;
+}
+
+/****************************************************************************
+	Auxiliary Arrays to aid debug messages
+ ****************************************************************************/
+char *v4l2_field_names[] = {
+	[V4L2_FIELD_ANY]        = "any",
+	[V4L2_FIELD_NONE]       = "none",
+	[V4L2_FIELD_TOP]        = "top",
+	[V4L2_FIELD_BOTTOM]     = "bottom",
+	[V4L2_FIELD_INTERLACED] = "interlaced",
+	[V4L2_FIELD_SEQ_TB]     = "seq-tb",
+	[V4L2_FIELD_SEQ_BT]     = "seq-bt",
+	[V4L2_FIELD_ALTERNATE]  = "alternate",
+};
+
+char *v4l2_type_names[] = {
+	[V4L2_BUF_TYPE_VIDEO_CAPTURE]      = "video-cap",
+	[V4L2_BUF_TYPE_VIDEO_OVERLAY]      = "video-over",
+	[V4L2_BUF_TYPE_VIDEO_OUTPUT]       = "video-out",
+	[V4L2_BUF_TYPE_VBI_CAPTURE]        = "vbi-cap",
+	[V4L2_BUF_TYPE_VBI_OUTPUT]         = "vbi-out",
+	[V4L2_BUF_TYPE_SLICED_VBI_CAPTURE] = "sliced-vbi-cap",
+	[V4L2_BUF_TYPE_SLICED_VBI_OUTPUT]  = "slicec-vbi-out",
+};
+
+static char *v4l2_memory_names[] = {
+	[V4L2_MEMORY_MMAP]    = "mmap",
+	[V4L2_MEMORY_USERPTR] = "userptr",
+	[V4L2_MEMORY_OVERLAY] = "overlay",
+};
+
+#define ARRAY_SIZE(arr) (sizeof(arr)/sizeof(*arr))
+#define prt_names(a,arr) (((a)<ARRAY_SIZE(arr))?arr[a]:"unknown")
+
+char *prt_caps(uint32_t caps)
+{
+	static char s[4096]="";
+
+	if (V4L2_CAP_VIDEO_CAPTURE & caps)
+		strcat (s,"CAPTURE ");
+	if (V4L2_CAP_VIDEO_OUTPUT & caps)
+		strcat (s,"OUTPUT ");
+	if (V4L2_CAP_VIDEO_OVERLAY & caps)
+		strcat (s,"OVERLAY ");
+	if (V4L2_CAP_VBI_CAPTURE & caps)
+		strcat (s,"VBI_CAPTURE ");
+	if (V4L2_CAP_VBI_OUTPUT & caps)
+		strcat (s,"VBI_OUTPUT ");
+	if (V4L2_CAP_SLICED_VBI_CAPTURE & caps)
+		strcat (s,"SLICED_VBI_CAPTURE ");
+	if (V4L2_CAP_SLICED_VBI_OUTPUT & caps)
+		strcat (s,"SLICED_VBI_OUTPUT ");
+	if (V4L2_CAP_RDS_CAPTURE & caps)
+		strcat (s,"RDS_CAPTURE ");
+	if (V4L2_CAP_TUNER & caps)
+		strcat (s,"TUNER ");
+	if (V4L2_CAP_AUDIO & caps)
+		strcat (s,"AUDIO ");
+	if (V4L2_CAP_RADIO & caps)
+		strcat (s,"RADIO ");
+	if (V4L2_CAP_READWRITE & caps)
+		strcat (s,"READWRITE ");
+	if (V4L2_CAP_ASYNCIO & caps)
+		strcat (s,"ASYNCIO ");
+	if (V4L2_CAP_STREAMING & caps)
+		strcat (s,"STREAMING ");
+
+	return s;
+}
+/****************************************************************************
+	Open/Close V4L2 devices
+ ****************************************************************************/
+int v4l2_open (char *device, int debug, struct v4l2_driver *drv)
+{
+	int ret;
+
+	memset(drv,0,sizeof(*drv));
+
+	drv->debug=debug;
+
+	if ((drv->fd = open(device, O_RDONLY)) < 0) {
+		perror("Couldn't open video0");
+		return(errno);
+	}
+
+	ret=ioctl(drv->fd,VIDIOC_QUERYCAP,(void *) &drv->cap);
+	if (ret>=0 && drv->debug) {
+		printf ("driver=%s, card=%s, bus=%s, version=%d.%d.%d, "
+			"capabilities=%s\n",
+			drv->cap.driver,drv->cap.card,drv->cap.bus_info,
+			(drv->cap.version >> 16) & 0xff,
+			(drv->cap.version >>  8) & 0xff,
+			drv->cap.version         & 0xff,
+			prt_caps(drv->cap.capabilities));
+
+
+	}
+	return ret;
+}
+
+int v4l2_close (struct v4l2_driver *drv)
+{
+	free_list(&drv->stds);
+	free_list(&drv->inputs);
+	free_list(&drv->fmt_caps);
+
+	return (close(drv->fd));
+}
+
+/****************************************************************************
+	V4L2 Eumberations
+ ****************************************************************************/
+int v4l2_enum_stds (struct v4l2_driver *drv)
+{
+	struct v4l2_standard	*p=NULL;
+	struct drv_list		*list;
+	int			ok=0,ret,i;
+	v4l2_std_id		id;
+
+	free_list(&drv->stds);
+
+	list=drv->stds=calloc(1,sizeof(drv->stds));
+	assert (list!=NULL);
+
+	for (i=0; ok==0; i++) {
+		p=calloc(1,sizeof(*p));
+		assert (p);
+
+		p->index=i;
+		ok=ioctl(drv->fd,VIDIOC_ENUMSTD,p);
+		if (ok<0) {
+			ok=errno;
+			free(p);
+			break;
+		}
+		if (drv->debug) {
+			printf ("STANDARD: index=%d, id=0x%08x, name=%s, fps=%.3f, "
+				"framelines=%d\n", p->index,
+				(unsigned int)p->id, p->name,
+				1.*p->frameperiod.denominator/p->frameperiod.numerator,
+				p->framelines);
+		}
+		if (list->curr) {
+			list->next=calloc(1,sizeof(*list->next));
+			list=list->next;
+			assert (list!=NULL);
+		}
+		list->curr=p;
+	}
+	if (i>0 && ok==-EINVAL)
+		return 0;
+
+	return ok;
+}
+
+int v4l2_enum_input (struct v4l2_driver *drv)
+{
+	struct v4l2_input	*p=NULL;
+	struct drv_list		*list;
+	int			ok=0,ret,i;
+	v4l2_std_id		id;
+
+	free_list(&drv->inputs);
+
+	list=drv->inputs=calloc(1,sizeof(drv->inputs));
+	assert (list!=NULL);
+
+	for (i=0; ok==0; i++) {
+		p=calloc(1,sizeof(*p));
+		assert (p);
+		p->index=i;
+		ok=ioctl(drv->fd,VIDIOC_ENUMINPUT,p);
+		if (ok<0) {
+			ok=errno;
+			free(p);
+			break;
+		}
+		if (drv->debug) {
+			printf ("INPUT: index=%d, name=%s, type=%d, audioset=%d, "
+				"tuner=%d, std=%08x, status=%d\n",
+				p->index,p->name,p->type,p->audioset, p->tuner,
+				(unsigned int)p->std, p->status);
+		}
+		if (list->curr) {
+			list->next=calloc(1,sizeof(*list->next));
+			list=list->next;
+			assert (list!=NULL);
+		}
+		list->curr=p;
+	}
+	if (i>0 && ok==-EINVAL)
+		return 0;
+	return ok;
+}
+
+int v4l2_enum_fmt (struct v4l2_driver *drv, enum v4l2_buf_type type)
+{
+	struct v4l2_fmtdesc 	*p=NULL;
+	struct v4l2_format	fmt;
+	struct drv_list		*list;
+	int			ok=0,ret,i;
+	v4l2_std_id		id;
+
+	free_list(&drv->fmt_caps);
+
+	list=drv->fmt_caps=calloc(1,sizeof(drv->fmt_caps));
+	assert (list!=NULL);
+
+	for (i=0; ok==0; i++) {
+		p=calloc(1,sizeof(*p));
+		assert (p!=NULL);
+
+		p->index=i;
+		p->type =type;
+
+		ok=ioctl(drv->fd,VIDIOC_ENUM_FMT,p);
+		if (ok<0) {
+			ok=errno;
+			free(p);
+			break;
+		}
+		if (drv->debug) {
+			printf ("FORMAT: index=%d, type=%d, flags=%d, description=%s\n\t"
+				"pixelformat=0x%08x\n",
+				p->index, p->type, p->flags,p->description,
+				p->pixelformat);
+		}
+		if (list->curr) {
+			list->next=calloc(1,sizeof(*list->next));
+			list=list->next;
+			assert (list!=NULL);
+		}
+		list->curr=p;
+	}
+	if (i>0 && ok==-EINVAL)
+		return 0;
+	return ok;
+}
+
+/****************************************************************************
+	Set routines - currently, it also checks results with Get
+ ****************************************************************************/
+int v4l2_setget_std (struct v4l2_driver *drv, enum v4l2_direction dir, v4l2_std_id *id)
+{
+	v4l2_std_id		s_id=*id;
+	int			ret=0;
+	char			s[256];
+
+	if (dir & V4L2_SET) {
+		ret=ioctl(drv->fd,VIDIOC_S_STD,&s_id);
+		if (ret<0) {
+			ret=errno;
+
+			sprintf (s,"while trying to set STD to %08x",
+								(unsigned int) *id);
+			perror(s);
+		}
+	}
+
+	if (dir & V4L2_GET) {
+		ret=ioctl(drv->fd,VIDIOC_G_STD,&s_id);
+		if (ret<0) {
+			ret=errno;
+			perror ("while trying to get STD id");
+		}
+	}
+
+	if (dir == V4L2_SET_GET) {
+		if (*id & s_id) {
+			if (*id != s_id) {
+				printf ("Warning: Received a std subset (%08x"
+					" std) while trying to adjust to %08x\n",
+					(unsigned int) s_id,(unsigned int) *id);
+			}
+		} else {
+			fprintf (stderr,"Error: Received %08x std while trying"
+				" to adjust to %08x\n",
+				(unsigned int) s_id,(unsigned int) *id);
+		}
+	}
+	return ret;
+}
+
+int v4l2_setget_input (struct v4l2_driver *drv, enum v4l2_direction dir, struct v4l2_input *input)
+{
+	int			ok=0,ret,i;
+	unsigned int		inp=input->index;
+	char			s[256];
+
+	if (dir & V4L2_SET) {
+		ret=ioctl(drv->fd,VIDIOC_S_INPUT,input);
+		if (ret<0) {
+			ret=errno;
+			sprintf (s,"while trying to set INPUT to %d\n", inp);
+			perror(s);
+		}
+	}
+
+	if (dir & V4L2_GET) {
+		ret=ioctl(drv->fd,VIDIOC_G_INPUT,input);
+		if (ret<0) {
+			perror ("while trying to get INPUT id\n");
+		}
+	}
+
+	if (dir & V4L2_SET_GET) {
+		if (input->index != inp) {
+			printf ("Input is different than expected (received %i, set %i)\n",
+						inp, input->index);
+		}
+	}
+
+	return ok;
+}
+
+int v4l2_gettryset_fmt_cap (struct v4l2_driver *drv, enum v4l2_direction dir,
+		      struct v4l2_format *fmt,uint32_t width, uint32_t height,
+		      uint32_t pixelformat, enum v4l2_field field)
+{
+	struct v4l2_pix_format  *pix=&(fmt->fmt.pix);
+	int			ret=0;
+
+	fmt->type=V4L2_BUF_TYPE_VIDEO_CAPTURE;
+	if (dir == V4L2_GET) {
+		ret=ioctl(drv->fd,VIDIOC_G_FMT,fmt);
+		if (ret < 0) {
+			ret=errno;
+			perror("VIDIOC_G_FMT failed\n");
+		}
+		return ret;
+	} else if (dir & (~(V4L2_TRY|V4L2_SET)) ) {
+		perror ("Invalid direction\n");
+		return EINVAL;
+	}
+
+	if (dir & (V4L2_TRY|V4L2_SET)) {
+		pix->width       = width;
+		pix->height      = height;
+		pix->pixelformat = pixelformat;
+		pix->field       = field;
+	/*
+		enum v4l2_colorspace	colorspace;
+	*/
+
+		if (dir & V4L2_TRY) {
+			ret=ioctl(drv->fd,VIDIOC_TRY_FMT,fmt);
+			if (ret < 0) {
+				perror("VIDIOC_TRY_FMT failed\n");
+			}
+		}
+
+		if (dir & V4L2_SET) {
+			ret=ioctl(drv->fd,VIDIOC_S_FMT,fmt);
+			if (ret < 0) {
+				perror("VIDIOC_S_FMT failed\n");
+			}
+			drv->sizeimage=pix->sizeimage;
+		}
+
+		if (pix->pixelformat != pixelformat) {
+			fprintf(stderr,"Error: asked for format %d, received %d",pixelformat,
+				pix->pixelformat);
+		}
+
+		if (pix->width != width) {
+			fprintf(stderr,"Error: asked for format %d, received %d\n",width,
+				pix->width);
+		}
+
+		if (pix->height != height) {
+			fprintf(stderr,"Error: asked for format %d, received %d\n",height,
+				pix->height);
+		}
+
+		if (pix->bytesperline == 0 ) {
+			fprintf(stderr,"Error: bytesperline = 0\n");
+		}
+
+		if (pix->sizeimage == 0 ) {
+			fprintf(stderr,"Error: sizeimage = 0\n");
+		}
+	}
+
+	if (drv->debug)
+		printf( "FMT SET: %dx%d, fourcc=%c%c%c%c, %d bytes/line,"
+			" %d bytes/frame, colorspace=0x%08x\n",
+			pix->width,pix->height,
+			pix->pixelformat & 0xff,
+			(pix->pixelformat >>  8) & 0xff,
+			(pix->pixelformat >> 16) & 0xff,
+			(pix->pixelformat >> 24) & 0xff,
+			pix->bytesperline,
+			pix->sizeimage,
+			pix->colorspace);
+
+	return 0;
+}
+
+/****************************************************************************
+	Get routines
+ ****************************************************************************/
+int v4l2_get_parm (struct v4l2_driver *drv)
+{
+	int ret;
+	struct v4l2_captureparm *c;
+
+	drv->parm.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+	if ((ret=ioctl(drv->fd,VIDIOC_G_PARM,&drv->parm))>=0) {
+		c=&drv->parm.parm.capture;
+		printf ("PARM: capability=%d, capturemode=%d, frame time =%.3f ns "
+			"ext=%x, readbuf=%d\n",
+			c->capability,
+			c->capturemode,
+			100.*c->timeperframe.numerator/c->timeperframe.denominator,
+			c->extendedmode, c->readbuffers);
+	} else {
+		ret=errno;
+
+		perror ("VIDIOC_G_PARM");
+	}
+
+	return ret;
+}
+
+/****************************************************************************
+	Queue Control
+ ****************************************************************************/
+
+int v4l2_mmap_bufs(struct v4l2_driver *drv, unsigned int num_buffers)
+{
+	uint32_t	i;
+
+	if (drv->sizeimage==0) {
+		fprintf(stderr,"Image size is zero! Can't proceed\n");
+		return -1;
+	}
+	/* Requests the specified number of buffers */
+	drv->reqbuf.count  = num_buffers;
+	drv->reqbuf.type   = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+	drv->reqbuf.memory = V4L2_MEMORY_MMAP;
+
+	if (ioctl(drv->fd,VIDIOC_REQBUFS,&drv->reqbuf)<0) {
+		perror("reqbufs");
+		return errno;
+	}
+
+	if (drv->debug)
+		printf ("REQBUFS: count=%d, type=%s, memory=%s\n",
+				drv->reqbuf.count,
+				prt_names(drv->reqbuf.type,v4l2_type_names),
+				prt_names(drv->reqbuf.memory,v4l2_memory_names));
+
+	/* Frees previous allocations, if required */
+	if (drv->v4l2_bufs)
+		free(drv->v4l2_bufs);
+	if (drv->bufs)
+		free(drv->bufs);
+
+	/* Allocates the required number of buffers */
+	drv->v4l2_bufs=calloc(drv->reqbuf.count, sizeof(drv->v4l2_bufs));
+	assert(drv->v4l2_bufs!=NULL);
+	drv->bufs=calloc(drv->reqbuf.count, drv->sizeimage);
+	assert(drv->bufs);
+
+	for (i = 0; i < drv->reqbuf.count; i++) {
+		struct v4l2_buffer *p=drv->v4l2_bufs[i];
+		struct v4l2_timecode *tc;
+
+		/* Requests kernel buffers to be mmapped */
+		p=calloc(1,sizeof(*p));
+		assert (p!=NULL);
+		p->index  = i;
+		p->type   = drv->reqbuf.type;
+		p->memory = V4L2_MEMORY_MMAP;
+		if (ioctl(drv->fd,VIDIOC_QUERYBUF,p)<0) {
+			int ret=errno;
+			perror("querybuf");
+
+			free(drv->v4l2_bufs);
+			free(drv->bufs);
+
+			drv->v4l2_bufs=NULL;
+			drv->bufs=NULL;
+			return ret;
+		}
+
+		if (drv->debug) {
+			printf ("QUERYBUF: %02ld:%02d:%02d.%08ld index=%d, type=%s, "
+				"bytesused=%d, flags=0x%08x, "
+				"field=%s, sequence=%d, memory=%s, offset=0x%08x\n",
+				(p->timestamp.tv_sec/3600),
+				(int)(p->timestamp.tv_sec/60)%60,
+				(int)(p->timestamp.tv_sec%60),
+				p->timestamp.tv_usec,
+				p->index,
+				prt_names(p->type,v4l2_type_names),
+				p->bytesused,p->flags,
+				prt_names(p->field,v4l2_field_names),
+				p->sequence,
+				prt_names(p->memory,v4l2_memory_names),
+				p->m.offset);
+			tc=&p->timecode;
+			printf ("TIMECODE: %02d:%02d:%02d type=%d, "
+				"flags=0x%08x, frames=%d, userbits=0x%08x\n",
+				tc->hours,tc->minutes,tc->seconds,
+				tc->type, tc->flags, tc->frames, *(uint32_t *) tc->userbits);
+		}
+
+printf("offset=0x%08x\n",p->m.offset);
+		drv->bufs[i].length = drv->sizeimage;
+		drv->bufs[i].start = mmap(NULL, drv->bufs[i].length, PROT_READ | PROT_WRITE,
+						MAP_SHARED, drv->fd, p->m.offset);
+		if (MAP_FAILED == drv->bufs) {
+			perror("mmap");
+
+//			free(drv->v4l2_bufs);
+//			free(drv->bufs);
+
+//			drv->v4l2_bufs=NULL;
+//			drv->bufs=NULL;
+			return errno;
+		}
+	}
+	return 0;
+}