Message-ID: <4C89F248.5000800@pelagicore.com>
Date:	Fri, 10 Sep 2010 10:54:32 +0200
From:	Richard Röjfors 
	<richard.rojfors@...agicore.com>
To:	Mauro Carvalho Chehab <mchehab@...hat.com>
CC:	Linux Media Mailing List <linux-media@...r.kernel.org>,
	Linux Kernel Mailing List <linux-kernel@...r.kernel.org>,
	Douglas Schilling Landgraf <dougsland@...il.com>,
	Samuel Ortiz <sameo@...ux.intel.com>,
	Andrew Morton <akpm@...ux-foundation.org>
Subject: Re: [RESEND][PATCH 1/2] media: Add timberdale video-in driver

Thanks for the feedback, I will post an updated patch. Comments below.


On 09/08/2010 09:35 PM, Mauro Carvalho Chehab wrote:
> Em 02-09-2010 08:56, Richard Röjfors escreveu:
>> This patch adds the timberdale video-in driver.
>>
>> The video IP of timberdale delivers the video data via DMA.
>> The driver uses the DMA api to handle DMA transfers, and make use
>> of the V4L2 video buffers to handle buffers against user space.
>>
>> If available the driver uses an encoder to get/set the video standard
>>
>> Signed-off-by: Richard Röjfors<richard.rojfors@...agicore.com>
>> ---
>> diff --git a/drivers/media/video/Kconfig b/drivers/media/video/Kconfig
>> index f6e4d04..1afbe26 100644
>> --- a/drivers/media/video/Kconfig
>> +++ b/drivers/media/video/Kconfig
>> @@ -734,6 +734,15 @@ config VIDEO_HEXIUM_GEMINI
>>   	  To compile this driver as a module, choose M here: the
>>   	  module will be called hexium_gemini.
>>
>> +config VIDEO_TIMBERDALE
>> +	tristate "Support for timberdale Video In/LogiWIN"
>> +	depends on VIDEO_V4L2&&  I2C
>> +	select TIMB_DMA
>> +	select VIDEO_ADV7180
>> +	select VIDEOBUF_DMA_CONTIG
>> +	---help---
>> +	Add support for the Video In peripherial of the timberdale FPGA.
>> +
>>   source "drivers/media/video/cx88/Kconfig"
>>
>>   source "drivers/media/video/cx23885/Kconfig"
>> diff --git a/drivers/media/video/Makefile b/drivers/media/video/Makefile
>> index 40f98fb..c93af35 100644
>> --- a/drivers/media/video/Makefile
>> +++ b/drivers/media/video/Makefile
>> @@ -109,6 +109,7 @@ obj-$(CONFIG_VIDEO_CPIA2) += cpia2/
>>   obj-$(CONFIG_VIDEO_MXB) += mxb.o
>>   obj-$(CONFIG_VIDEO_HEXIUM_ORION) += hexium_orion.o
>>   obj-$(CONFIG_VIDEO_HEXIUM_GEMINI) += hexium_gemini.o
>> +obj-$(CONFIG_VIDEO_TIMBERDALE)	+= timblogiw.o
>>
>>   obj-$(CONFIG_VIDEOBUF_GEN) += videobuf-core.o
>>   obj-$(CONFIG_VIDEOBUF_DMA_SG) += videobuf-dma-sg.o
>> diff --git a/drivers/media/video/timblogiw.c b/drivers/media/video/timblogiw.c
>> new file mode 100644
>> index 0000000..1ccc620
>> --- /dev/null
>> +++ b/drivers/media/video/timblogiw.c
>> @@ -0,0 +1,877 @@
>> +/*
>> + * timblogiw.c timberdale FPGA LogiWin Video In driver
>> + * Copyright (c) 2009-2010 Intel Corporation
>> + *
>> + * This program is free software; you can redistribute it and/or modify
>> + * it under the terms of the GNU General Public License version 2 as
>> + * published by the Free Software Foundation.
>> + *
>> + * This program 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 General Public License for more details.
>> + *
>> + * You should have received a copy of the GNU General Public License
>> + * along with this program; if not, write to the Free Software
>> + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
>> + */
>> +
>> +/* Supports:
>> + * Timberdale FPGA LogiWin Video In
>> + */
>> +
>> +#include<linux/version.h>
>> +#include<linux/platform_device.h>
>> +#include<linux/slab.h>
>> +#include<linux/dmaengine.h>
>> +#include<linux/scatterlist.h>
>> +#include<linux/interrupt.h>
>> +#include<linux/list.h>
>> +#include<linux/i2c.h>
>> +#include<media/v4l2-ioctl.h>
>> +#include<media/v4l2-device.h>
>> +#include<media/videobuf-dma-contig.h>
>> +#include<media/timb_video.h>
>> +
>> +#define DRIVER_NAME			"timb-video"
>> +
>> +#define TIMBLOGIWIN_NAME		"Timberdale Video-In"
>> +#define TIMBLOGIW_VERSION_CODE		0x04
>> +
>> +#define TIMBLOGIW_LINES_PER_DESC	44
>> +#define TIMBLOGIW_MAX_VIDEO_MEM		16
>> +
>> +#define TIMBLOGIW_VIDEO_FORMAT		V4L2_PIX_FMT_UYVY
>
> Hmm... why are you using a constant here? Does this device provide the standard UYVY fourcc
> format, or does it have a different (proprietary) format?

