Commit 2efe2cc4 authored by Hans Verkuil's avatar Hans Verkuil Committed by Mauro Carvalho Chehab

[media] cx25821: move vidq from cx25821_fh to cx25821_channel

This is not a per-filehandle object, it's a per-channel object.
Signed-off-by: default avatarHans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 11f095aa
...@@ -288,7 +288,7 @@ static void cx25821_vid_timeout(unsigned long data) ...@@ -288,7 +288,7 @@ static void cx25821_vid_timeout(unsigned long data)
struct cx25821_data *timeout_data = (struct cx25821_data *)data; struct cx25821_data *timeout_data = (struct cx25821_data *)data;
struct cx25821_dev *dev = timeout_data->dev; struct cx25821_dev *dev = timeout_data->dev;
const struct sram_channel *channel = timeout_data->channel; const struct sram_channel *channel = timeout_data->channel;
struct cx25821_dmaqueue *q = &dev->channels[channel->i].vidq; struct cx25821_dmaqueue *q = &dev->channels[channel->i].dma_vidq;
struct cx25821_buffer *buf; struct cx25821_buffer *buf;
unsigned long flags; unsigned long flags;
...@@ -334,7 +334,7 @@ int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status) ...@@ -334,7 +334,7 @@ int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status)
if (status & FLD_VID_DST_RISC1) { if (status & FLD_VID_DST_RISC1) {
spin_lock(&dev->slock); spin_lock(&dev->slock);
count = cx_read(channel->gpcnt); count = cx_read(channel->gpcnt);
cx25821_video_wakeup(dev, &dev->channels[channel->i].vidq, cx25821_video_wakeup(dev, &dev->channels[channel->i].dma_vidq,
count); count);
spin_unlock(&dev->slock); spin_unlock(&dev->slock);
handled++; handled++;
...@@ -345,7 +345,7 @@ int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status) ...@@ -345,7 +345,7 @@ int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status)
dprintk(2, "stopper video\n"); dprintk(2, "stopper video\n");
spin_lock(&dev->slock); spin_lock(&dev->slock);
cx25821_restart_video_queue(dev, cx25821_restart_video_queue(dev,
&dev->channels[channel->i].vidq, channel); &dev->channels[channel->i].dma_vidq, channel);
spin_unlock(&dev->slock); spin_unlock(&dev->slock);
handled++; handled++;
} }
...@@ -355,9 +355,9 @@ int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status) ...@@ -355,9 +355,9 @@ int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status)
static int cx25821_buffer_setup(struct videobuf_queue *q, unsigned int *count, static int cx25821_buffer_setup(struct videobuf_queue *q, unsigned int *count,
unsigned int *size) unsigned int *size)
{ {
struct cx25821_fh *fh = q->priv_data; struct cx25821_channel *chan = q->priv_data;
*size = fh->fmt->depth * fh->width * fh->height >> 3; *size = chan->fmt->depth * chan->width * chan->height >> 3;
if (0 == *count) if (0 == *count)
*count = 32; *count = 32;
...@@ -371,32 +371,32 @@ static int cx25821_buffer_setup(struct videobuf_queue *q, unsigned int *count, ...@@ -371,32 +371,32 @@ static int cx25821_buffer_setup(struct videobuf_queue *q, unsigned int *count,
static int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb, static int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
enum v4l2_field field) enum v4l2_field field)
{ {
struct cx25821_fh *fh = q->priv_data; struct cx25821_channel *chan = q->priv_data;
struct cx25821_dev *dev = fh->dev; struct cx25821_dev *dev = chan->dev;
struct cx25821_buffer *buf = struct cx25821_buffer *buf =
container_of(vb, struct cx25821_buffer, vb); container_of(vb, struct cx25821_buffer, vb);
int rc, init_buffer = 0; int rc, init_buffer = 0;
u32 line0_offset; u32 line0_offset;
struct videobuf_dmabuf *dma = videobuf_to_dma(&buf->vb); struct videobuf_dmabuf *dma = videobuf_to_dma(&buf->vb);
int bpl_local = LINE_SIZE_D1; int bpl_local = LINE_SIZE_D1;
int channel_opened = fh->channel_id; int channel_opened = chan->id;
BUG_ON(NULL == fh->fmt); BUG_ON(NULL == chan->fmt);
if (fh->width < 48 || fh->width > 720 || if (chan->width < 48 || chan->width > 720 ||
fh->height < 32 || fh->height > 576) chan->height < 32 || chan->height > 576)
return -EINVAL; return -EINVAL;
buf->vb.size = (fh->width * fh->height * fh->fmt->depth) >> 3; buf->vb.size = (chan->width * chan->height * chan->fmt->depth) >> 3;
if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size) if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size)
return -EINVAL; return -EINVAL;
if (buf->fmt != fh->fmt || if (buf->fmt != chan->fmt ||
buf->vb.width != fh->width || buf->vb.width != chan->width ||
buf->vb.height != fh->height || buf->vb.field != field) { buf->vb.height != chan->height || buf->vb.field != field) {
buf->fmt = fh->fmt; buf->fmt = chan->fmt;
buf->vb.width = fh->width; buf->vb.width = chan->width;
buf->vb.height = fh->height; buf->vb.height = chan->height;
buf->vb.field = field; buf->vb.field = field;
init_buffer = 1; init_buffer = 1;
} }
...@@ -413,7 +413,6 @@ static int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buff ...@@ -413,7 +413,6 @@ static int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buff
dprintk(1, "init_buffer=%d\n", init_buffer); dprintk(1, "init_buffer=%d\n", init_buffer);
if (init_buffer) { if (init_buffer) {
channel_opened = dev->channel_opened; channel_opened = dev->channel_opened;
if (channel_opened < 0 || channel_opened > 7) if (channel_opened < 0 || channel_opened > 7)
channel_opened = 7; channel_opened = 7;
...@@ -483,8 +482,8 @@ static int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buff ...@@ -483,8 +482,8 @@ static int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buff
} }
dprintk(2, "[%p/%d] buffer_prep - %dx%d %dbpp \"%s\" - dma=0x%08lx\n", dprintk(2, "[%p/%d] buffer_prep - %dx%d %dbpp \"%s\" - dma=0x%08lx\n",
buf, buf->vb.i, fh->width, fh->height, fh->fmt->depth, buf, buf->vb.i, chan->width, chan->height, chan->fmt->depth,
fh->fmt->name, (unsigned long)buf->risc.dma); chan->fmt->name, (unsigned long)buf->risc.dma);
buf->vb.state = VIDEOBUF_PREPARED; buf->vb.state = VIDEOBUF_PREPARED;
...@@ -504,11 +503,6 @@ static void cx25821_buffer_release(struct videobuf_queue *q, ...@@ -504,11 +503,6 @@ static void cx25821_buffer_release(struct videobuf_queue *q,
cx25821_free_buffer(q, buf); cx25821_free_buffer(q, buf);
} }
static struct videobuf_queue *get_queue(struct cx25821_fh *fh)
{
return &fh->vidq;
}
static int cx25821_get_resource(struct cx25821_fh *fh, int resource) static int cx25821_get_resource(struct cx25821_fh *fh, int resource)
{ {
return resource; return resource;
...@@ -516,9 +510,9 @@ static int cx25821_get_resource(struct cx25821_fh *fh, int resource) ...@@ -516,9 +510,9 @@ static int cx25821_get_resource(struct cx25821_fh *fh, int resource)
static int cx25821_video_mmap(struct file *file, struct vm_area_struct *vma) static int cx25821_video_mmap(struct file *file, struct vm_area_struct *vma)
{ {
struct cx25821_fh *fh = file->private_data; struct cx25821_channel *chan = video_drvdata(file);
return videobuf_mmap_mapper(get_queue(fh), vma); return videobuf_mmap_mapper(&chan->vidq, vma);
} }
...@@ -527,9 +521,9 @@ static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb) ...@@ -527,9 +521,9 @@ static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb)
struct cx25821_buffer *buf = struct cx25821_buffer *buf =
container_of(vb, struct cx25821_buffer, vb); container_of(vb, struct cx25821_buffer, vb);
struct cx25821_buffer *prev; struct cx25821_buffer *prev;
struct cx25821_fh *fh = vq->priv_data; struct cx25821_channel *chan = vq->priv_data;
struct cx25821_dev *dev = fh->dev; struct cx25821_dev *dev = chan->dev;
struct cx25821_dmaqueue *q = &dev->channels[fh->channel_id].vidq; struct cx25821_dmaqueue *q = &dev->channels[chan->id].dma_vidq;
/* add jump to stopper */ /* add jump to stopper */
buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP | RISC_IRQ1 | RISC_CNT_INC); buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP | RISC_IRQ1 | RISC_CNT_INC);
...@@ -546,8 +540,7 @@ static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb) ...@@ -546,8 +540,7 @@ static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb)
} else if (list_empty(&q->active)) { } else if (list_empty(&q->active)) {
list_add_tail(&buf->vb.queue, &q->active); list_add_tail(&buf->vb.queue, &q->active);
cx25821_start_video_dma(dev, q, buf, cx25821_start_video_dma(dev, q, buf, chan->sram_channels);
dev->channels[fh->channel_id].sram_channels);
buf->vb.state = VIDEOBUF_ACTIVE; buf->vb.state = VIDEOBUF_ACTIVE;
buf->count = q->count++; buf->count = q->count++;
mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT); mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
...@@ -590,19 +583,9 @@ static struct videobuf_queue_ops cx25821_video_qops = { ...@@ -590,19 +583,9 @@ static struct videobuf_queue_ops cx25821_video_qops = {
static int video_open(struct file *file) static int video_open(struct file *file)
{ {
struct video_device *vdev = video_devdata(file); struct cx25821_channel *chan = video_drvdata(file);
struct cx25821_dev *dev = video_drvdata(file); struct cx25821_dev *dev = chan->dev;
struct cx25821_fh *fh; struct cx25821_fh *fh;
u32 pix_format;
int ch_id;
for (ch_id = 0; ch_id < MAX_VID_CHANNEL_NUM - 1; ch_id++)
if (&dev->channels[ch_id].vdev == vdev)
break;
/* Can't happen */
if (ch_id >= MAX_VID_CHANNEL_NUM - 1)
return -ENODEV;
/* allocate + initialize per filehandle data */ /* allocate + initialize per filehandle data */
fh = kzalloc(sizeof(*fh), GFP_KERNEL); fh = kzalloc(sizeof(*fh), GFP_KERNEL);
...@@ -611,27 +594,11 @@ static int video_open(struct file *file) ...@@ -611,27 +594,11 @@ static int video_open(struct file *file)
file->private_data = fh; file->private_data = fh;
fh->dev = dev; fh->dev = dev;
fh->width = 720; fh->channel_id = chan->id;
fh->channel_id = ch_id;
if (dev->tvnorm & V4L2_STD_PAL_BG || dev->tvnorm & V4L2_STD_PAL_DK)
fh->height = 576;
else
fh->height = 480;
dev->channel_opened = fh->channel_id; dev->channel_opened = fh->channel_id;
if (dev->channels[ch_id].pixel_formats == PIXEL_FRMT_411)
pix_format = V4L2_PIX_FMT_Y41P;
else
pix_format = V4L2_PIX_FMT_YUYV;
fh->fmt = cx25821_format_by_fourcc(pix_format);
v4l2_prio_open(&dev->channels[ch_id].prio, &fh->prio);
videobuf_queue_sg_init(&fh->vidq, &cx25821_video_qops, &dev->pci->dev, v4l2_prio_open(&chan->prio, &fh->prio);
&dev->slock, V4L2_BUF_TYPE_VIDEO_CAPTURE,
V4L2_FIELD_INTERLACED, sizeof(struct cx25821_buffer),
fh, &dev->lock);
dprintk(1, "post videobuf_queue_init()\n"); dprintk(1, "post videobuf_queue_init()\n");
...@@ -642,6 +609,7 @@ static ssize_t video_read(struct file *file, char __user * data, size_t count, ...@@ -642,6 +609,7 @@ static ssize_t video_read(struct file *file, char __user * data, size_t count,
loff_t *ppos) loff_t *ppos)
{ {
struct cx25821_fh *fh = file->private_data; struct cx25821_fh *fh = file->private_data;
struct cx25821_channel *chan = video_drvdata(file);
struct cx25821_dev *dev = fh->dev; struct cx25821_dev *dev = fh->dev;
int err; int err;
...@@ -650,7 +618,7 @@ static ssize_t video_read(struct file *file, char __user * data, size_t count, ...@@ -650,7 +618,7 @@ static ssize_t video_read(struct file *file, char __user * data, size_t count,
if (cx25821_res_locked(fh, RESOURCE_VIDEO0)) if (cx25821_res_locked(fh, RESOURCE_VIDEO0))
err = -EBUSY; err = -EBUSY;
else else
err = videobuf_read_one(&fh->vidq, data, count, ppos, err = videobuf_read_one(&chan->vidq, data, count, ppos,
file->f_flags & O_NONBLOCK); file->f_flags & O_NONBLOCK);
mutex_unlock(&dev->lock); mutex_unlock(&dev->lock);
return err; return err;
...@@ -660,17 +628,18 @@ static unsigned int video_poll(struct file *file, ...@@ -660,17 +628,18 @@ static unsigned int video_poll(struct file *file,
struct poll_table_struct *wait) struct poll_table_struct *wait)
{ {
struct cx25821_fh *fh = file->private_data; struct cx25821_fh *fh = file->private_data;
struct cx25821_channel *chan = video_drvdata(file);
struct cx25821_buffer *buf; struct cx25821_buffer *buf;
if (cx25821_res_check(fh, RESOURCE_VIDEO0)) { if (cx25821_res_check(fh, RESOURCE_VIDEO0)) {
/* streaming capture */ /* streaming capture */
if (list_empty(&fh->vidq.stream)) if (list_empty(&chan->vidq.stream))
return POLLERR; return POLLERR;
buf = list_entry(fh->vidq.stream.next, buf = list_entry(chan->vidq.stream.next,
struct cx25821_buffer, vb.stream); struct cx25821_buffer, vb.stream);
} else { } else {
/* read() capture */ /* read() capture */
buf = (struct cx25821_buffer *)fh->vidq.read_buf; buf = (struct cx25821_buffer *)chan->vidq.read_buf;
if (NULL == buf) if (NULL == buf)
return POLLERR; return POLLERR;
} }
...@@ -680,12 +649,11 @@ static unsigned int video_poll(struct file *file, ...@@ -680,12 +649,11 @@ static unsigned int video_poll(struct file *file,
if (buf->vb.state == VIDEOBUF_DONE) { if (buf->vb.state == VIDEOBUF_DONE) {
struct cx25821_dev *dev = fh->dev; struct cx25821_dev *dev = fh->dev;
if (dev && dev->channels[fh->channel_id] if (dev && chan->use_cif_resolution) {
.use_cif_resolution) {
u8 cam_id = *((char *)buf->vb.baddr + 3); u8 cam_id = *((char *)buf->vb.baddr + 3);
memcpy((char *)buf->vb.baddr, memcpy((char *)buf->vb.baddr,
(char *)buf->vb.baddr + (fh->width * 2), (char *)buf->vb.baddr + (chan->width * 2),
(fh->width * 2)); (chan->width * 2));
*((char *)buf->vb.baddr + 3) = cam_id; *((char *)buf->vb.baddr + 3) = cam_id;
} }
} }
...@@ -698,8 +666,9 @@ static unsigned int video_poll(struct file *file, ...@@ -698,8 +666,9 @@ static unsigned int video_poll(struct file *file,
static int video_release(struct file *file) static int video_release(struct file *file)
{ {
struct cx25821_channel *chan = video_drvdata(file);
struct cx25821_fh *fh = file->private_data; struct cx25821_fh *fh = file->private_data;
struct cx25821_dev *dev = fh->dev; struct cx25821_dev *dev = chan->dev;
const struct sram_channel *sram_ch = const struct sram_channel *sram_ch =
dev->channels[0].sram_channels; dev->channels[0].sram_channels;
...@@ -709,19 +678,19 @@ static int video_release(struct file *file) ...@@ -709,19 +678,19 @@ static int video_release(struct file *file)
/* stop video capture */ /* stop video capture */
if (cx25821_res_check(fh, RESOURCE_VIDEO0)) { if (cx25821_res_check(fh, RESOURCE_VIDEO0)) {
videobuf_queue_cancel(&fh->vidq); videobuf_queue_cancel(&chan->vidq);
cx25821_res_free(dev, fh, RESOURCE_VIDEO0); cx25821_res_free(dev, fh, RESOURCE_VIDEO0);
} }
mutex_unlock(&dev->lock); mutex_unlock(&dev->lock);
if (fh->vidq.read_buf) { if (chan->vidq.read_buf) {
cx25821_buffer_release(&fh->vidq, fh->vidq.read_buf); cx25821_buffer_release(&chan->vidq, chan->vidq.read_buf);
kfree(fh->vidq.read_buf); kfree(chan->vidq.read_buf);
} }
videobuf_mmap_free(&fh->vidq); videobuf_mmap_free(&chan->vidq);
v4l2_prio_close(&dev->channels[fh->channel_id].prio, fh->prio); v4l2_prio_close(&chan->prio, fh->prio);
file->private_data = NULL; file->private_data = NULL;
kfree(fh); kfree(fh);
...@@ -732,13 +701,13 @@ static int video_release(struct file *file) ...@@ -732,13 +701,13 @@ static int video_release(struct file *file)
static int cx25821_vidioc_g_fmt_vid_cap(struct file *file, void *priv, static int cx25821_vidioc_g_fmt_vid_cap(struct file *file, void *priv,
struct v4l2_format *f) struct v4l2_format *f)
{ {
struct cx25821_fh *fh = priv; struct cx25821_channel *chan = video_drvdata(file);
f->fmt.pix.width = fh->width; f->fmt.pix.width = chan->width;
f->fmt.pix.height = fh->height; f->fmt.pix.height = chan->height;
f->fmt.pix.field = fh->vidq.field; f->fmt.pix.field = chan->vidq.field;
f->fmt.pix.pixelformat = fh->fmt->fourcc; f->fmt.pix.pixelformat = chan->fmt->fourcc;
f->fmt.pix.bytesperline = (f->fmt.pix.width * fh->fmt->depth) >> 3; f->fmt.pix.bytesperline = (f->fmt.pix.width * chan->fmt->depth) >> 3;
f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline; f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
return 0; return 0;
...@@ -794,6 +763,7 @@ static int cx25821_vidioc_try_fmt_vid_cap(struct file *file, void *priv, ...@@ -794,6 +763,7 @@ static int cx25821_vidioc_try_fmt_vid_cap(struct file *file, void *priv,
} }
static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i) static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
{ {
struct cx25821_channel *chan = video_drvdata(file);
struct cx25821_fh *fh = priv; struct cx25821_fh *fh = priv;
struct cx25821_dev *dev = fh->dev; struct cx25821_dev *dev = fh->dev;
...@@ -804,11 +774,12 @@ static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i) ...@@ -804,11 +774,12 @@ static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
cx25821_get_resource(fh, RESOURCE_VIDEO0))) cx25821_get_resource(fh, RESOURCE_VIDEO0)))
return -EBUSY; return -EBUSY;
return videobuf_streamon(get_queue(fh)); return videobuf_streamon(&chan->vidq);
} }
static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i) static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
{ {
struct cx25821_channel *chan = video_drvdata(file);
struct cx25821_fh *fh = priv; struct cx25821_fh *fh = priv;
struct cx25821_dev *dev = fh->dev; struct cx25821_dev *dev = fh->dev;
int err, res; int err, res;
...@@ -817,7 +788,7 @@ static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i) ...@@ -817,7 +788,7 @@ static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
return -EINVAL; return -EINVAL;
res = cx25821_get_resource(fh, RESOURCE_VIDEO0); res = cx25821_get_resource(fh, RESOURCE_VIDEO0);
err = videobuf_streamoff(get_queue(fh)); err = videobuf_streamoff(&chan->vidq);
if (err < 0) if (err < 0)
return err; return err;
cx25821_res_free(dev, fh, res); cx25821_res_free(dev, fh, res);
...@@ -865,6 +836,7 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, ...@@ -865,6 +836,7 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
struct v4l2_format *f) struct v4l2_format *f)
{ {
struct cx25821_fh *fh = priv; struct cx25821_fh *fh = priv;
struct cx25821_channel *chan = video_drvdata(file);
struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev; struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
struct v4l2_mbus_framefmt mbus_fmt; struct v4l2_mbus_framefmt mbus_fmt;
int err; int err;
...@@ -882,15 +854,15 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, ...@@ -882,15 +854,15 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
if (0 != err) if (0 != err)
return err; return err;
fh->fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat); chan->fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
fh->vidq.field = f->fmt.pix.field; chan->vidq.field = f->fmt.pix.field;
/* check if width and height is valid based on set standard */ /* check if width and height is valid based on set standard */
if (cx25821_is_valid_width(f->fmt.pix.width, dev->tvnorm)) if (cx25821_is_valid_width(f->fmt.pix.width, dev->tvnorm))
fh->width = f->fmt.pix.width; chan->width = f->fmt.pix.width;
if (cx25821_is_valid_height(f->fmt.pix.height, dev->tvnorm)) if (cx25821_is_valid_height(f->fmt.pix.height, dev->tvnorm))
fh->height = f->fmt.pix.height; chan->height = f->fmt.pix.height;
if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_Y41P) if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_Y41P)
pix_format = PIXEL_FRMT_411; pix_format = PIXEL_FRMT_411;
...@@ -902,13 +874,13 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, ...@@ -902,13 +874,13 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
cx25821_set_pixel_format(dev, SRAM_CH00, pix_format); cx25821_set_pixel_format(dev, SRAM_CH00, pix_format);
/* check if cif resolution */ /* check if cif resolution */
if (fh->width == 320 || fh->width == 352) if (chan->width == 320 || chan->width == 352)
dev->channels[fh->channel_id].use_cif_resolution = 1; chan->use_cif_resolution = 1;
else else
dev->channels[fh->channel_id].use_cif_resolution = 0; chan->use_cif_resolution = 0;
dev->channels[fh->channel_id].cif_width = fh->width; chan->cif_width = chan->width;
medusa_set_resolution(dev, fh->width, SRAM_CH00); medusa_set_resolution(dev, chan->width, SRAM_CH00);
v4l2_fill_mbus_format(&mbus_fmt, &f->fmt.pix, V4L2_MBUS_FMT_FIXED); v4l2_fill_mbus_format(&mbus_fmt, &f->fmt.pix, V4L2_MBUS_FMT_FIXED);
cx25821_call_all(dev, video, s_mbus_fmt, &mbus_fmt); cx25821_call_all(dev, video, s_mbus_fmt, &mbus_fmt);
...@@ -919,12 +891,10 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, ...@@ -919,12 +891,10 @@ static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *p) static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *p)
{ {
int ret_val = 0; int ret_val = 0;
struct cx25821_fh *fh = priv; struct cx25821_channel *chan = video_drvdata(file);
struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
ret_val = videobuf_dqbuf(get_queue(fh), p, file->f_flags & O_NONBLOCK); ret_val = videobuf_dqbuf(&chan->vidq, p, file->f_flags & O_NONBLOCK);
p->sequence = chan->dma_vidq.count;
p->sequence = dev->channels[fh->channel_id].vidq.count;
return ret_val; return ret_val;
} }
...@@ -980,21 +950,24 @@ static int cx25821_vidioc_enum_fmt_vid_cap(struct file *file, void *priv, ...@@ -980,21 +950,24 @@ static int cx25821_vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
static int cx25821_vidioc_reqbufs(struct file *file, void *priv, static int cx25821_vidioc_reqbufs(struct file *file, void *priv,
struct v4l2_requestbuffers *p) struct v4l2_requestbuffers *p)
{ {
struct cx25821_fh *fh = priv; struct cx25821_channel *chan = video_drvdata(file);
return videobuf_reqbufs(get_queue(fh), p);
return videobuf_reqbufs(&chan->vidq, p);
} }
static int cx25821_vidioc_querybuf(struct file *file, void *priv, static int cx25821_vidioc_querybuf(struct file *file, void *priv,
struct v4l2_buffer *p) struct v4l2_buffer *p)
{ {
struct cx25821_fh *fh = priv; struct cx25821_channel *chan = video_drvdata(file);
return videobuf_querybuf(get_queue(fh), p);
return videobuf_querybuf(&chan->vidq, p);
} }
static int cx25821_vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *p) static int cx25821_vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *p)
{ {
struct cx25821_fh *fh = priv; struct cx25821_channel *chan = video_drvdata(file);
return videobuf_qbuf(get_queue(fh), p);
return videobuf_qbuf(&chan->vidq, p);
} }
static int cx25821_vidioc_g_priority(struct file *file, void *f, enum v4l2_priority *p) static int cx25821_vidioc_g_priority(struct file *file, void *f, enum v4l2_priority *p)
...@@ -1466,7 +1439,7 @@ void cx25821_video_unregister(struct cx25821_dev *dev, int chan_num) ...@@ -1466,7 +1439,7 @@ void cx25821_video_unregister(struct cx25821_dev *dev, int chan_num)
v4l2_ctrl_handler_free(&dev->channels[chan_num].hdl); v4l2_ctrl_handler_free(&dev->channels[chan_num].hdl);
btcx_riscmem_free(dev->pci, btcx_riscmem_free(dev->pci,
&dev->channels[chan_num].vidq.stopper); &dev->channels[chan_num].dma_vidq.stopper);
} }
} }
...@@ -1482,8 +1455,9 @@ int cx25821_video_register(struct cx25821_dev *dev) ...@@ -1482,8 +1455,9 @@ int cx25821_video_register(struct cx25821_dev *dev)
spin_lock_init(&dev->slock); spin_lock_init(&dev->slock);
for (i = 0; i < VID_CHANNEL_NUM; ++i) { for (i = 0; i < VID_CHANNEL_NUM; ++i) {
struct video_device *vdev = &dev->channels[i].vdev; struct cx25821_channel *chan = &dev->channels[i];
struct v4l2_ctrl_handler *hdl = &dev->channels[i].hdl; struct video_device *vdev = &chan->vdev;
struct v4l2_ctrl_handler *hdl = &chan->hdl;
if (i == SRAM_CH08) /* audio channel */ if (i == SRAM_CH08) /* audio channel */
continue; continue;
...@@ -1505,24 +1479,37 @@ int cx25821_video_register(struct cx25821_dev *dev) ...@@ -1505,24 +1479,37 @@ int cx25821_video_register(struct cx25821_dev *dev)
if (err) if (err)
goto fail_unreg; goto fail_unreg;
cx25821_risc_stopper(dev->pci, &dev->channels[i].vidq.stopper, cx25821_risc_stopper(dev->pci, &chan->dma_vidq.stopper,
dev->channels[i].sram_channels->dma_ctl, 0x11, 0); chan->sram_channels->dma_ctl, 0x11, 0);
dev->channels[i].sram_channels = &cx25821_sram_channels[i]; chan->sram_channels = &cx25821_sram_channels[i];
dev->channels[i].resources = 0; chan->resources = 0;
chan->width = 720;
if (dev->tvnorm & V4L2_STD_625_50)
chan->height = 576;
else
chan->height = 480;
cx_write(dev->channels[i].sram_channels->int_stat, 0xffffffff); if (chan->pixel_formats == PIXEL_FRMT_411)
chan->fmt = cx25821_format_by_fourcc(V4L2_PIX_FMT_Y41P);
else
chan->fmt = cx25821_format_by_fourcc(V4L2_PIX_FMT_YUYV);
INIT_LIST_HEAD(&dev->channels[i].vidq.active); cx_write(chan->sram_channels->int_stat, 0xffffffff);
INIT_LIST_HEAD(&dev->channels[i].vidq.queued);
dev->channels[i].timeout_data.dev = dev; INIT_LIST_HEAD(&chan->dma_vidq.active);
dev->channels[i].timeout_data.channel = INIT_LIST_HEAD(&chan->dma_vidq.queued);
&cx25821_sram_channels[i];
dev->channels[i].vidq.timeout.function = cx25821_vid_timeout; chan->timeout_data.dev = dev;
dev->channels[i].vidq.timeout.data = chan->timeout_data.channel = &cx25821_sram_channels[i];
(unsigned long)&dev->channels[i].timeout_data; chan->dma_vidq.timeout.function = cx25821_vid_timeout;
init_timer(&dev->channels[i].vidq.timeout); chan->dma_vidq.timeout.data = (unsigned long)&chan->timeout_data;
init_timer(&chan->dma_vidq.timeout);
videobuf_queue_sg_init(&chan->vidq, &cx25821_video_qops, &dev->pci->dev,
&dev->slock, V4L2_BUF_TYPE_VIDEO_CAPTURE,
V4L2_FIELD_INTERLACED, sizeof(struct cx25821_buffer),
chan, &dev->lock);
/* register v4l devices */ /* register v4l devices */
*vdev = cx25821_video_device; *vdev = cx25821_video_device;
...@@ -1530,7 +1517,7 @@ int cx25821_video_register(struct cx25821_dev *dev) ...@@ -1530,7 +1517,7 @@ int cx25821_video_register(struct cx25821_dev *dev)
vdev->ctrl_handler = hdl; vdev->ctrl_handler = hdl;
vdev->lock = &dev->lock; vdev->lock = &dev->lock;
snprintf(vdev->name, sizeof(vdev->name), "%s #%d", dev->name, i); snprintf(vdev->name, sizeof(vdev->name), "%s #%d", dev->name, i);
video_set_drvdata(vdev, dev); video_set_drvdata(vdev, chan);
err = video_register_device(vdev, VFL_TYPE_GRABBER, err = video_register_device(vdev, VFL_TYPE_GRABBER,
video_nr[dev->nr]); video_nr[dev->nr]);
......
...@@ -123,10 +123,7 @@ struct cx25821_fh { ...@@ -123,10 +123,7 @@ struct cx25821_fh {
enum v4l2_priority prio; enum v4l2_priority prio;
/* video capture */ /* video capture */
const struct cx25821_fmt *fmt;
unsigned int width, height;
int channel_id; int channel_id;
struct videobuf_queue vidq;
}; };
enum cx25821_itype { enum cx25821_itype {
...@@ -217,12 +214,15 @@ struct cx25821_channel { ...@@ -217,12 +214,15 @@ struct cx25821_channel {
struct cx25821_data timeout_data; struct cx25821_data timeout_data;
struct video_device vdev; struct video_device vdev;
struct cx25821_dmaqueue vidq; struct cx25821_dmaqueue dma_vidq;
struct videobuf_queue vidq;
const struct sram_channel *sram_channels; const struct sram_channel *sram_channels;
int resources; int resources;
const struct cx25821_fmt *fmt;
unsigned int width, height;
int pixel_formats; int pixel_formats;
int use_cif_resolution; int use_cif_resolution;
int cif_width; int cif_width;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment