blob: a9aa09651cab8dcbeaa991d903dce3e3498b984d [file] [log] [blame]
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001/*
2 * Driver for the Conexant CX25821 PCIe bridge
3 *
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03004 * Copyright (C) 2009 Conexant Systems Inc.
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03005 * Authors <shu.lin@conexant.com>, <hiep.huynh@conexant.com>
6 * Based on Steven Toth <stoth@linuxtv.org> cx23885 driver
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03007 * Parts adapted/taken from Eduardo Moscoso Rubino
8 * Copyright (C) 2009 Eduardo Moscoso Rubino <moscoso@TopoLogica.com>
9 *
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030010 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (at your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 *
20 * GNU General Public License for more details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
25 */
26
Joe Perches36d89f72010-11-07 17:48:21 -030027#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
28
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030029#include "cx25821-video.h"
30
31MODULE_DESCRIPTION("v4l2 driver module for cx25821 based TV cards");
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -030032MODULE_AUTHOR("Hiep Huynh <hiep.huynh@conexant.com>");
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030033MODULE_LICENSE("GPL");
34
Mauro Carvalho Chehab53e712d2009-09-13 11:39:12 -030035static unsigned int video_nr[] = {[0 ... (CX25821_MAXBOARDS - 1)] = UNSET };
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030036
37module_param_array(video_nr, int, NULL, 0444);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030038
39MODULE_PARM_DESC(video_nr, "video device numbers");
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030040
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -030041static unsigned int video_debug = VIDEO_DEBUG;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030042module_param(video_debug, int, 0644);
43MODULE_PARM_DESC(video_debug, "enable debug messages [video]");
44
45static unsigned int irq_debug;
46module_param(irq_debug, int, 0644);
47MODULE_PARM_DESC(irq_debug, "enable debug messages [IRQ handler]");
48
49unsigned int vid_limit = 16;
50module_param(vid_limit, int, 0644);
51MODULE_PARM_DESC(vid_limit, "capture memory limit in megabytes");
52
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -030053static void cx25821_init_controls(struct cx25821_dev *dev, int chan_num);
54
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030055#define FORMAT_FLAGS_PACKED 0x01
56
57struct cx25821_fmt formats[] = {
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -030058 {
Mauro Carvalho Chehabd7d93382010-03-24 14:23:25 -030059 .name = "8 bpp, gray",
60 .fourcc = V4L2_PIX_FMT_GREY,
61 .depth = 8,
62 .flags = FORMAT_FLAGS_PACKED,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -030063 }, {
Mauro Carvalho Chehabd7d93382010-03-24 14:23:25 -030064 .name = "4:1:1, packed, Y41P",
65 .fourcc = V4L2_PIX_FMT_Y41P,
66 .depth = 12,
67 .flags = FORMAT_FLAGS_PACKED,
68 }, {
69 .name = "4:2:2, packed, YUYV",
70 .fourcc = V4L2_PIX_FMT_YUYV,
71 .depth = 16,
72 .flags = FORMAT_FLAGS_PACKED,
73 }, {
74 .name = "4:2:2, packed, UYVY",
75 .fourcc = V4L2_PIX_FMT_UYVY,
76 .depth = 16,
77 .flags = FORMAT_FLAGS_PACKED,
78 }, {
79 .name = "4:2:0, YUV",
80 .fourcc = V4L2_PIX_FMT_YUV420,
81 .depth = 12,
82 .flags = FORMAT_FLAGS_PACKED,
83 },
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030084};
85
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -030086int cx25821_get_format_size(void)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030087{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -030088 return ARRAY_SIZE(formats);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030089}
90
Mauro Carvalho Chehaba757ee22010-12-02 01:57:03 -020091struct cx25821_fmt *cx25821_format_by_fourcc(unsigned int fourcc)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030092{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -030093 unsigned int i;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -030094
Leonid V. Fedorenchike313e1f2011-09-16 14:15:13 +080095 if (fourcc == V4L2_PIX_FMT_Y41P || fourcc == V4L2_PIX_FMT_YUV411P)
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -030096 return formats + 1;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -030097
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -030098 for (i = 0; i < ARRAY_SIZE(formats); i++)
99 if (formats[i].fourcc == fourcc)
100 return formats + i;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300101
Joe Perches36d89f72010-11-07 17:48:21 -0300102 pr_err("%s(0x%08x) NOT FOUND\n", __func__, fourcc);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300103 return NULL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300104}
105
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300106void cx25821_video_wakeup(struct cx25821_dev *dev, struct cx25821_dmaqueue *q,
107 u32 count)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300108{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300109 struct cx25821_buffer *buf;
110 int bc;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300111
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300112 for (bc = 0;; bc++) {
113 if (list_empty(&q->active)) {
114 dprintk(1, "bc=%d (=0: active empty)\n", bc);
115 break;
116 }
117
Leonid V. Fedorenchik0abfefb2011-10-22 01:43:55 -0300118 buf = list_entry(q->active.next, struct cx25821_buffer,
119 vb.queue);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300120
121 /* count comes from the hw and it is 16bit wide --
122 * this trick handles wrap-arounds correctly for
123 * up to 32767 buffers in flight... */
Leonid V. Fedorenchike313e1f2011-09-16 14:15:13 +0800124 if ((s16) (count - buf->count) < 0)
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300125 break;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300126
Sakari Ailus8e6057b2012-09-15 15:14:42 -0300127 v4l2_get_timestamp(&buf->vb.ts);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300128 buf->vb.state = VIDEOBUF_DONE;
129 list_del(&buf->vb.queue);
130 wake_up(&buf->vb.done);
131 }
132
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300133 if (list_empty(&q->active))
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300134 del_timer(&q->timeout);
135 else
136 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
137 if (bc != 1)
Leonid V. Fedorenchik692cfb92011-09-16 14:14:36 +0800138 pr_err("%s: %d buffers handled (should be 1)\n", __func__, bc);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300139}
140
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300141int cx25821_set_tvnorm(struct cx25821_dev *dev, v4l2_std_id norm)
142{
Joe Perches36d89f72010-11-07 17:48:21 -0300143 dprintk(1, "%s(norm = 0x%08x) name: [%s]\n",
144 __func__, (unsigned int)norm, v4l2_norm_to_name(norm));
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300145
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300146 dev->tvnorm = norm;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300147
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300148 /* Tell the internal A/V decoder */
149 cx25821_call_all(dev, core, s_std, norm);
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300150
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300151 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300152}
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300153
154struct video_device *cx25821_vdev_init(struct cx25821_dev *dev,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300155 struct pci_dev *pci,
Hans Verkuil170bd532013-04-13 05:19:41 -0300156 const struct video_device *template,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300157 char *type)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300158{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300159 struct video_device *vfd;
160 dprintk(1, "%s()\n", __func__);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300161
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300162 vfd = video_device_alloc();
163 if (NULL == vfd)
164 return NULL;
165 *vfd = *template;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300166 vfd->v4l2_dev = &dev->v4l2_dev;
167 vfd->release = video_device_release;
168 snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)", dev->name, type,
169 cx25821_boards[dev->board].name);
Laurent Pinchart63b0d5a2009-12-10 11:44:04 -0200170 video_set_drvdata(vfd, dev);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300171 return vfd;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300172}
173
174/*
175static int cx25821_ctrl_query(struct v4l2_queryctrl *qctrl)
176{
Leonid V. Fedorenchikc2c311f2011-09-16 14:14:37 +0800177 int i;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300178
Leonid V. Fedorenchikc2c311f2011-09-16 14:14:37 +0800179 if (qctrl->id < V4L2_CID_BASE || qctrl->id >= V4L2_CID_LASTP1)
180 return -EINVAL;
181 for (i = 0; i < CX25821_CTLS; i++)
182 if (cx25821_ctls[i].v.id == qctrl->id)
183 break;
184 if (i == CX25821_CTLS) {
185 *qctrl = no_ctl;
186 return 0;
187 }
188 *qctrl = cx25821_ctls[i].v;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300189 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300190}
191*/
192
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300193/* resource management */
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +0800194int cx25821_res_get(struct cx25821_dev *dev, struct cx25821_fh *fh,
195 unsigned int bit)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300196{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300197 dprintk(1, "%s()\n", __func__);
198 if (fh->resources & bit)
199 /* have it already allocated */
200 return 1;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300201
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300202 /* is it free? */
203 mutex_lock(&dev->lock);
Leonid V. Fedorenchik69dfe452011-09-16 14:14:38 +0800204 if (dev->channels[fh->channel_id].resources & bit) {
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300205 /* no, someone else uses it */
206 mutex_unlock(&dev->lock);
207 return 0;
208 }
209 /* it's free, grab it */
210 fh->resources |= bit;
Leonid V. Fedorenchik69dfe452011-09-16 14:14:38 +0800211 dev->channels[fh->channel_id].resources |= bit;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300212 dprintk(1, "res: get %d\n", bit);
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300213 mutex_unlock(&dev->lock);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300214 return 1;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300215}
216
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -0300217int cx25821_res_check(struct cx25821_fh *fh, unsigned int bit)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300218{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300219 return fh->resources & bit;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300220}
221
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300222int cx25821_res_locked(struct cx25821_fh *fh, unsigned int bit)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300223{
Leonid V. Fedorenchik69dfe452011-09-16 14:14:38 +0800224 return fh->dev->channels[fh->channel_id].resources & bit;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300225}
226
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +0800227void cx25821_res_free(struct cx25821_dev *dev, struct cx25821_fh *fh,
228 unsigned int bits)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300229{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300230 BUG_ON((fh->resources & bits) != bits);
231 dprintk(1, "%s()\n", __func__);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300232
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300233 mutex_lock(&dev->lock);
234 fh->resources &= ~bits;
Leonid V. Fedorenchik69dfe452011-09-16 14:14:38 +0800235 dev->channels[fh->channel_id].resources &= ~bits;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300236 dprintk(1, "res: put %d\n", bits);
237 mutex_unlock(&dev->lock);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300238}
239
240int cx25821_video_mux(struct cx25821_dev *dev, unsigned int input)
241{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300242 struct v4l2_routing route;
243 memset(&route, 0, sizeof(route));
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300244
Joe Perches36d89f72010-11-07 17:48:21 -0300245 dprintk(1, "%s(): video_mux: %d [vmux=%d, gpio=0x%x,0x%x,0x%x,0x%x]\n",
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300246 __func__, input, INPUT(input)->vmux, INPUT(input)->gpio0,
247 INPUT(input)->gpio1, INPUT(input)->gpio2, INPUT(input)->gpio3);
248 dev->input = input;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300249
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300250 route.input = INPUT(input)->vmux;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300251
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300252 /* Tell the internal A/V decoder */
253 cx25821_call_all(dev, video, s_routing, INPUT(input)->vmux, 0, 0);
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300254
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300255 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300256}
257
258int cx25821_start_video_dma(struct cx25821_dev *dev,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300259 struct cx25821_dmaqueue *q,
260 struct cx25821_buffer *buf,
Hans Verkuilbfef0d32013-04-13 06:28:54 -0300261 const struct sram_channel *channel)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300262{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300263 int tmp = 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300264
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300265 /* setup fifo + format */
266 cx25821_sram_channel_setup(dev, channel, buf->bpl, buf->risc.dma);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300267
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300268 /* reset counter */
269 cx_write(channel->gpcnt_ctl, 3);
270 q->count = 1;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300271
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300272 /* enable irq */
273 cx_set(PCI_INT_MSK, cx_read(PCI_INT_MSK) | (1 << channel->i));
274 cx_set(channel->int_msk, 0x11);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300275
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300276 /* start dma */
277 cx_write(channel->dma_ctl, 0x11); /* FIFO and RISC enable */
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300278
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300279 /* make sure upstream setting if any is reversed */
280 tmp = cx_read(VID_CH_MODE_SEL);
281 cx_write(VID_CH_MODE_SEL, tmp & 0xFFFFFE00);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300282
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300283 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300284}
285
Mauro Carvalho Chehabdafc4562012-10-27 12:42:59 -0300286static int cx25821_restart_video_queue(struct cx25821_dev *dev,
287 struct cx25821_dmaqueue *q,
Hans Verkuilbfef0d32013-04-13 06:28:54 -0300288 const struct sram_channel *channel)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300289{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300290 struct cx25821_buffer *buf, *prev;
291 struct list_head *item;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300292
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300293 if (!list_empty(&q->active)) {
Leonid V. Fedorenchik0abfefb2011-10-22 01:43:55 -0300294 buf = list_entry(q->active.next, struct cx25821_buffer,
295 vb.queue);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300296
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300297 cx25821_start_video_dma(dev, q, buf, channel);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300298
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300299 list_for_each(item, &q->active) {
300 buf = list_entry(item, struct cx25821_buffer, vb.queue);
301 buf->count = q->count++;
302 }
303
304 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
305 return 0;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300306 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300307
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300308 prev = NULL;
309 for (;;) {
310 if (list_empty(&q->queued))
311 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300312
Leonid V. Fedorenchik0abfefb2011-10-22 01:43:55 -0300313 buf = list_entry(q->queued.next, struct cx25821_buffer,
314 vb.queue);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300315
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300316 if (NULL == prev) {
317 list_move_tail(&buf->vb.queue, &q->active);
318 cx25821_start_video_dma(dev, q, buf, channel);
319 buf->vb.state = VIDEOBUF_ACTIVE;
320 buf->count = q->count++;
321 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
322 } else if (prev->vb.width == buf->vb.width &&
323 prev->vb.height == buf->vb.height &&
324 prev->fmt == buf->fmt) {
325 list_move_tail(&buf->vb.queue, &q->active);
326 buf->vb.state = VIDEOBUF_ACTIVE;
327 buf->count = q->count++;
328 prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
Leonid V. Fedorenchik69dfe452011-09-16 14:14:38 +0800329 prev->risc.jmp[2] = cpu_to_le32(0); /* Bits 63 - 32 */
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300330 } else {
331 return 0;
332 }
333 prev = buf;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300334 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300335}
336
Mauro Carvalho Chehabdafc4562012-10-27 12:42:59 -0300337static void cx25821_vid_timeout(unsigned long data)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300338{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300339 struct cx25821_data *timeout_data = (struct cx25821_data *)data;
340 struct cx25821_dev *dev = timeout_data->dev;
Hans Verkuilbfef0d32013-04-13 06:28:54 -0300341 const struct sram_channel *channel = timeout_data->channel;
Leonid V. Fedorenchik69dfe452011-09-16 14:14:38 +0800342 struct cx25821_dmaqueue *q = &dev->channels[channel->i].vidq;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300343 struct cx25821_buffer *buf;
344 unsigned long flags;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300345
Leonid V. Fedorenchik69dfe452011-09-16 14:14:38 +0800346 /* cx25821_sram_channel_dump(dev, channel); */
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300347 cx_clear(channel->dma_ctl, 0x11);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300348
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300349 spin_lock_irqsave(&dev->slock, flags);
350 while (!list_empty(&q->active)) {
Leonid V. Fedorenchik0abfefb2011-10-22 01:43:55 -0300351 buf = list_entry(q->active.next, struct cx25821_buffer,
352 vb.queue);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300353 list_del(&buf->vb.queue);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300354
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300355 buf->vb.state = VIDEOBUF_ERROR;
356 wake_up(&buf->vb.done);
357 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300358
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300359 cx25821_restart_video_queue(dev, q, channel);
360 spin_unlock_irqrestore(&dev->slock, flags);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300361}
362
363int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status)
364{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300365 u32 count = 0;
366 int handled = 0;
367 u32 mask;
Hans Verkuilbfef0d32013-04-13 06:28:54 -0300368 const struct sram_channel *channel = dev->channels[chan_num].sram_channels;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300369
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300370 mask = cx_read(channel->int_msk);
371 if (0 == (status & mask))
372 return handled;
373
374 cx_write(channel->int_stat, status);
375
376 /* risc op code error */
377 if (status & (1 << 16)) {
Joe Perches36d89f72010-11-07 17:48:21 -0300378 pr_warn("%s, %s: video risc op code error\n",
379 dev->name, channel->name);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300380 cx_clear(channel->dma_ctl, 0x11);
381 cx25821_sram_channel_dump(dev, channel);
382 }
383
384 /* risc1 y */
385 if (status & FLD_VID_DST_RISC1) {
386 spin_lock(&dev->slock);
387 count = cx_read(channel->gpcnt);
Leonid V. Fedorenchik69dfe452011-09-16 14:14:38 +0800388 cx25821_video_wakeup(dev, &dev->channels[channel->i].vidq,
389 count);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300390 spin_unlock(&dev->slock);
391 handled++;
392 }
393
394 /* risc2 y */
395 if (status & 0x10) {
396 dprintk(2, "stopper video\n");
397 spin_lock(&dev->slock);
Leonid V. Fedorenchik788d0f32011-09-16 14:14:39 +0800398 cx25821_restart_video_queue(dev,
399 &dev->channels[channel->i].vidq, channel);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300400 spin_unlock(&dev->slock);
401 handled++;
402 }
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300403 return handled;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300404}
405
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -0300406int cx25821_buffer_setup(struct videobuf_queue *q, unsigned int *count,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300407 unsigned int *size)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300408{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300409 struct cx25821_fh *fh = q->priv_data;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300410
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300411 *size = fh->fmt->depth * fh->width * fh->height >> 3;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300412
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300413 if (0 == *count)
414 *count = 32;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300415
Andreas Bombedab7e312010-03-21 16:02:45 -0300416 if (*size * *count > vid_limit * 1024 * 1024)
417 *count = (vid_limit * 1024 * 1024) / *size;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300418
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300419 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300420}
421
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -0300422int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300423 enum v4l2_field field)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300424{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300425 struct cx25821_fh *fh = q->priv_data;
426 struct cx25821_dev *dev = fh->dev;
427 struct cx25821_buffer *buf =
Leonid V. Fedorenchikf2539812011-10-22 01:43:54 -0300428 container_of(vb, struct cx25821_buffer, vb);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300429 int rc, init_buffer = 0;
Hans Verkuil30fdf032012-04-20 06:26:19 -0300430 u32 line0_offset;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300431 struct videobuf_dmabuf *dma = videobuf_to_dma(&buf->vb);
432 int bpl_local = LINE_SIZE_D1;
Leonid V. Fedorenchik8e4ac072011-09-16 14:14:43 +0800433 int channel_opened = fh->channel_id;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300434
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300435 BUG_ON(NULL == fh->fmt);
436 if (fh->width < 48 || fh->width > 720 ||
437 fh->height < 32 || fh->height > 576)
438 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300439
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300440 buf->vb.size = (fh->width * fh->height * fh->fmt->depth) >> 3;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300441
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300442 if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size)
443 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300444
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300445 if (buf->fmt != fh->fmt ||
446 buf->vb.width != fh->width ||
447 buf->vb.height != fh->height || buf->vb.field != field) {
448 buf->fmt = fh->fmt;
449 buf->vb.width = fh->width;
450 buf->vb.height = fh->height;
451 buf->vb.field = field;
452 init_buffer = 1;
453 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300454
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300455 if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {
456 init_buffer = 1;
457 rc = videobuf_iolock(q, &buf->vb, NULL);
458 if (0 != rc) {
Joe Perches36d89f72010-11-07 17:48:21 -0300459 printk(KERN_DEBUG pr_fmt("videobuf_iolock failed!\n"));
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300460 goto fail;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300461 }
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300462 }
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300463
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300464 dprintk(1, "init_buffer=%d\n", init_buffer);
465
466 if (init_buffer) {
467
468 channel_opened = dev->channel_opened;
Leonid V. Fedorenchik3038f632011-09-16 14:15:14 +0800469 if (channel_opened < 0 || channel_opened > 7)
470 channel_opened = 7;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300471
Leonid V. Fedorenchik8e4ac072011-09-16 14:14:43 +0800472 if (dev->channels[channel_opened].pixel_formats ==
473 PIXEL_FRMT_411)
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300474 buf->bpl = (buf->fmt->depth * buf->vb.width) >> 3;
475 else
476 buf->bpl = (buf->fmt->depth >> 3) * (buf->vb.width);
477
Leonid V. Fedorenchik8e4ac072011-09-16 14:14:43 +0800478 if (dev->channels[channel_opened].pixel_formats ==
479 PIXEL_FRMT_411) {
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300480 bpl_local = buf->bpl;
481 } else {
Leonid V. Fedorenchik8e4ac072011-09-16 14:14:43 +0800482 bpl_local = buf->bpl; /* Default */
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300483
484 if (channel_opened >= 0 && channel_opened <= 7) {
Leonid V. Fedorenchik8e4ac072011-09-16 14:14:43 +0800485 if (dev->channels[channel_opened]
486 .use_cif_resolution) {
Leonid V. Fedorenchikcd52b2c2011-10-22 01:43:53 -0300487 if (dev->tvnorm & V4L2_STD_PAL_BG ||
488 dev->tvnorm & V4L2_STD_PAL_DK)
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300489 bpl_local = 352 << 1;
490 else
Leonid V. Fedorenchik0abfefb2011-10-22 01:43:55 -0300491 bpl_local = dev->channels[
492 channel_opened].
493 cif_width << 1;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300494 }
495 }
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300496 }
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300497
498 switch (buf->vb.field) {
499 case V4L2_FIELD_TOP:
500 cx25821_risc_buffer(dev->pci, &buf->risc,
501 dma->sglist, 0, UNSET,
502 buf->bpl, 0, buf->vb.height);
503 break;
504 case V4L2_FIELD_BOTTOM:
505 cx25821_risc_buffer(dev->pci, &buf->risc,
506 dma->sglist, UNSET, 0,
507 buf->bpl, 0, buf->vb.height);
508 break;
509 case V4L2_FIELD_INTERLACED:
510 /* All other formats are top field first */
511 line0_offset = 0;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300512 dprintk(1, "top field first\n");
513
514 cx25821_risc_buffer(dev->pci, &buf->risc,
515 dma->sglist, line0_offset,
516 bpl_local, bpl_local, bpl_local,
517 buf->vb.height >> 1);
518 break;
519 case V4L2_FIELD_SEQ_TB:
520 cx25821_risc_buffer(dev->pci, &buf->risc,
521 dma->sglist,
522 0, buf->bpl * (buf->vb.height >> 1),
523 buf->bpl, 0, buf->vb.height >> 1);
524 break;
525 case V4L2_FIELD_SEQ_BT:
526 cx25821_risc_buffer(dev->pci, &buf->risc,
527 dma->sglist,
528 buf->bpl * (buf->vb.height >> 1), 0,
529 buf->bpl, 0, buf->vb.height >> 1);
530 break;
531 default:
532 BUG();
533 }
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300534 }
535
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300536 dprintk(2, "[%p/%d] buffer_prep - %dx%d %dbpp \"%s\" - dma=0x%08lx\n",
537 buf, buf->vb.i, fh->width, fh->height, fh->fmt->depth,
538 fh->fmt->name, (unsigned long)buf->risc.dma);
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300539
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300540 buf->vb.state = VIDEOBUF_PREPARED;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -0300541
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300542 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300543
Leonid V. Fedorenchik2748f262011-09-16 14:14:34 +0800544fail:
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300545 cx25821_free_buffer(q, buf);
546 return rc;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300547}
548
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +0800549void cx25821_buffer_release(struct videobuf_queue *q,
550 struct videobuf_buffer *vb)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300551{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300552 struct cx25821_buffer *buf =
Leonid V. Fedorenchikf2539812011-10-22 01:43:54 -0300553 container_of(vb, struct cx25821_buffer, vb);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300554
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300555 cx25821_free_buffer(q, buf);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300556}
557
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300558struct videobuf_queue *get_queue(struct cx25821_fh *fh)
559{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300560 switch (fh->type) {
561 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
562 return &fh->vidq;
563 default:
564 BUG();
565 return NULL;
566 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300567}
568
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -0300569int cx25821_get_resource(struct cx25821_fh *fh, int resource)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300570{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300571 switch (fh->type) {
572 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
573 return resource;
574 default:
575 BUG();
576 return 0;
577 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300578}
579
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -0300580int cx25821_video_mmap(struct file *file, struct vm_area_struct *vma)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300581{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300582 struct cx25821_fh *fh = file->private_data;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300583
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300584 return videobuf_mmap_mapper(get_queue(fh), vma);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300585}
586
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300587
588static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb)
589{
Leonid V. Fedorenchik8e4ac072011-09-16 14:14:43 +0800590 struct cx25821_buffer *buf =
Leonid V. Fedorenchikf2539812011-10-22 01:43:54 -0300591 container_of(vb, struct cx25821_buffer, vb);
Leonid V. Fedorenchike6cf66c2011-09-16 14:14:44 +0800592 struct cx25821_buffer *prev;
593 struct cx25821_fh *fh = vq->priv_data;
594 struct cx25821_dev *dev = fh->dev;
595 struct cx25821_dmaqueue *q = &dev->channels[fh->channel_id].vidq;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300596
Leonid V. Fedorenchike6cf66c2011-09-16 14:14:44 +0800597 /* add jump to stopper */
598 buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP | RISC_IRQ1 | RISC_CNT_INC);
599 buf->risc.jmp[1] = cpu_to_le32(q->stopper.dma);
600 buf->risc.jmp[2] = cpu_to_le32(0); /* bits 63-32 */
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300601
Leonid V. Fedorenchike6cf66c2011-09-16 14:14:44 +0800602 dprintk(2, "jmp to stopper (0x%x)\n", buf->risc.jmp[1]);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300603
Leonid V. Fedorenchike6cf66c2011-09-16 14:14:44 +0800604 if (!list_empty(&q->queued)) {
605 list_add_tail(&buf->vb.queue, &q->queued);
606 buf->vb.state = VIDEOBUF_QUEUED;
607 dprintk(2, "[%p/%d] buffer_queue - append to queued\n", buf,
608 buf->vb.i);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300609
Leonid V. Fedorenchike6cf66c2011-09-16 14:14:44 +0800610 } else if (list_empty(&q->active)) {
611 list_add_tail(&buf->vb.queue, &q->active);
612 cx25821_start_video_dma(dev, q, buf,
613 dev->channels[fh->channel_id].sram_channels);
614 buf->vb.state = VIDEOBUF_ACTIVE;
615 buf->count = q->count++;
616 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
617 dprintk(2, "[%p/%d] buffer_queue - first active, buf cnt = %d, q->count = %d\n",
618 buf, buf->vb.i, buf->count, q->count);
619 } else {
620 prev = list_entry(q->active.prev, struct cx25821_buffer,
621 vb.queue);
622 if (prev->vb.width == buf->vb.width
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -0300623 && prev->vb.height == buf->vb.height
624 && prev->fmt == buf->fmt) {
Leonid V. Fedorenchik8ebbda42011-09-16 14:14:45 +0800625 list_add_tail(&buf->vb.queue, &q->active);
626 buf->vb.state = VIDEOBUF_ACTIVE;
627 buf->count = q->count++;
628 prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300629
Leonid V. Fedorenchik8ebbda42011-09-16 14:14:45 +0800630 /* 64 bit bits 63-32 */
631 prev->risc.jmp[2] = cpu_to_le32(0);
632 dprintk(2, "[%p/%d] buffer_queue - append to active, buf->count=%d\n",
633 buf, buf->vb.i, buf->count);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300634
Leonid V. Fedorenchik8ebbda42011-09-16 14:14:45 +0800635 } else {
636 list_add_tail(&buf->vb.queue, &q->queued);
637 buf->vb.state = VIDEOBUF_QUEUED;
638 dprintk(2, "[%p/%d] buffer_queue - first queued\n", buf,
639 buf->vb.i);
640 }
641 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300642
Leonid V. Fedorenchik8ebbda42011-09-16 14:14:45 +0800643 if (list_empty(&q->active))
644 dprintk(2, "active queue empty!\n");
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300645}
646
647static struct videobuf_queue_ops cx25821_video_qops = {
Leonid V. Fedorenchikfb5f2c82011-09-16 14:14:46 +0800648 .buf_setup = cx25821_buffer_setup,
649 .buf_prepare = cx25821_buffer_prepare,
650 .buf_queue = buffer_queue,
651 .buf_release = cx25821_buffer_release,
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300652};
653
654static int video_open(struct file *file)
655{
Leonid V. Fedorenchikfb5f2c82011-09-16 14:14:46 +0800656 struct video_device *vdev = video_devdata(file);
Hans Verkuila8f35ce2013-04-13 07:07:40 -0300657 struct cx25821_dev *dev = video_drvdata(file);
Leonid V. Fedorenchikfb5f2c82011-09-16 14:14:46 +0800658 struct cx25821_fh *fh;
Leonid V. Fedorenchikfb5f2c82011-09-16 14:14:46 +0800659 enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
660 u32 pix_format;
Hans Verkuila8f35ce2013-04-13 07:07:40 -0300661 int ch_id;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300662
Leonid V. Fedorenchikfb5f2c82011-09-16 14:14:46 +0800663 dprintk(1, "open dev=%s type=%s\n", video_device_node_name(vdev),
664 v4l2_type_names[type]);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300665
Hans Verkuila8f35ce2013-04-13 07:07:40 -0300666 for (ch_id = 0; ch_id < MAX_VID_CHANNEL_NUM - 1; ch_id++)
667 if (dev->channels[ch_id].video_dev == vdev)
668 break;
669
670 /* Can't happen */
671 if (ch_id >= MAX_VID_CHANNEL_NUM - 1)
672 return -ENODEV;
673
Leonid V. Fedorenchikfb5f2c82011-09-16 14:14:46 +0800674 /* allocate + initialize per filehandle data */
675 fh = kzalloc(sizeof(*fh), GFP_KERNEL);
676 if (NULL == fh)
677 return -ENOMEM;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300678
Leonid V. Fedorenchik0bf42c92011-09-16 14:14:48 +0800679 file->private_data = fh;
680 fh->dev = dev;
681 fh->type = type;
682 fh->width = 720;
683 fh->channel_id = ch_id;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300684
Leonid V. Fedorenchik0bf42c92011-09-16 14:14:48 +0800685 if (dev->tvnorm & V4L2_STD_PAL_BG || dev->tvnorm & V4L2_STD_PAL_DK)
686 fh->height = 576;
687 else
688 fh->height = 480;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300689
Leonid V. Fedorenchik0bf42c92011-09-16 14:14:48 +0800690 dev->channel_opened = fh->channel_id;
Leonid V. Fedorenchik3038f632011-09-16 14:15:14 +0800691 if (dev->channels[ch_id].pixel_formats == PIXEL_FRMT_411)
692 pix_format = V4L2_PIX_FMT_Y41P;
693 else
694 pix_format = V4L2_PIX_FMT_YUYV;
Leonid V. Fedorenchik0bf42c92011-09-16 14:14:48 +0800695 fh->fmt = cx25821_format_by_fourcc(pix_format);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300696
Leonid V. Fedorenchik0bf42c92011-09-16 14:14:48 +0800697 v4l2_prio_open(&dev->channels[ch_id].prio, &fh->prio);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300698
Leonid V. Fedorenchik0abfefb2011-10-22 01:43:55 -0300699 videobuf_queue_sg_init(&fh->vidq, &cx25821_video_qops, &dev->pci->dev,
700 &dev->slock, V4L2_BUF_TYPE_VIDEO_CAPTURE,
701 V4L2_FIELD_INTERLACED, sizeof(struct cx25821_buffer),
702 fh, NULL);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300703
Leonid V. Fedorenchik20e8a362011-09-16 14:14:49 +0800704 dprintk(1, "post videobuf_queue_init()\n");
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300705
Leonid V. Fedorenchik20e8a362011-09-16 14:14:49 +0800706 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300707}
708
709static ssize_t video_read(struct file *file, char __user * data, size_t count,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -0300710 loff_t *ppos)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300711{
Leonid V. Fedorenchik20e8a362011-09-16 14:14:49 +0800712 struct cx25821_fh *fh = file->private_data;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300713
Leonid V. Fedorenchik20e8a362011-09-16 14:14:49 +0800714 switch (fh->type) {
715 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
716 if (cx25821_res_locked(fh, RESOURCE_VIDEO0))
717 return -EBUSY;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300718
Leonid V. Fedorenchik20e8a362011-09-16 14:14:49 +0800719 return videobuf_read_one(&fh->vidq, data, count, ppos,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -0300720 file->f_flags & O_NONBLOCK);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300721
Leonid V. Fedorenchik20e8a362011-09-16 14:14:49 +0800722 default:
723 BUG();
724 return 0;
725 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300726}
727
728static unsigned int video_poll(struct file *file,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -0300729 struct poll_table_struct *wait)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300730{
Leonid V. Fedorenchik55c37c02011-09-16 14:14:50 +0800731 struct cx25821_fh *fh = file->private_data;
732 struct cx25821_buffer *buf;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300733
Leonid V. Fedorenchik55c37c02011-09-16 14:14:50 +0800734 if (cx25821_res_check(fh, RESOURCE_VIDEO0)) {
735 /* streaming capture */
736 if (list_empty(&fh->vidq.stream))
737 return POLLERR;
738 buf = list_entry(fh->vidq.stream.next,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -0300739 struct cx25821_buffer, vb.stream);
Leonid V. Fedorenchik55c37c02011-09-16 14:14:50 +0800740 } else {
741 /* read() capture */
742 buf = (struct cx25821_buffer *)fh->vidq.read_buf;
743 if (NULL == buf)
744 return POLLERR;
745 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300746
Leonid V. Fedorenchik55c37c02011-09-16 14:14:50 +0800747 poll_wait(file, &buf->vb.done, wait);
748 if (buf->vb.state == VIDEOBUF_DONE || buf->vb.state == VIDEOBUF_ERROR) {
749 if (buf->vb.state == VIDEOBUF_DONE) {
750 struct cx25821_dev *dev = fh->dev;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300751
Leonid V. Fedorenchik55c37c02011-09-16 14:14:50 +0800752 if (dev && dev->channels[fh->channel_id]
753 .use_cif_resolution) {
754 u8 cam_id = *((char *)buf->vb.baddr + 3);
755 memcpy((char *)buf->vb.baddr,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -0300756 (char *)buf->vb.baddr + (fh->width * 2),
757 (fh->width * 2));
Leonid V. Fedorenchik55c37c02011-09-16 14:14:50 +0800758 *((char *)buf->vb.baddr + 3) = cam_id;
759 }
760 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300761
Leonid V. Fedorenchik55c37c02011-09-16 14:14:50 +0800762 return POLLIN | POLLRDNORM;
763 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300764
Leonid V. Fedorenchik55c37c02011-09-16 14:14:50 +0800765 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300766}
767
768static int video_release(struct file *file)
769{
Leonid V. Fedorenchik21377cd2011-09-16 14:14:51 +0800770 struct cx25821_fh *fh = file->private_data;
771 struct cx25821_dev *dev = fh->dev;
Hans Verkuilbfef0d32013-04-13 06:28:54 -0300772 const struct sram_channel *sram_ch =
773 dev->channels[0].sram_channels;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300774
Leonid V. Fedorenchik21377cd2011-09-16 14:14:51 +0800775 /* stop the risc engine and fifo */
Hans Verkuilbfef0d32013-04-13 06:28:54 -0300776 cx_write(sram_ch->dma_ctl, 0); /* FIFO and RISC disable */
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300777
Leonid V. Fedorenchik21377cd2011-09-16 14:14:51 +0800778 /* stop video capture */
779 if (cx25821_res_check(fh, RESOURCE_VIDEO0)) {
780 videobuf_queue_cancel(&fh->vidq);
781 cx25821_res_free(dev, fh, RESOURCE_VIDEO0);
782 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300783
Leonid V. Fedorenchik21377cd2011-09-16 14:14:51 +0800784 if (fh->vidq.read_buf) {
785 cx25821_buffer_release(&fh->vidq, fh->vidq.read_buf);
786 kfree(fh->vidq.read_buf);
787 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300788
Leonid V. Fedorenchik21377cd2011-09-16 14:14:51 +0800789 videobuf_mmap_free(&fh->vidq);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300790
Leonid V. Fedorenchik21377cd2011-09-16 14:14:51 +0800791 v4l2_prio_close(&dev->channels[fh->channel_id].prio, fh->prio);
792 file->private_data = NULL;
793 kfree(fh);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300794
Leonid V. Fedorenchik21377cd2011-09-16 14:14:51 +0800795 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300796}
797
798static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
799{
Leonid V. Fedorenchik3f3d9e42011-09-16 14:14:52 +0800800 struct cx25821_fh *fh = priv;
801 struct cx25821_dev *dev = fh->dev;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300802
Leonid V. Fedorenchik3f3d9e42011-09-16 14:14:52 +0800803 if (unlikely(fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE))
804 return -EINVAL;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300805
Leonid V. Fedorenchik3f3d9e42011-09-16 14:14:52 +0800806 if (unlikely(i != fh->type))
807 return -EINVAL;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300808
Leonid V. Fedorenchik3f3d9e42011-09-16 14:14:52 +0800809 if (unlikely(!cx25821_res_get(dev, fh, cx25821_get_resource(fh,
810 RESOURCE_VIDEO0))))
811 return -EBUSY;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300812
Leonid V. Fedorenchik3f3d9e42011-09-16 14:14:52 +0800813 return videobuf_streamon(get_queue(fh));
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300814}
815
816static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
817{
Leonid V. Fedorenchikeda59eb2011-09-16 14:14:53 +0800818 struct cx25821_fh *fh = priv;
819 struct cx25821_dev *dev = fh->dev;
820 int err, res;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300821
Leonid V. Fedorenchikeda59eb2011-09-16 14:14:53 +0800822 if (fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
823 return -EINVAL;
824 if (i != fh->type)
825 return -EINVAL;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300826
Leonid V. Fedorenchikeda59eb2011-09-16 14:14:53 +0800827 res = cx25821_get_resource(fh, RESOURCE_VIDEO0);
828 err = videobuf_streamoff(get_queue(fh));
829 if (err < 0)
830 return err;
831 cx25821_res_free(dev, fh, res);
832 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300833}
834
835static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +0800836 struct v4l2_format *f)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300837{
Leonid V. Fedorenchika39bea32011-09-16 14:14:54 +0800838 struct cx25821_fh *fh = priv;
839 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
Hans Verkuilc5e76a62010-08-06 16:18:23 -0300840 struct v4l2_mbus_framefmt mbus_fmt;
Leonid V. Fedorenchika39bea32011-09-16 14:14:54 +0800841 int err;
842 int pix_format = PIXEL_FRMT_422;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300843
Leonid V. Fedorenchika39bea32011-09-16 14:14:54 +0800844 if (fh) {
845 err = v4l2_prio_check(&dev->channels[fh->channel_id].prio,
846 fh->prio);
847 if (0 != err)
848 return err;
849 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300850
Leonid V. Fedorenchik255c0402011-09-16 14:14:55 +0800851 dprintk(2, "%s()\n", __func__);
852 err = cx25821_vidioc_try_fmt_vid_cap(file, priv, f);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300853
Leonid V. Fedorenchik255c0402011-09-16 14:14:55 +0800854 if (0 != err)
855 return err;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300856
Leonid V. Fedorenchik255c0402011-09-16 14:14:55 +0800857 fh->fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
858 fh->vidq.field = f->fmt.pix.field;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300859
Leonid V. Fedorenchik255c0402011-09-16 14:14:55 +0800860 /* check if width and height is valid based on set standard */
861 if (cx25821_is_valid_width(f->fmt.pix.width, dev->tvnorm))
862 fh->width = f->fmt.pix.width;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300863
Leonid V. Fedorenchik255c0402011-09-16 14:14:55 +0800864 if (cx25821_is_valid_height(f->fmt.pix.height, dev->tvnorm))
865 fh->height = f->fmt.pix.height;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300866
Leonid V. Fedorenchik66787622011-09-16 14:14:56 +0800867 if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_Y41P)
868 pix_format = PIXEL_FRMT_411;
869 else if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_YUYV)
870 pix_format = PIXEL_FRMT_422;
871 else
872 return -EINVAL;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300873
Leonid V. Fedorenchik66787622011-09-16 14:14:56 +0800874 cx25821_set_pixel_format(dev, SRAM_CH00, pix_format);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300875
Leonid V. Fedorenchik66787622011-09-16 14:14:56 +0800876 /* check if cif resolution */
877 if (fh->width == 320 || fh->width == 352)
878 dev->channels[fh->channel_id].use_cif_resolution = 1;
879 else
880 dev->channels[fh->channel_id].use_cif_resolution = 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300881
Leonid V. Fedorenchik66787622011-09-16 14:14:56 +0800882 dev->channels[fh->channel_id].cif_width = fh->width;
883 medusa_set_resolution(dev, fh->width, SRAM_CH00);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300884
Joe Perches36d89f72010-11-07 17:48:21 -0300885 dprintk(2, "%s(): width=%d height=%d field=%d\n", __func__, fh->width,
886 fh->height, fh->vidq.field);
Hans Verkuilc5e76a62010-08-06 16:18:23 -0300887 v4l2_fill_mbus_format(&mbus_fmt, &f->fmt.pix, V4L2_MBUS_FMT_FIXED);
888 cx25821_call_all(dev, video, s_mbus_fmt, &mbus_fmt);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300889
Leonid V. Fedorenchik66787622011-09-16 14:14:56 +0800890 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300891}
892
893static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *p)
894{
Leonid V. Fedorenchik02859b62011-09-16 14:14:57 +0800895 int ret_val = 0;
896 struct cx25821_fh *fh = priv;
897 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300898
Leonid V. Fedorenchik02859b62011-09-16 14:14:57 +0800899 ret_val = videobuf_dqbuf(get_queue(fh), p, file->f_flags & O_NONBLOCK);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300900
Leonid V. Fedorenchik02859b62011-09-16 14:14:57 +0800901 p->sequence = dev->channels[fh->channel_id].vidq.count;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300902
Leonid V. Fedorenchik02859b62011-09-16 14:14:57 +0800903 return ret_val;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300904}
905
906static int vidioc_log_status(struct file *file, void *priv)
907{
Leonid V. Fedorenchik02859b62011-09-16 14:14:57 +0800908 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
909 struct cx25821_fh *fh = priv;
Hans Verkuilbfef0d32013-04-13 06:28:54 -0300910 const struct sram_channel *sram_ch =
Hans Verkuil3dd473c2013-04-13 06:06:18 -0300911 dev->channels[fh->channel_id].sram_channels;
Leonid V. Fedorenchik02859b62011-09-16 14:14:57 +0800912 u32 tmp = 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300913
Leonid V. Fedorenchik02859b62011-09-16 14:14:57 +0800914 cx25821_call_all(dev, core, log_status);
915 tmp = cx_read(sram_ch->dma_ctl);
Joe Perches36d89f72010-11-07 17:48:21 -0300916 pr_info("Video input 0 is %s\n",
917 (tmp & 0x11) ? "streaming" : "stopped");
Leonid V. Fedorenchik02859b62011-09-16 14:14:57 +0800918 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300919}
920
921static int vidioc_s_ctrl(struct file *file, void *priv,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -0300922 struct v4l2_control *ctl)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300923{
Leonid V. Fedorenchikf9a81502011-09-16 14:14:58 +0800924 struct cx25821_fh *fh = priv;
925 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
926 int err;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300927
Leonid V. Fedorenchikf9a81502011-09-16 14:14:58 +0800928 if (fh) {
929 err = v4l2_prio_check(&dev->channels[fh->channel_id].prio,
930 fh->prio);
931 if (0 != err)
932 return err;
933 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300934
Leonid V. Fedorenchikf9a81502011-09-16 14:14:58 +0800935 return cx25821_set_control(dev, ctl, fh->channel_id);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -0300936}
937
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +0800938/* VIDEO IOCTLS */
939int cx25821_vidioc_g_fmt_vid_cap(struct file *file, void *priv,
940 struct v4l2_format *f)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300941{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300942 struct cx25821_fh *fh = priv;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300943
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300944 f->fmt.pix.width = fh->width;
945 f->fmt.pix.height = fh->height;
946 f->fmt.pix.field = fh->vidq.field;
947 f->fmt.pix.pixelformat = fh->fmt->fourcc;
948 f->fmt.pix.bytesperline = (f->fmt.pix.width * fh->fmt->depth) >> 3;
949 f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300950
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300951 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300952}
953
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +0800954int cx25821_vidioc_try_fmt_vid_cap(struct file *file, void *priv,
955 struct v4l2_format *f)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300956{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300957 struct cx25821_fmt *fmt;
958 enum v4l2_field field;
959 unsigned int maxw, maxh;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300960
Mauro Carvalho Chehaba757ee22010-12-02 01:57:03 -0200961 fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300962 if (NULL == fmt)
963 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300964
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300965 field = f->fmt.pix.field;
966 maxw = 720;
967 maxh = 576;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300968
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300969 if (V4L2_FIELD_ANY == field) {
Leonid V. Fedorenchik3038f632011-09-16 14:15:14 +0800970 if (f->fmt.pix.height > maxh / 2)
971 field = V4L2_FIELD_INTERLACED;
972 else
973 field = V4L2_FIELD_TOP;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300974 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300975
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300976 switch (field) {
977 case V4L2_FIELD_TOP:
978 case V4L2_FIELD_BOTTOM:
979 maxh = maxh / 2;
980 break;
981 case V4L2_FIELD_INTERLACED:
982 break;
983 default:
984 return -EINVAL;
985 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300986
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -0300987 f->fmt.pix.field = field;
988 if (f->fmt.pix.height < 32)
989 f->fmt.pix.height = 32;
990 if (f->fmt.pix.height > maxh)
991 f->fmt.pix.height = maxh;
992 if (f->fmt.pix.width < 48)
993 f->fmt.pix.width = 48;
994 if (f->fmt.pix.width > maxw)
995 f->fmt.pix.width = maxw;
996 f->fmt.pix.width &= ~0x03;
997 f->fmt.pix.bytesperline = (f->fmt.pix.width * fmt->depth) >> 3;
998 f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -0300999
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001000 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001001}
1002
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +08001003int cx25821_vidioc_querycap(struct file *file, void *priv,
1004 struct v4l2_capability *cap)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001005{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001006 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
Hans Verkuil3dd473c2013-04-13 06:06:18 -03001007 struct cx25821_fh *fh = priv;
1008 const u32 cap_input = V4L2_CAP_VIDEO_CAPTURE |
1009 V4L2_CAP_READWRITE | V4L2_CAP_STREAMING;
1010 const u32 cap_output = V4L2_CAP_VIDEO_OUTPUT;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001011
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001012 strcpy(cap->driver, "cx25821");
1013 strlcpy(cap->card, cx25821_boards[dev->board].name, sizeof(cap->card));
1014 sprintf(cap->bus_info, "PCIe:%s", pci_name(dev->pci));
Hans Verkuil3dd473c2013-04-13 06:06:18 -03001015 if (fh->channel_id >= VID_CHANNEL_NUM)
1016 cap->device_caps = cap_output;
1017 else
1018 cap->device_caps = cap_input;
1019 cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001020 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001021}
1022
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001023int cx25821_vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001024 struct v4l2_fmtdesc *f)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001025{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001026 if (unlikely(f->index >= ARRAY_SIZE(formats)))
1027 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001028
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001029 strlcpy(f->description, formats[f->index].name, sizeof(f->description));
1030 f->pixelformat = formats[f->index].fourcc;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001031
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001032 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001033}
1034
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +08001035int cx25821_vidioc_reqbufs(struct file *file, void *priv,
1036 struct v4l2_requestbuffers *p)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001037{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001038 struct cx25821_fh *fh = priv;
1039 return videobuf_reqbufs(get_queue(fh), p);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001040}
1041
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +08001042int cx25821_vidioc_querybuf(struct file *file, void *priv,
1043 struct v4l2_buffer *p)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001044{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001045 struct cx25821_fh *fh = priv;
1046 return videobuf_querybuf(get_queue(fh), p);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001047}
1048
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001049int cx25821_vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *p)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001050{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001051 struct cx25821_fh *fh = priv;
1052 return videobuf_qbuf(get_queue(fh), p);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001053}
1054
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001055int cx25821_vidioc_g_priority(struct file *file, void *f, enum v4l2_priority *p)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001056{
1057 struct cx25821_dev *dev = ((struct cx25821_fh *)f)->dev;
Leonid V. Fedorenchik70e7f142011-09-16 14:14:59 +08001058 struct cx25821_fh *fh = f;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001059
Leonid V. Fedorenchik70e7f142011-09-16 14:14:59 +08001060 *p = v4l2_prio_max(&dev->channels[fh->channel_id].prio);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001061
1062 return 0;
1063}
1064
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +08001065int cx25821_vidioc_s_priority(struct file *file, void *f,
1066 enum v4l2_priority prio)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001067{
1068 struct cx25821_fh *fh = f;
1069 struct cx25821_dev *dev = ((struct cx25821_fh *)f)->dev;
1070
Leonid V. Fedorenchik70e7f142011-09-16 14:14:59 +08001071 return v4l2_prio_change(&dev->channels[fh->channel_id].prio, &fh->prio,
1072 prio);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001073}
1074
Hans Verkuil18c73af2013-04-13 05:50:18 -03001075int cx25821_vidioc_g_std(struct file *file, void *priv, v4l2_std_id *tvnorms)
1076{
1077 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1078
1079 *tvnorms = dev->tvnorm;
1080 return 0;
1081}
1082
Hans Verkuil314527a2013-03-15 06:10:40 -03001083int cx25821_vidioc_s_std(struct file *file, void *priv, v4l2_std_id tvnorms)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001084{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001085 struct cx25821_fh *fh = priv;
1086 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1087 int err;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001088
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001089 dprintk(1, "%s()\n", __func__);
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001090
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001091 if (fh) {
Leonid V. Fedorenchik70e7f142011-09-16 14:14:59 +08001092 err = v4l2_prio_check(&dev->channels[fh->channel_id].prio,
1093 fh->prio);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001094 if (0 != err)
1095 return err;
1096 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001097
Hans Verkuil314527a2013-03-15 06:10:40 -03001098 if (dev->tvnorm == tvnorms)
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001099 return 0;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001100
1101 mutex_lock(&dev->lock);
Hans Verkuil314527a2013-03-15 06:10:40 -03001102 cx25821_set_tvnorm(dev, tvnorms);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001103 mutex_unlock(&dev->lock);
1104
1105 medusa_set_videostandard(dev);
1106
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001107 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001108}
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001109
1110int cx25821_enum_input(struct cx25821_dev *dev, struct v4l2_input *i)
1111{
Leonid V. Fedorenchik70e7f142011-09-16 14:14:59 +08001112 static const char * const iname[] = {
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001113 [CX25821_VMUX_COMPOSITE] = "Composite",
1114 [CX25821_VMUX_SVIDEO] = "S-Video",
1115 [CX25821_VMUX_DEBUG] = "for debug only",
1116 };
1117 unsigned int n;
1118 dprintk(1, "%s()\n", __func__);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001119
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001120 n = i->index;
Dan Carpentered300132009-12-28 19:00:24 +02001121 if (n >= 2)
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001122 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001123
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001124 if (0 == INPUT(n)->type)
1125 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001126
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001127 i->type = V4L2_INPUT_TYPE_CAMERA;
1128 strcpy(i->name, iname[INPUT(n)->type]);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001129
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001130 i->std = CX25821_NORMS;
1131 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001132}
1133
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +08001134int cx25821_vidioc_enum_input(struct file *file, void *priv,
1135 struct v4l2_input *i)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001136{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001137 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1138 dprintk(1, "%s()\n", __func__);
1139 return cx25821_enum_input(dev, i);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001140}
1141
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001142int cx25821_vidioc_g_input(struct file *file, void *priv, unsigned int *i)
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001143{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001144 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001145
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001146 *i = dev->input;
Joe Perches36d89f72010-11-07 17:48:21 -03001147 dprintk(1, "%s(): returns %d\n", __func__, *i);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001148 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001149}
1150
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001151int cx25821_vidioc_s_input(struct file *file, void *priv, unsigned int i)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001152{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001153 struct cx25821_fh *fh = priv;
1154 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1155 int err;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001156
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001157 dprintk(1, "%s(%d)\n", __func__, i);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001158
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001159 if (fh) {
Leonid V. Fedorenchik70e7f142011-09-16 14:14:59 +08001160 err = v4l2_prio_check(&dev->channels[fh->channel_id].prio,
1161 fh->prio);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001162 if (0 != err)
1163 return err;
1164 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001165
Dan Carpenter567a23f2011-10-13 02:41:41 -03001166 if (i >= CX25821_NR_INPUT) {
Joe Perches36d89f72010-11-07 17:48:21 -03001167 dprintk(1, "%s(): -EINVAL\n", __func__);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001168 return -EINVAL;
1169 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001170
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001171 mutex_lock(&dev->lock);
1172 cx25821_video_mux(dev, i);
1173 mutex_unlock(&dev->lock);
1174 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001175}
1176
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001177#ifdef CONFIG_VIDEO_ADV_DEBUG
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001178int cx25821_vidioc_g_register(struct file *file, void *fh,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001179 struct v4l2_dbg_register *reg)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001180{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001181 struct cx25821_dev *dev = ((struct cx25821_fh *)fh)->dev;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001182
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001183 if (!v4l2_chip_match_host(&reg->match))
1184 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001185
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001186 cx25821_call_all(dev, core, g_register, reg);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001187
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001188 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001189}
1190
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001191int cx25821_vidioc_s_register(struct file *file, void *fh,
Hans Verkuil977ba3b2013-03-24 08:28:46 -03001192 const struct v4l2_dbg_register *reg)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001193{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001194 struct cx25821_dev *dev = ((struct cx25821_fh *)fh)->dev;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001195
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001196 if (!v4l2_chip_match_host(&reg->match))
1197 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001198
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001199 cx25821_call_all(dev, core, s_register, reg);
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001200
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001201 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001202}
1203
1204#endif
1205
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001206/*****************************************************************************/
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001207static const struct v4l2_queryctrl no_ctl = {
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001208 .name = "42",
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001209 .flags = V4L2_CTRL_FLAG_DISABLED,
1210};
1211
1212static struct v4l2_queryctrl cx25821_ctls[] = {
1213 /* --- video --- */
1214 {
Leonid V. Fedorenchikf2539812011-10-22 01:43:54 -03001215 .id = V4L2_CID_BRIGHTNESS,
1216 .name = "Brightness",
1217 .minimum = 0,
1218 .maximum = 10000,
1219 .step = 1,
1220 .default_value = 6200,
1221 .type = V4L2_CTRL_TYPE_INTEGER,
1222 }, {
1223 .id = V4L2_CID_CONTRAST,
1224 .name = "Contrast",
1225 .minimum = 0,
1226 .maximum = 10000,
1227 .step = 1,
1228 .default_value = 5000,
1229 .type = V4L2_CTRL_TYPE_INTEGER,
1230 }, {
1231 .id = V4L2_CID_SATURATION,
1232 .name = "Saturation",
1233 .minimum = 0,
1234 .maximum = 10000,
1235 .step = 1,
1236 .default_value = 5000,
1237 .type = V4L2_CTRL_TYPE_INTEGER,
1238 }, {
1239 .id = V4L2_CID_HUE,
1240 .name = "Hue",
1241 .minimum = 0,
1242 .maximum = 10000,
1243 .step = 1,
1244 .default_value = 5000,
1245 .type = V4L2_CTRL_TYPE_INTEGER,
1246 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001247};
1248static const int CX25821_CTLS = ARRAY_SIZE(cx25821_ctls);
1249
1250static int cx25821_ctrl_query(struct v4l2_queryctrl *qctrl)
1251{
1252 int i;
1253
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001254 if (qctrl->id < V4L2_CID_BASE || qctrl->id >= V4L2_CID_LASTP1)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001255 return -EINVAL;
1256 for (i = 0; i < CX25821_CTLS; i++)
1257 if (cx25821_ctls[i].id == qctrl->id)
1258 break;
1259 if (i == CX25821_CTLS) {
1260 *qctrl = no_ctl;
1261 return 0;
1262 }
1263 *qctrl = cx25821_ctls[i];
1264 return 0;
1265}
1266
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001267int cx25821_vidioc_queryctrl(struct file *file, void *priv,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001268 struct v4l2_queryctrl *qctrl)
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001269{
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001270 return cx25821_ctrl_query(qctrl);
1271}
1272
1273/* ------------------------------------------------------------------ */
1274/* VIDEO CTRL IOCTLS */
1275
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001276static const struct v4l2_queryctrl *ctrl_by_id(unsigned int id)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001277{
1278 unsigned int i;
1279
1280 for (i = 0; i < CX25821_CTLS; i++)
1281 if (cx25821_ctls[i].id == id)
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001282 return cx25821_ctls + i;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001283 return NULL;
1284}
1285
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +08001286int cx25821_vidioc_g_ctrl(struct file *file, void *priv,
1287 struct v4l2_control *ctl)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001288{
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001289 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
Leonid V. Fedorenchike0b871b2011-09-16 14:15:00 +08001290 struct cx25821_fh *fh = priv;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001291
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001292 const struct v4l2_queryctrl *ctrl;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001293
1294 ctrl = ctrl_by_id(ctl->id);
1295
1296 if (NULL == ctrl)
1297 return -EINVAL;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001298 switch (ctl->id) {
1299 case V4L2_CID_BRIGHTNESS:
Leonid V. Fedorenchike0b871b2011-09-16 14:15:00 +08001300 ctl->value = dev->channels[fh->channel_id].ctl_bright;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001301 break;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001302 case V4L2_CID_HUE:
Leonid V. Fedorenchike0b871b2011-09-16 14:15:00 +08001303 ctl->value = dev->channels[fh->channel_id].ctl_hue;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001304 break;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001305 case V4L2_CID_CONTRAST:
Leonid V. Fedorenchike0b871b2011-09-16 14:15:00 +08001306 ctl->value = dev->channels[fh->channel_id].ctl_contrast;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001307 break;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001308 case V4L2_CID_SATURATION:
Leonid V. Fedorenchike0b871b2011-09-16 14:15:00 +08001309 ctl->value = dev->channels[fh->channel_id].ctl_saturation;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001310 break;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001311 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001312 return 0;
1313}
1314
1315int cx25821_set_control(struct cx25821_dev *dev,
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001316 struct v4l2_control *ctl, int chan_num)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001317{
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001318 int err;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001319 const struct v4l2_queryctrl *ctrl;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001320
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001321 err = -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001322
1323 ctrl = ctrl_by_id(ctl->id);
1324
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001325 if (NULL == ctrl)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001326 return err;
1327
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001328 switch (ctrl->type) {
1329 case V4L2_CTRL_TYPE_BOOLEAN:
1330 case V4L2_CTRL_TYPE_MENU:
1331 case V4L2_CTRL_TYPE_INTEGER:
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001332 if (ctl->value < ctrl->minimum)
1333 ctl->value = ctrl->minimum;
1334 if (ctl->value > ctrl->maximum)
1335 ctl->value = ctrl->maximum;
1336 break;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001337 default:
1338 /* nothing */ ;
Joe Perches95cd17c2011-04-10 14:31:35 -07001339 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001340
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001341 switch (ctl->id) {
1342 case V4L2_CID_BRIGHTNESS:
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001343 dev->channels[chan_num].ctl_bright = ctl->value;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001344 medusa_set_brightness(dev, ctl->value, chan_num);
1345 break;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001346 case V4L2_CID_HUE:
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001347 dev->channels[chan_num].ctl_hue = ctl->value;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001348 medusa_set_hue(dev, ctl->value, chan_num);
1349 break;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001350 case V4L2_CID_CONTRAST:
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001351 dev->channels[chan_num].ctl_contrast = ctl->value;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001352 medusa_set_contrast(dev, ctl->value, chan_num);
1353 break;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001354 case V4L2_CID_SATURATION:
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001355 dev->channels[chan_num].ctl_saturation = ctl->value;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001356 medusa_set_saturation(dev, ctl->value, chan_num);
1357 break;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001358 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001359
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001360 err = 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001361
1362 return err;
1363}
1364
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001365static void cx25821_init_controls(struct cx25821_dev *dev, int chan_num)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001366{
1367 struct v4l2_control ctrl;
1368 int i;
1369 for (i = 0; i < CX25821_CTLS; i++) {
1370 ctrl.id = cx25821_ctls[i].id;
1371 ctrl.value = cx25821_ctls[i].default_value;
1372
1373 cx25821_set_control(dev, &ctrl, chan_num);
1374 }
1375}
1376
Leonid V. Fedorenchikc1e6e242011-09-16 14:14:35 +08001377int cx25821_vidioc_cropcap(struct file *file, void *priv,
1378 struct v4l2_cropcap *cropcap)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001379{
1380 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001381
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001382 if (cropcap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
1383 return -EINVAL;
Leonid V. Fedorenchika1937e12011-10-22 01:43:51 -03001384 cropcap->bounds.top = 0;
1385 cropcap->bounds.left = 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001386 cropcap->bounds.width = 720;
1387 cropcap->bounds.height = dev->tvnorm == V4L2_STD_PAL_BG ? 576 : 480;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001388 cropcap->pixelaspect.numerator =
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001389 dev->tvnorm == V4L2_STD_PAL_BG ? 59 : 10;
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001390 cropcap->pixelaspect.denominator =
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001391 dev->tvnorm == V4L2_STD_PAL_BG ? 54 : 11;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001392 cropcap->defrect = cropcap->bounds;
1393 return 0;
1394}
1395
Hans Verkuil4f9965942012-09-05 05:10:48 -03001396int cx25821_vidioc_s_crop(struct file *file, void *priv, const struct v4l2_crop *crop)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001397{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001398 struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1399 struct cx25821_fh *fh = priv;
1400 int err;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001401
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001402 if (fh) {
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001403 err = v4l2_prio_check(&dev->channels[fh->channel_id].prio,
1404 fh->prio);
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001405 if (0 != err)
1406 return err;
1407 }
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001408 /* cx25821_vidioc_s_crop not supported */
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001409 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001410}
1411
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001412int cx25821_vidioc_g_crop(struct file *file, void *priv, struct v4l2_crop *crop)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001413{
Leonid V. Fedorenchik8a911ed2011-09-16 14:15:01 +08001414 /* cx25821_vidioc_g_crop not supported */
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001415 return -EINVAL;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001416}
1417
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001418int cx25821_is_valid_width(u32 width, v4l2_std_id tvnorm)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001419{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001420 if (tvnorm == V4L2_STD_PAL_BG) {
1421 if (width == 352 || width == 720)
1422 return 1;
1423 else
1424 return 0;
1425 }
Mauro Carvalho Chehabbb4c9a72009-09-13 11:25:45 -03001426
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001427 if (tvnorm == V4L2_STD_NTSC_M) {
1428 if (width == 320 || width == 352 || width == 720)
1429 return 1;
1430 else
1431 return 0;
1432 }
1433 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001434}
1435
Mauro Carvalho Chehabf2466d62010-03-24 16:33:40 -03001436int cx25821_is_valid_height(u32 height, v4l2_std_id tvnorm)
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001437{
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001438 if (tvnorm == V4L2_STD_PAL_BG) {
1439 if (height == 576 || height == 288)
1440 return 1;
1441 else
1442 return 0;
1443 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001444
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001445 if (tvnorm == V4L2_STD_NTSC_M) {
1446 if (height == 480 || height == 240)
1447 return 1;
1448 else
1449 return 0;
1450 }
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001451
Mauro Carvalho Chehab1a9fc852009-09-13 11:30:11 -03001452 return 0;
Mauro Carvalho Chehab02b20b02009-09-15 11:33:54 -03001453}
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001454
1455static long video_ioctl_upstream9(struct file *file, unsigned int cmd,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -03001456 unsigned long arg)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001457{
Leonid V. Fedorenchik75965b82011-09-16 14:15:02 +08001458 struct cx25821_fh *fh = file->private_data;
1459 struct cx25821_dev *dev = fh->dev;
1460 int command = 0;
1461 struct upstream_user_struct *data_from_user;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001462
Leonid V. Fedorenchik75965b82011-09-16 14:15:02 +08001463 data_from_user = (struct upstream_user_struct *)arg;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001464
Joe Perches36d89f72010-11-07 17:48:21 -03001465 if (!data_from_user) {
1466 pr_err("%s(): Upstream data is INVALID. Returning\n", __func__);
1467 return 0;
1468 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001469
Leonid V. Fedorenchik75965b82011-09-16 14:15:02 +08001470 command = data_from_user->command;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001471
Leonid V. Fedorenchik75965b82011-09-16 14:15:02 +08001472 if (command != UPSTREAM_START_VIDEO && command != UPSTREAM_STOP_VIDEO)
1473 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001474
Leonid V. Fedorenchik75965b82011-09-16 14:15:02 +08001475 dev->input_filename = data_from_user->input_filename;
1476 dev->input_audiofilename = data_from_user->input_filename;
1477 dev->vid_stdname = data_from_user->vid_stdname;
1478 dev->pixel_format = data_from_user->pixel_format;
1479 dev->channel_select = data_from_user->channel_select;
1480 dev->command = data_from_user->command;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001481
Leonid V. Fedorenchik6f87cc62011-09-16 14:15:03 +08001482 switch (command) {
1483 case UPSTREAM_START_VIDEO:
1484 cx25821_start_upstream_video_ch1(dev, data_from_user);
1485 break;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001486
Leonid V. Fedorenchik6f87cc62011-09-16 14:15:03 +08001487 case UPSTREAM_STOP_VIDEO:
1488 cx25821_stop_upstream_video_ch1(dev);
1489 break;
1490 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001491
Leonid V. Fedorenchik6f87cc62011-09-16 14:15:03 +08001492 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001493}
1494
1495static long video_ioctl_upstream10(struct file *file, unsigned int cmd,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -03001496 unsigned long arg)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001497{
Leonid V. Fedorenchik43be3822011-09-16 14:15:04 +08001498 struct cx25821_fh *fh = file->private_data;
1499 struct cx25821_dev *dev = fh->dev;
1500 int command = 0;
1501 struct upstream_user_struct *data_from_user;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001502
Leonid V. Fedorenchik43be3822011-09-16 14:15:04 +08001503 data_from_user = (struct upstream_user_struct *)arg;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001504
Joe Perches36d89f72010-11-07 17:48:21 -03001505 if (!data_from_user) {
1506 pr_err("%s(): Upstream data is INVALID. Returning\n", __func__);
1507 return 0;
1508 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001509
Leonid V. Fedorenchik43be3822011-09-16 14:15:04 +08001510 command = data_from_user->command;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001511
Leonid V. Fedorenchik43be3822011-09-16 14:15:04 +08001512 if (command != UPSTREAM_START_VIDEO && command != UPSTREAM_STOP_VIDEO)
1513 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001514
Leonid V. Fedorenchik43be3822011-09-16 14:15:04 +08001515 dev->input_filename_ch2 = data_from_user->input_filename;
1516 dev->input_audiofilename = data_from_user->input_filename;
1517 dev->vid_stdname_ch2 = data_from_user->vid_stdname;
1518 dev->pixel_format_ch2 = data_from_user->pixel_format;
1519 dev->channel_select_ch2 = data_from_user->channel_select;
1520 dev->command_ch2 = data_from_user->command;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001521
Leonid V. Fedorenchikf9ef6be2011-09-16 14:15:05 +08001522 switch (command) {
1523 case UPSTREAM_START_VIDEO:
1524 cx25821_start_upstream_video_ch2(dev, data_from_user);
1525 break;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001526
Leonid V. Fedorenchikf9ef6be2011-09-16 14:15:05 +08001527 case UPSTREAM_STOP_VIDEO:
1528 cx25821_stop_upstream_video_ch2(dev);
1529 break;
1530 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001531
Leonid V. Fedorenchikf9ef6be2011-09-16 14:15:05 +08001532 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001533}
1534
1535static long video_ioctl_upstream11(struct file *file, unsigned int cmd,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -03001536 unsigned long arg)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001537{
Leonid V. Fedorenchik5e644012011-09-16 14:15:06 +08001538 struct cx25821_fh *fh = file->private_data;
1539 struct cx25821_dev *dev = fh->dev;
1540 int command = 0;
1541 struct upstream_user_struct *data_from_user;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001542
Leonid V. Fedorenchik5e644012011-09-16 14:15:06 +08001543 data_from_user = (struct upstream_user_struct *)arg;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001544
Joe Perches36d89f72010-11-07 17:48:21 -03001545 if (!data_from_user) {
1546 pr_err("%s(): Upstream data is INVALID. Returning\n", __func__);
1547 return 0;
1548 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001549
Leonid V. Fedorenchik5e644012011-09-16 14:15:06 +08001550 command = data_from_user->command;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001551
Leonid V. Fedorenchik5e644012011-09-16 14:15:06 +08001552 if (command != UPSTREAM_START_AUDIO && command != UPSTREAM_STOP_AUDIO)
1553 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001554
Leonid V. Fedorenchik5e644012011-09-16 14:15:06 +08001555 dev->input_filename = data_from_user->input_filename;
1556 dev->input_audiofilename = data_from_user->input_filename;
1557 dev->vid_stdname = data_from_user->vid_stdname;
1558 dev->pixel_format = data_from_user->pixel_format;
1559 dev->channel_select = data_from_user->channel_select;
1560 dev->command = data_from_user->command;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001561
Leonid V. Fedorenchik5e644012011-09-16 14:15:06 +08001562 switch (command) {
1563 case UPSTREAM_START_AUDIO:
1564 cx25821_start_upstream_audio(dev, data_from_user);
1565 break;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001566
Leonid V. Fedorenchik5e644012011-09-16 14:15:06 +08001567 case UPSTREAM_STOP_AUDIO:
1568 cx25821_stop_upstream_audio(dev);
1569 break;
1570 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001571
Leonid V. Fedorenchik5e644012011-09-16 14:15:06 +08001572 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001573}
1574
1575static long video_ioctl_set(struct file *file, unsigned int cmd,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -03001576 unsigned long arg)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001577{
Leonid V. Fedorenchik16a81ef2011-09-16 14:15:07 +08001578 struct cx25821_fh *fh = file->private_data;
1579 struct cx25821_dev *dev = fh->dev;
1580 struct downstream_user_struct *data_from_user;
1581 int command;
1582 int width = 720;
Leonid V. Fedorenchik4a33b6f2011-10-22 01:43:52 -03001583 int selected_channel = 0;
1584 int pix_format = 0;
1585 int i = 0;
1586 int cif_enable = 0;
1587 int cif_width = 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001588
Leonid V. Fedorenchik16a81ef2011-09-16 14:15:07 +08001589 data_from_user = (struct downstream_user_struct *)arg;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001590
Joe Perches36d89f72010-11-07 17:48:21 -03001591 if (!data_from_user) {
1592 pr_err("%s(): User data is INVALID. Returning\n", __func__);
1593 return 0;
1594 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001595
Leonid V. Fedorenchik16a81ef2011-09-16 14:15:07 +08001596 command = data_from_user->command;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001597
Leonid V. Fedorenchik16a81ef2011-09-16 14:15:07 +08001598 if (command != SET_VIDEO_STD && command != SET_PIXEL_FORMAT
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -03001599 && command != ENABLE_CIF_RESOLUTION && command != REG_READ
1600 && command != REG_WRITE && command != MEDUSA_READ
1601 && command != MEDUSA_WRITE) {
Leonid V. Fedorenchik12fe7462011-09-16 14:15:08 +08001602 return 0;
1603 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001604
Leonid V. Fedorenchik12fe7462011-09-16 14:15:08 +08001605 switch (command) {
1606 case SET_VIDEO_STD:
Leonid V. Fedorenchik3038f632011-09-16 14:15:14 +08001607 if (!strcmp(data_from_user->vid_stdname, "PAL"))
1608 dev->tvnorm = V4L2_STD_PAL_BG;
1609 else
1610 dev->tvnorm = V4L2_STD_NTSC_M;
Leonid V. Fedorenchik12fe7462011-09-16 14:15:08 +08001611 medusa_set_videostandard(dev);
1612 break;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001613
Leonid V. Fedorenchik12fe7462011-09-16 14:15:08 +08001614 case SET_PIXEL_FORMAT:
1615 selected_channel = data_from_user->decoder_select;
1616 pix_format = data_from_user->pixel_format;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001617
Leonid V. Fedorenchik12fe7462011-09-16 14:15:08 +08001618 if (!(selected_channel <= 7 && selected_channel >= 0)) {
1619 selected_channel -= 4;
1620 selected_channel = selected_channel % 8;
1621 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001622
Leonid V. Fedorenchik12fe7462011-09-16 14:15:08 +08001623 if (selected_channel >= 0)
1624 cx25821_set_pixel_format(dev, selected_channel,
Mauro Carvalho Chehab3e9442c2010-07-04 15:37:05 -03001625 pix_format);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001626
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001627 break;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001628
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001629 case ENABLE_CIF_RESOLUTION:
1630 selected_channel = data_from_user->decoder_select;
1631 cif_enable = data_from_user->cif_resolution_enable;
1632 cif_width = data_from_user->cif_width;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001633
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001634 if (cif_enable) {
1635 if (dev->tvnorm & V4L2_STD_PAL_BG
Leonid V. Fedorenchik3038f632011-09-16 14:15:14 +08001636 || dev->tvnorm & V4L2_STD_PAL_DK) {
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001637 width = 352;
Leonid V. Fedorenchik3038f632011-09-16 14:15:14 +08001638 } else {
1639 width = cif_width;
1640 if (cif_width != 320 && cif_width != 352)
1641 width = 320;
1642 }
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001643 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001644
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001645 if (!(selected_channel <= 7 && selected_channel >= 0)) {
1646 selected_channel -= 4;
1647 selected_channel = selected_channel % 8;
1648 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001649
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001650 if (selected_channel <= 7 && selected_channel >= 0) {
Leonid V. Fedorenchik0abfefb2011-10-22 01:43:55 -03001651 dev->channels[selected_channel].use_cif_resolution =
1652 cif_enable;
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001653 dev->channels[selected_channel].cif_width = width;
1654 } else {
1655 for (i = 0; i < VID_CHANNEL_NUM; i++) {
1656 dev->channels[i].use_cif_resolution =
1657 cif_enable;
1658 dev->channels[i].cif_width = width;
1659 }
1660 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001661
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001662 medusa_set_resolution(dev, width, selected_channel);
1663 break;
1664 case REG_READ:
1665 data_from_user->reg_data = cx_read(data_from_user->reg_address);
1666 break;
1667 case REG_WRITE:
1668 cx_write(data_from_user->reg_address, data_from_user->reg_data);
1669 break;
1670 case MEDUSA_READ:
Hans Verkuil30fdf032012-04-20 06:26:19 -03001671 cx25821_i2c_read(&dev->i2c_bus[0],
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001672 (u16) data_from_user->reg_address,
1673 &data_from_user->reg_data);
1674 break;
1675 case MEDUSA_WRITE:
1676 cx25821_i2c_write(&dev->i2c_bus[0],
1677 (u16) data_from_user->reg_address,
1678 data_from_user->reg_data);
1679 break;
1680 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001681
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001682 return 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001683}
1684
1685static long cx25821_video_ioctl(struct file *file,
Leonid V. Fedorenchik2a517492011-09-16 14:15:09 +08001686 unsigned int cmd, unsigned long arg)
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001687{
Leonid V. Fedorenchik1316b632011-10-22 01:43:50 -03001688 int ret = 0;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001689
Leonid V. Fedorenchik1316b632011-10-22 01:43:50 -03001690 struct cx25821_fh *fh = file->private_data;
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001691
Leonid V. Fedorenchikd2a167c2011-09-16 14:15:10 +08001692 /* check to see if it's the video upstream */
1693 if (fh->channel_id == SRAM_CH09) {
1694 ret = video_ioctl_upstream9(file, cmd, arg);
1695 return ret;
1696 } else if (fh->channel_id == SRAM_CH10) {
1697 ret = video_ioctl_upstream10(file, cmd, arg);
1698 return ret;
1699 } else if (fh->channel_id == SRAM_CH11) {
1700 ret = video_ioctl_upstream11(file, cmd, arg);
1701 ret = video_ioctl_set(file, cmd, arg);
1702 return ret;
1703 }
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001704
Leonid V. Fedorenchikd2a167c2011-09-16 14:15:10 +08001705 return video_ioctl2(file, cmd, arg);
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001706}
1707
1708/* exported stuff */
1709static const struct v4l2_file_operations video_fops = {
Leonid V. Fedorenchikfa7ce1f2011-09-16 14:15:11 +08001710 .owner = THIS_MODULE,
1711 .open = video_open,
1712 .release = video_release,
1713 .read = video_read,
1714 .poll = video_poll,
1715 .mmap = cx25821_video_mmap,
1716 .ioctl = cx25821_video_ioctl,
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001717};
1718
1719static const struct v4l2_ioctl_ops video_ioctl_ops = {
Leonid V. Fedorenchikfa7ce1f2011-09-16 14:15:11 +08001720 .vidioc_querycap = cx25821_vidioc_querycap,
1721 .vidioc_enum_fmt_vid_cap = cx25821_vidioc_enum_fmt_vid_cap,
1722 .vidioc_g_fmt_vid_cap = cx25821_vidioc_g_fmt_vid_cap,
1723 .vidioc_try_fmt_vid_cap = cx25821_vidioc_try_fmt_vid_cap,
1724 .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
1725 .vidioc_reqbufs = cx25821_vidioc_reqbufs,
1726 .vidioc_querybuf = cx25821_vidioc_querybuf,
1727 .vidioc_qbuf = cx25821_vidioc_qbuf,
1728 .vidioc_dqbuf = vidioc_dqbuf,
Hans Verkuil18c73af2013-04-13 05:50:18 -03001729 .vidioc_g_std = cx25821_vidioc_g_std,
Leonid V. Fedorenchikfa7ce1f2011-09-16 14:15:11 +08001730 .vidioc_s_std = cx25821_vidioc_s_std,
Leonid V. Fedorenchikfa7ce1f2011-09-16 14:15:11 +08001731 .vidioc_cropcap = cx25821_vidioc_cropcap,
1732 .vidioc_s_crop = cx25821_vidioc_s_crop,
1733 .vidioc_g_crop = cx25821_vidioc_g_crop,
1734 .vidioc_enum_input = cx25821_vidioc_enum_input,
1735 .vidioc_g_input = cx25821_vidioc_g_input,
1736 .vidioc_s_input = cx25821_vidioc_s_input,
1737 .vidioc_g_ctrl = cx25821_vidioc_g_ctrl,
1738 .vidioc_s_ctrl = vidioc_s_ctrl,
1739 .vidioc_queryctrl = cx25821_vidioc_queryctrl,
1740 .vidioc_streamon = vidioc_streamon,
1741 .vidioc_streamoff = vidioc_streamoff,
1742 .vidioc_log_status = vidioc_log_status,
1743 .vidioc_g_priority = cx25821_vidioc_g_priority,
1744 .vidioc_s_priority = cx25821_vidioc_s_priority,
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001745#ifdef CONFIG_VIDEO_ADV_DEBUG
Leonid V. Fedorenchikfa7ce1f2011-09-16 14:15:11 +08001746 .vidioc_g_register = cx25821_vidioc_g_register,
1747 .vidioc_s_register = cx25821_vidioc_s_register,
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001748#endif
1749};
1750
Hans Verkuilffd3c232013-04-13 05:30:48 -03001751static const struct video_device cx25821_video_device = {
1752 .name = "cx25821-video",
Leonid V. Fedorenchik527db492011-09-16 14:15:12 +08001753 .fops = &video_fops,
Hans Verkuilffd3c232013-04-13 05:30:48 -03001754 .minor = -1,
Leonid V. Fedorenchik527db492011-09-16 14:15:12 +08001755 .ioctl_ops = &video_ioctl_ops,
1756 .tvnorms = CX25821_NORMS,
Palash Bandyopadhyay6d8c2ba2010-07-04 14:15:38 -03001757};
Hans Verkuilffd3c232013-04-13 05:30:48 -03001758
1759void cx25821_video_unregister(struct cx25821_dev *dev, int chan_num)
1760{
1761 cx_clear(PCI_INT_MSK, 1);
1762
1763 if (dev->channels[chan_num].video_dev) {
1764 if (video_is_registered(dev->channels[chan_num].video_dev))
1765 video_unregister_device(
1766 dev->channels[chan_num].video_dev);
1767 else
1768 video_device_release(
1769 dev->channels[chan_num].video_dev);
1770
1771 dev->channels[chan_num].video_dev = NULL;
1772
1773 btcx_riscmem_free(dev->pci,
1774 &dev->channels[chan_num].vidq.stopper);
1775
1776 pr_warn("device %d released!\n", chan_num);
1777 }
1778
1779}
1780
1781int cx25821_video_register(struct cx25821_dev *dev)
1782{
1783 int err;
1784 int i;
1785
1786 spin_lock_init(&dev->slock);
1787
1788 for (i = 0; i < VID_CHANNEL_NUM; ++i) {
1789 if (i == SRAM_CH08) /* audio channel */
1790 continue;
1791
1792 cx25821_init_controls(dev, i);
1793
1794 cx25821_risc_stopper(dev->pci, &dev->channels[i].vidq.stopper,
1795 dev->channels[i].sram_channels->dma_ctl, 0x11, 0);
1796
1797 dev->channels[i].sram_channels = &cx25821_sram_channels[i];
1798 dev->channels[i].video_dev = NULL;
1799 dev->channels[i].resources = 0;
1800
1801 cx_write(dev->channels[i].sram_channels->int_stat, 0xffffffff);
1802
1803 INIT_LIST_HEAD(&dev->channels[i].vidq.active);
1804 INIT_LIST_HEAD(&dev->channels[i].vidq.queued);
1805
1806 dev->channels[i].timeout_data.dev = dev;
1807 dev->channels[i].timeout_data.channel =
1808 &cx25821_sram_channels[i];
1809 dev->channels[i].vidq.timeout.function = cx25821_vid_timeout;
1810 dev->channels[i].vidq.timeout.data =
1811 (unsigned long)&dev->channels[i].timeout_data;
1812 init_timer(&dev->channels[i].vidq.timeout);
1813
1814 /* register v4l devices */
1815 dev->channels[i].video_dev = cx25821_vdev_init(dev, dev->pci,
1816 &cx25821_video_device, "video");
1817
1818 err = video_register_device(dev->channels[i].video_dev,
1819 VFL_TYPE_GRABBER, video_nr[dev->nr]);
1820
1821 if (err < 0)
1822 goto fail_unreg;
1823
1824 }
1825
1826 /* set PCI interrupt */
1827 cx_set(PCI_INT_MSK, 0xff);
1828
1829 /* initial device configuration */
1830 mutex_lock(&dev->lock);
Hans Verkuil18c73af2013-04-13 05:50:18 -03001831 dev->tvnorm = V4L2_STD_NTSC_M,
Hans Verkuilffd3c232013-04-13 05:30:48 -03001832 cx25821_set_tvnorm(dev, dev->tvnorm);
Hans Verkuilffd3c232013-04-13 05:30:48 -03001833 mutex_unlock(&dev->lock);
1834
1835 return 0;
1836
1837fail_unreg:
1838 cx25821_video_unregister(dev, i);
1839 return err;
1840}