I will change to use the V4L2 define in the code instead of an own. The framegrabber follows the 
standard.

> If it uses the standard format, just use the standard definition. Otherwise, we need to add a
> new format to the V4L2 API, to make sure that userspace applications and libv4l will properly
> handle it.
>
>> +
>> +#define TIMBLOGIW_HAS_DECODER(lw)	(lw->pdata.encoder.module_name)
>> +
>> +
>> +struct timblogiw {
>> +	struct video_device		video_dev;
>> +	struct v4l2_device		v4l2_dev; /* mutual exclusion */
>> +	struct mutex			lock;
>> +	struct device			*dev;
>> +	struct timb_video_platform_data pdata;
>> +	struct v4l2_subdev		*sd_enc;	/* encoder */
>> +	bool				opened;
>> +};
>> +
>> +struct timblogiw_tvnorm {
>> +	v4l2_std_id std;
>> +	u16     width;
>> +	u16     height;
>> +	u8	fps;
>> +};
>> +
>> +struct timblogiw_fh {
>> +	struct videobuf_queue		vb_vidq;
>> +	struct timblogiw_tvnorm const	*cur_norm;
>> +	struct list_head		capture;
>> +	struct dma_chan			*chan;
>> +	spinlock_t			queue_lock; /* mutual exclusion */
>> +	unsigned int			frame_count;
>> +};
>> +
>> +struct timblogiw_buffer {
>> +	/* common v4l buffer stuff -- must be first */
>> +	struct videobuf_buffer	vb;
>> +	struct scatterlist	sg[16];
>> +	dma_cookie_t		cookie;
>> +	struct timblogiw_fh	*fh;
>> +};
>> +
>> +const struct timblogiw_tvnorm timblogiw_tvnorms[] = {
>> +	{
>> +		.std			= V4L2_STD_PAL,
>> +		.width			= 720,
>> +		.height			= 576,
>> +		.fps			= 25
>> +	},
>> +	{
>> +		.std			= V4L2_STD_NTSC,
>> +		.width			= 720,
>> +		.height			= 480,
>> +		.fps			= 26
>
> Hmm... 26? This sounds weird to me for a 60Hz video standard. It should be about 30fps.

You are right, it's weird. Should be 30!

>
>> +	}
>> +};
>> +
>> +static int timblogiw_bytes_per_line(const struct timblogiw_tvnorm *norm)
>> +{
>> +	return norm->width * 2;
>> +}
>> +
>> +
>> +static int timblogiw_frame_size(const struct timblogiw_tvnorm *norm)
>> +{
>> +	return norm->height * timblogiw_bytes_per_line(norm);
>> +}
>> +
>> +static const struct timblogiw_tvnorm *timblogiw_get_norm(const v4l2_std_id std)
>> +{
>> +	int i;
>> +	for (i = 0; i<  ARRAY_SIZE(timblogiw_tvnorms); i++)
>> +		if (timblogiw_tvnorms[i].std&  std)
>> +			return timblogiw_tvnorms + i;
>> +
>> +	/* default to first element */
>> +	return timblogiw_tvnorms;
>> +}
>> +
>> +static void timblogiw_dma_cb(void *data)
>> +{
>> +	struct timblogiw_buffer *buf = data;
>> +	struct timblogiw_fh *fh = buf->fh;
>> +	struct videobuf_buffer *vb =&buf->vb;
>> +
>> +	spin_lock(&fh->queue_lock);
>> +
>> +	/* mark the transfer done */
>> +	buf->cookie = -1;
>> +
>> +	fh->frame_count++;
>> +
>> +	if (vb->state != VIDEOBUF_ERROR) {
>> +		list_del(&vb->queue);
>> +		do_gettimeofday(&vb->ts);
>> +		vb->field_count = fh->frame_count * 2;
>> +		vb->state = VIDEOBUF_DONE;
>> +
>> +		wake_up(&vb->done);
>> +	}
>> +
>> +	if (!list_empty(&fh->capture)) {
>> +		vb = list_entry(fh->capture.next, struct videobuf_buffer,
>> +			queue);
>> +		vb->state = VIDEOBUF_ACTIVE;
>> +	}
>> +
>> +	spin_unlock(&fh->queue_lock);
>> +}
>> +
>> +static bool timblogiw_dma_filter_fn(struct dma_chan *chan, void *filter_param)
>> +{
>> +	return chan->chan_id == (int)filter_param;
>> +}
>> +
>> +/* IOCTL functions */
>> +
>> +static int timblogiw_g_fmt(struct file *file, void  *priv,
>> +	struct v4l2_format *format)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s entry\n", __func__);
>> +
>> +	if (format->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
>> +		return -EINVAL;
>> +
>> +	format->fmt.pix.width = fh->cur_norm->width;
>> +	format->fmt.pix.height = fh->cur_norm->height;
>> +	format->fmt.pix.pixelformat = TIMBLOGIW_VIDEO_FORMAT;
>> +	format->fmt.pix.bytesperline = timblogiw_bytes_per_line(fh->cur_norm);
>> +	format->fmt.pix.sizeimage = timblogiw_frame_size(fh->cur_norm);
>> +	format->fmt.pix.field = V4L2_FIELD_NONE;
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_try_fmt(struct file *file, void  *priv,
>> +	struct v4l2_format *format)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct v4l2_pix_format *pix =&format->fmt.pix;
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev,
>> +		"%s - width=%d, height=%d, pixelformat=%d, field=%d\n"
>> +		"bytes per line %d, size image: %d, colorspace: %d\n",
>> +		__func__,
>> +		pix->width, pix->height, pix->pixelformat, pix->field,
>> +		pix->bytesperline, pix->sizeimage, pix->colorspace);
>> +
>> +	if (format->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
>> +		return -EINVAL;
>> +
>> +	if (pix->field != V4L2_FIELD_NONE)
>> +		return -EINVAL;
>> +
>> +	if (pix->pixelformat != TIMBLOGIW_VIDEO_FORMAT)
>> +		return -EINVAL;
>> +
>> +	if ((fh->cur_norm->height != pix->height) ||
>> +		(fh->cur_norm->width != pix->width)) {
>> +		pix->width = fh->cur_norm->width;
>> +		pix->height = fh->cur_norm->height;
>> +	}
>> +
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_s_fmt(struct file *file, void  *priv,
>> +	struct v4l2_format *format)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +	int err;
>> +
>> +	err = timblogiw_try_fmt(file, priv, format);
>> +	if (err)
>> +		return err;
>> +
>> +	if (videobuf_queue_is_busy(&fh->vb_vidq)) {
>> +		dev_err(&vdev->dev, "%s queue busy\n", __func__);
>> +		return -EBUSY;
>> +	}
>> +
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_querycap(struct file *file, void  *priv,
>> +	struct v4l2_capability *cap)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +
>> +	dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);
>> +	memset(cap, 0, sizeof(*cap));
>> +	strncpy(cap->card, TIMBLOGIWIN_NAME, sizeof(cap->card)-1);
>> +	strncpy(cap->driver, DRIVER_NAME, sizeof(cap->card)-1);
>> +	strlcpy(cap->bus_info, vdev->name, sizeof(cap->bus_info));
>> +	cap->version = TIMBLOGIW_VERSION_CODE;
>> +	cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING |
>> +		V4L2_CAP_READWRITE;
>> +
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_enum_fmt(struct file *file, void  *priv,
>> +	struct v4l2_fmtdesc *fmt)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +
>> +	dev_dbg(&vdev->dev, "%s, index: %d\n",  __func__, fmt->index);
>> +
>> +	if (fmt->index != 0)
>> +		return -EINVAL;
>> +	memset(fmt, 0, sizeof(*fmt));
>> +	fmt->index = 0;
>> +	fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
>> +	strncpy(fmt->description, "4:2:2, packed, YUYV",
>> +		sizeof(fmt->description)-1);
>> +	fmt->pixelformat = TIMBLOGIW_VIDEO_FORMAT;
>> +
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_g_parm(struct file *file, void *priv,
>> +	struct v4l2_streamparm *sp)
>> +{
>> +	struct timblogiw_fh *fh = priv;
>> +	struct v4l2_captureparm *cp =&sp->parm.capture;
>> +
>> +	cp->capability = V4L2_CAP_TIMEPERFRAME;
>> +	cp->timeperframe.numerator = 1;
>> +	cp->timeperframe.denominator = fh->cur_norm->fps;
>> +
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_reqbufs(struct file *file, void  *priv,
>> +	struct v4l2_requestbuffers *rb)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	return videobuf_reqbufs(&fh->vb_vidq, rb);
>> +}
>> +
>> +static int timblogiw_querybuf(struct file *file, void  *priv,
>> +	struct v4l2_buffer *b)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	return videobuf_querybuf(&fh->vb_vidq, b);
>> +}
>> +
>> +static int timblogiw_qbuf(struct file *file, void  *priv, struct v4l2_buffer *b)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	return videobuf_qbuf(&fh->vb_vidq, b);
>> +}
>> +
>> +static int timblogiw_dqbuf(struct file *file, void  *priv,
>> +	struct v4l2_buffer *b)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	return videobuf_dqbuf(&fh->vb_vidq, b, file->f_flags&  O_NONBLOCK);
>> +}
>> +
>> +static int timblogiw_g_std(struct file *file, void  *priv, v4l2_std_id *std)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	*std = fh->cur_norm->std;
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_s_std(struct file *file, void  *priv, v4l2_std_id *std)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw *lw = video_get_drvdata(vdev);
>> +	struct timblogiw_fh *fh = priv;
>> +	int err = 0;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	if (TIMBLOGIW_HAS_DECODER(lw))
>> +		err = v4l2_subdev_call(lw->sd_enc, core, s_std, *std);
>> +
>> +	if (!err)
>> +		fh->cur_norm = timblogiw_get_norm(*std);
>> +
>> +	return err;
>> +}
>> +
>> +static int timblogiw_enuminput(struct file *file, void  *priv,
>> +	struct v4l2_input *inp)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +
>> +	dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);
>> +
>> +	if (inp->index != 0)
>> +		return -EINVAL;
>> +
>> +	memset(inp, 0, sizeof(*inp));
>> +	inp->index = 0;
>> +
>> +	strncpy(inp->name, "Timb input 1", sizeof(inp->name) - 1);
>> +	inp->type = V4L2_INPUT_TYPE_CAMERA;
>> +	inp->std = V4L2_STD_ALL;
>
> Hmm... there's something wrong here: You're enumerating all existing video
> formats, but you allow setting only a few PAL and one NTSC standard.
>
> If the device is for just camera devices, the better is to use
> V4L2_STD_525_60 instead of V4L2_STD_NTSC, and V4L2_STD_625_50 instead
> of V4L2_STD_PAL, at timblogiw_tvnorms[] array.

I will change it to logically or all standards in the tvnorms-array. which will reflect the 
standards in the template pointed out below.

>
> Is this device just for camera, or does it work with a video decoder?

It works with a video decoder, so there might be other sources than just camera

>
>> +
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_g_input(struct file *file, void  *priv,
>> +	unsigned int *input)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +
>> +	dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);
>> +
>> +	*input = 0;
>> +
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_s_input(struct file *file, void  *priv, unsigned int input)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +
>> +	dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);
>> +
>> +	if (input != 0)
>> +		return -EINVAL;
>> +	return 0;
>> +}
>> +
>> +static int timblogiw_streamon(struct file *file, void  *priv, unsigned int type)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
>> +		dev_dbg(&vdev->dev, "%s - No capture device\n", __func__);
>> +		return -EINVAL;
>> +	}
>> +
>> +	fh->frame_count = 0;
>> +	return videobuf_streamon(&fh->vb_vidq);
>> +}
>> +
>> +static int timblogiw_streamoff(struct file *file, void  *priv,
>> +	unsigned int type)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s entry\n",  __func__);
>> +
>> +	if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
>> +		return -EINVAL;
>> +
>> +	return videobuf_streamoff(&fh->vb_vidq);
>> +}
>> +
>> +static int timblogiw_querystd(struct file *file, void  *priv, v4l2_std_id *std)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw *lw = video_get_drvdata(vdev);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s entry\n",  __func__);
>> +
>> +	if (TIMBLOGIW_HAS_DECODER(lw))
>> +		return v4l2_subdev_call(lw->sd_enc, video, querystd, std);
>> +	else {
>> +		*std = fh->cur_norm->std;
>> +		return 0;
>> +	}
>> +}
>> +
>> +static int timblogiw_enum_framesizes(struct file *file, void  *priv,
>> +	struct v4l2_frmsizeenum *fsize)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = priv;
>> +
>> +	dev_dbg(&vdev->dev, "%s - index: %d, format: %d\n",  __func__,
>> +		fsize->index, fsize->pixel_format);
>> +
>> +	if ((fsize->index != 0) ||
>> +		(fsize->pixel_format != TIMBLOGIW_VIDEO_FORMAT))
>> +		return -EINVAL;
>> +
>> +	fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE;
>> +	fsize->discrete.width = fh->cur_norm->width;
>> +	fsize->discrete.height = fh->cur_norm->height;
>> +
>> +	return 0;
>> +}
>> +
>> +/* Video buffer functions */
>> +
>> +static int buffer_setup(struct videobuf_queue *vq, unsigned int *count,
>> +	unsigned int *size)
>> +{
>> +	struct timblogiw_fh *fh = vq->priv_data;
>> +
>> +	*size = timblogiw_frame_size(fh->cur_norm);
>> +
>> +	if (!*count)
>> +		*count = 32;
>> +
>> +	while (*size * *count>  TIMBLOGIW_MAX_VIDEO_MEM * 1024 * 1024)
>> +		(*count)--;
>> +
>> +	return 0;
>> +}
>> +
>> +static int buffer_prepare(struct videobuf_queue *vq, struct videobuf_buffer *vb,
>> +	enum v4l2_field field)
>> +{
>> +	struct timblogiw_fh *fh = vq->priv_data;
>> +	struct timblogiw_buffer *buf = container_of(vb, struct timblogiw_buffer,
>> +		vb);
>> +	unsigned int data_size = timblogiw_frame_size(fh->cur_norm);
>> +	int err = 0;
>> +
>> +	if (vb->baddr&&  vb->bsize<  data_size)
>> +		/* User provided buffer, but it is too small */
>> +		return -ENOMEM;
>> +
>> +	vb->size = data_size;
>> +	vb->width = fh->cur_norm->width;
>> +	vb->height = fh->cur_norm->height;
>> +	vb->field = field;
>> +
>> +	if (vb->state == VIDEOBUF_NEEDS_INIT) {
>> +		int i;
>> +		unsigned int size;
>> +		unsigned int bytes_per_desc = TIMBLOGIW_LINES_PER_DESC *
>> +			timblogiw_bytes_per_line(fh->cur_norm);
>> +		dma_addr_t addr;
>> +
>> +		sg_init_table(buf->sg, ARRAY_SIZE(buf->sg));
>> +
>> +		err = videobuf_iolock(vq, vb, NULL);
>> +		if (err)
>> +			goto err;
>> +
>> +		addr = videobuf_to_dma_contig(vb);
>> +		for (i = 0, size = 0; size<  data_size; i++) {
>> +			sg_dma_address(buf->sg + i) = addr + size;
>> +			size += bytes_per_desc;
>> +			sg_dma_len(buf->sg + i) = (size>  data_size) ?
>> +				(bytes_per_desc - (size - data_size)) :
>> +				bytes_per_desc;
>> +		}
>> +
>> +		vb->state = VIDEOBUF_PREPARED;
>> +		buf->cookie = -1;
>> +		buf->fh = fh;
>> +	}
>> +
>> +	return 0;
>> +
>> +err:
>> +	videobuf_dma_contig_free(vq, vb);
>> +	vb->state = VIDEOBUF_NEEDS_INIT;
>> +	return err;
>> +}
>> +
>> +static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb)
>> +{
>> +	struct timblogiw_fh *fh = vq->priv_data;
>> +	struct timblogiw_buffer *buf = container_of(vb, struct timblogiw_buffer,
>> +		vb);
>> +	struct dma_async_tx_descriptor *desc;
>> +	int sg_elems;
>> +	int bytes_per_desc = TIMBLOGIW_LINES_PER_DESC *
>> +		timblogiw_bytes_per_line(fh->cur_norm);
>> +
>> +	sg_elems = timblogiw_frame_size(fh->cur_norm) / bytes_per_desc;
>> +	sg_elems +=
>> +		(timblogiw_frame_size(fh->cur_norm) % bytes_per_desc) ? 1 : 0;
>> +
>> +	if (list_empty(&fh->capture))
>> +		vb->state = VIDEOBUF_ACTIVE;
>> +	else
>> +		vb->state = VIDEOBUF_QUEUED;
>> +
>> +	list_add_tail(&vb->queue,&fh->capture);
>> +
>> +	spin_unlock_irq(&fh->queue_lock);
>> +
>> +	desc = fh->chan->device->device_prep_slave_sg(fh->chan,
>> +		buf->sg, sg_elems, DMA_FROM_DEVICE,
>> +		DMA_PREP_INTERRUPT | DMA_COMPL_SKIP_SRC_UNMAP);
>> +	if (!desc) {
>> +		spin_lock_irq(&fh->queue_lock);
>> +		list_del_init(&vb->queue);
>> +		vb->state = VIDEOBUF_PREPARED;
>> +		return;
>> +	}
>> +
>> +	desc->callback_param = buf;
>> +	desc->callback = timblogiw_dma_cb;
>> +
>> +	buf->cookie = desc->tx_submit(desc);
>> +
>> +	spin_lock_irq(&fh->queue_lock);
>> +}
>> +
>> +static void buffer_release(struct videobuf_queue *vq,
>> +	struct videobuf_buffer *vb)
>> +{
>> +	struct timblogiw_fh *fh = vq->priv_data;
>> +	struct timblogiw_buffer *buf = container_of(vb, struct timblogiw_buffer,
>> +		vb);
>> +
>> +	videobuf_waiton(vb, 0, 0);
>> +	if (buf->cookie>= 0)
>> +		dma_sync_wait(fh->chan, buf->cookie);
>> +
>> +	videobuf_dma_contig_free(vq, vb);
>> +	vb->state = VIDEOBUF_NEEDS_INIT;
>> +}
>> +
>> +static struct videobuf_queue_ops timblogiw_video_qops = {
>> +	.buf_setup      = buffer_setup,
>> +	.buf_prepare    = buffer_prepare,
>> +	.buf_queue      = buffer_queue,
>> +	.buf_release    = buffer_release,
>> +};
>> +
>> +/* Device Operations functions */
>> +
>> +static int timblogiw_open(struct file *file)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw *lw = video_get_drvdata(vdev);
>> +	struct timblogiw_fh *fh;
>> +	v4l2_std_id std;
>> +	dma_cap_mask_t mask;
>> +	int err = 0;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n", __func__);
>> +
>> +	mutex_lock(&lw->lock);
>> +	if (lw->opened) {
>> +		err = -EBUSY;
>> +		goto out;
>> +	}
>> +
>> +	if (TIMBLOGIW_HAS_DECODER(lw)&&  !lw->sd_enc) {
>> +		struct i2c_adapter *adapt;
>> +
>> +		/* find the video decoder */
>> +		adapt = i2c_get_adapter(lw->pdata.i2c_adapter);
>> +		if (!adapt) {
>> +			dev_err(&vdev->dev, "No I2C bus #%d\n",
>> +				lw->pdata.i2c_adapter);
>> +			err = -ENODEV;
>> +			goto out;
>> +		}
>> +
>> +		/* now find the encoder */
>> +		lw->sd_enc = v4l2_i2c_new_subdev_board(&lw->v4l2_dev, adapt,
>> +			lw->pdata.encoder.module_name, lw->pdata.encoder.info,
>> +			NULL);
>> +
>> +		i2c_put_adapter(adapt);
>> +
>> +		if (!lw->sd_enc) {
>> +			dev_err(&vdev->dev, "Failed to get encoder: %s\n",
>> +				lw->pdata.encoder.module_name);
>> +			err = -ENODEV;
>> +			goto out;
>> +		}
>> +	}
>> +
>> +	fh = kzalloc(sizeof(*fh), GFP_KERNEL);
>> +	if (!fh) {
>> +		err = -ENOMEM;
>> +		goto out;
>> +	}
>> +
>> +	fh->cur_norm = timblogiw_tvnorms;
>> +	timblogiw_querystd(file, fh,&std);
>> +	fh->cur_norm = timblogiw_get_norm(std);
>> +
>> +	INIT_LIST_HEAD(&fh->capture);
>> +	spin_lock_init(&fh->queue_lock);
>> +
>> +	dma_cap_zero(mask);
>> +	dma_cap_set(DMA_SLAVE, mask);
>> +	dma_cap_set(DMA_PRIVATE, mask);
>> +
>> +	/* find the DMA channel */
>> +	fh->chan = dma_request_channel(mask, timblogiw_dma_filter_fn,
>> +			(void *)lw->pdata.dma_channel);
>> +	if (!fh->chan) {
>> +		dev_err(&vdev->dev, "Failed to get DMA channel\n");
>> +		kfree(fh);
>> +		err = -ENODEV;
>> +		goto out;
>> +	}
>> +
>> +	file->private_data = fh;
>> +	videobuf_queue_dma_contig_init(&fh->vb_vidq,&timblogiw_video_qops,
>> +		lw->dev,&fh->queue_lock, V4L2_BUF_TYPE_VIDEO_CAPTURE,
>> +		V4L2_FIELD_NONE, sizeof(struct timblogiw_buffer), fh);
>> +
>> +	lw->opened = true;
>> +out:
>> +	mutex_unlock(&lw->lock);
>> +
>> +	return err;
>> +}
>> +
>> +static int timblogiw_close(struct file *file)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw *lw = video_get_drvdata(vdev);
>> +	struct timblogiw_fh *fh = file->private_data;
>> +
>> +	dev_dbg(&vdev->dev, "%s: Entry\n",  __func__);
>> +
>> +	videobuf_stop(&fh->vb_vidq);
>> +	videobuf_mmap_free(&fh->vb_vidq);
>> +
>> +	dma_release_channel(fh->chan);
>> +
>> +	kfree(fh);
>> +
>> +	mutex_lock(&lw->lock);
>> +	lw->opened = false;
>> +	mutex_unlock(&lw->lock);
>> +	return 0;
>> +}
>> +
>> +static ssize_t timblogiw_read(struct file *file, char __user *data,
>> +	size_t count, loff_t *ppos)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = file->private_data;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	return videobuf_read_stream(&fh->vb_vidq, data, count, ppos, 0,
>> +		file->f_flags&  O_NONBLOCK);
>> +}
>> +
>> +static unsigned int timblogiw_poll(struct file *file,
>> +	struct poll_table_struct *wait)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = file->private_data;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n",  __func__);
>> +
>> +	return videobuf_poll_stream(file,&fh->vb_vidq, wait);
>> +}
>> +
>> +static int timblogiw_mmap(struct file *file, struct vm_area_struct *vma)
>> +{
>> +	struct video_device *vdev = video_devdata(file);
>> +	struct timblogiw_fh *fh = file->private_data;
>> +
>> +	dev_dbg(&vdev->dev, "%s: entry\n", __func__);
>> +
>> +	return videobuf_mmap_mapper(&fh->vb_vidq, vma);
>> +}
>> +
>> +/* Platform device functions */
>> +
>> +static const __devinitdata struct v4l2_ioctl_ops timblogiw_ioctl_ops = {
>> +	.vidioc_querycap		= timblogiw_querycap,
>> +	.vidioc_enum_fmt_vid_cap	= timblogiw_enum_fmt,
>> +	.vidioc_g_fmt_vid_cap		= timblogiw_g_fmt,
>> +	.vidioc_try_fmt_vid_cap		= timblogiw_try_fmt,
>> +	.vidioc_s_fmt_vid_cap		= timblogiw_s_fmt,
>> +	.vidioc_g_parm			= timblogiw_g_parm,
>> +	.vidioc_reqbufs			= timblogiw_reqbufs,
>> +	.vidioc_querybuf		= timblogiw_querybuf,
>> +	.vidioc_qbuf			= timblogiw_qbuf,
>> +	.vidioc_dqbuf			= timblogiw_dqbuf,
>> +	.vidioc_g_std			= timblogiw_g_std,
>> +	.vidioc_s_std			= timblogiw_s_std,
>> +	.vidioc_enum_input		= timblogiw_enuminput,
>> +	.vidioc_g_input			= timblogiw_g_input,
>> +	.vidioc_s_input			= timblogiw_s_input,
>> +	.vidioc_streamon		= timblogiw_streamon,
>> +	.vidioc_streamoff		= timblogiw_streamoff,
>> +	.vidioc_querystd		= timblogiw_querystd,
>> +	.vidioc_enum_framesizes		= timblogiw_enum_framesizes,
>> +};
>> +
>> +static const __devinitdata struct v4l2_file_operations timblogiw_fops = {
>> +	.owner		= THIS_MODULE,
>> +	.open		= timblogiw_open,
>> +	.release	= timblogiw_close,
>> +	.ioctl		= video_ioctl2, /* V4L2 ioctl handler */
>> +	.mmap		= timblogiw_mmap,
>> +	.read		= timblogiw_read,
>> +	.poll		= timblogiw_poll,
>> +};
>> +
>> +static const __devinitdata struct video_device timblogiw_template = {
>> +	.name		= TIMBLOGIWIN_NAME,
>> +	.fops		=&timblogiw_fops,
>> +	.ioctl_ops	=&timblogiw_ioctl_ops,
>> +	.release	= video_device_release_empty,
>> +	.minor		= -1,
>> +	.tvnorms	= V4L2_STD_PAL | V4L2_STD_NTSC
>
> Should match whatever you're using at VIDIOC_ENUMSTD.

Done by oring all standars in the video-norms array.

>
>> +};
>> +
>> +static int __devinit timblogiw_probe(struct platform_device *pdev)
>> +{
>> +	int err;
>> +	struct timblogiw *lw = NULL;
>> +	struct timb_video_platform_data *pdata = pdev->dev.platform_data;
>> +
>> +	if (!pdata) {
>> +		dev_err(&pdev->dev, "No platform data\n");
>> +		err = -EINVAL;
>> +		goto err;
>> +	}
>> +
>> +	if (!pdata->encoder.module_name)
>> +		dev_info(&pdev->dev, "Running without decoder\n");
>> +
>> +	lw = kzalloc(sizeof(*lw), GFP_KERNEL);
>> +	if (!lw) {
>> +		err = -ENOMEM;
>> +		goto err;
>> +	}
>> +
>> +	if (pdev->dev.parent)
>> +		lw->dev = pdev->dev.parent;
>> +	else
>> +		lw->dev =&pdev->dev;
>> +
>> +	memcpy(&lw->pdata, pdata, sizeof(lw->pdata));
>> +
>> +	mutex_init(&lw->lock);
>> +
>> +	lw->video_dev = timblogiw_template;
>> +
>> +	strlcpy(lw->v4l2_dev.name, DRIVER_NAME, sizeof(lw->v4l2_dev.name));
>> +	err = v4l2_device_register(NULL,&lw->v4l2_dev);
>> +	if (err)
>> +		goto err_register;
>> +
>> +	lw->video_dev.v4l2_dev =&lw->v4l2_dev;
>> +
>> +	err = video_register_device(&lw->video_dev, VFL_TYPE_GRABBER, 0);
>> +	if (err) {
>> +		dev_err(&pdev->dev, "Error reg video: %d\n", err);
>> +		goto err_request;
>> +	}
>> +
>> +	platform_set_drvdata(pdev, lw);
>> +	video_set_drvdata(&lw->video_dev, lw);
>
> An open may happen just after registering the device (and, in fact, it occurs, if
> you're using udev). So, I think you need to move those two calls to happen before
> registering the device, to avoid race conditions.

Will update

>
>> +
>> +	return 0;
>> +
>> +err_request:
>> +	v4l2_device_unregister(&lw->v4l2_dev);
>> +err_register:
>> +	kfree(lw);
>> +err:
>> +	dev_err(&pdev->dev, "Failed to register: %d\n", err);
>> +
>> +	return err;
>> +}
>> +
>> +static int __devexit timblogiw_remove(struct platform_device *pdev)
>> +{
>> +	struct timblogiw *lw = platform_get_drvdata(pdev);
>> +
>> +	video_unregister_device(&lw->video_dev);
>> +
>> +	v4l2_device_unregister(&lw->v4l2_dev);
>> +
>> +	kfree(lw);
>> +
>> +	platform_set_drvdata(pdev, NULL);
>> +
>> +	return 0;
>> +}
>> +
>> +static struct platform_driver timblogiw_platform_driver = {
>> +	.driver = {
>> +		.name	= DRIVER_NAME,
>> +		.owner	= THIS_MODULE,
>> +	},
>> +	.probe		= timblogiw_probe,
>> +	.remove		= __devexit_p(timblogiw_remove),
>> +};
>> +
>> +/* Module functions */
>> +
>> +static int __init timblogiw_init(void)
>> +{
>> +	return platform_driver_register(&timblogiw_platform_driver);
>> +}
>> +
>> +static void __exit timblogiw_exit(void)
>> +{
>> +	platform_driver_unregister(&timblogiw_platform_driver);
>> +}
>> +
>> +module_init(timblogiw_init);
>> +module_exit(timblogiw_exit);
>> +
>> +MODULE_DESCRIPTION(TIMBLOGIWIN_NAME);
>> +MODULE_AUTHOR("Pelagicore AB<info@...agicore.com>");
>> +MODULE_LICENSE("GPL v2");
>> +MODULE_ALIAS("platform:"DRIVER_NAME);
>> diff --git a/include/media/timb_video.h b/include/media/timb_video.h
>> new file mode 100644
>> index 0000000..55334ad
>> --- /dev/null
>> +++ b/include/media/timb_video.h
>> @@ -0,0 +1,34 @@
>> +/*
>> + * timb_video.h Platform struct for the Timberdale video driver
>> + * Copyright (c) 2009-2010 Intel Corporation
>> + *
>> + * This program is free software; you can redistribute it and/or modify
>> + * it under the terms of the GNU General Public License version 2 as
>> + * published by the Free Software Foundation.
>> + *
>> + * This program 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 General Public License for more details.
>> + *
>> + * You should have received a copy of the GNU General Public License
>> + * along with this program; if not, write to the Free Software
>> + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
>> + */
>> +
>> +#ifndef _TIMB_VIDEO_
>> +#define _TIMB_VIDEO_ 1
>> +
>> +#include<linux/i2c.h>
>> +
>> +struct timb_video_platform_data {
>> +	int dma_channel;
>> +	int i2c_adapter; /* The I2C adapter where the encoder is attached */
>> +	struct {
>> +		const char *module_name;
>> +		struct i2c_board_info *info;
>> +	} encoder;
>> +};
>> +
>> +#endif
>> +
--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@...r.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Powered by blists - more mailing lists