V4L/DVB (10486): ivtv/cx18: fix g_fmt and try_fmt for raw video
[safe/jmp/linux-2.6] / drivers / media / video / cx18 / cx18-ioctl.c
1 /*
2  *  cx18 ioctl system call
3  *
4  *  Derived from ivtv-ioctl.c
5  *
6  *  Copyright (C) 2007  Hans Verkuil <hverkuil@xs4all.nl>
7  *  Copyright (C) 2008  Andy Walls <awalls@radix.net>
8  *
9  *  This program is free software; you can redistribute it and/or modify
10  *  it under the terms of the GNU General Public License as published by
11  *  the Free Software Foundation; either version 2 of the License, or
12  *  (at your option) any later version.
13  *
14  *  This program is distributed in the hope that it will be useful,
15  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
16  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  *  GNU General Public License for more details.
18  *
19  *  You should have received a copy of the GNU General Public License
20  *  along with this program; if not, write to the Free Software
21  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
22  *  02111-1307  USA
23  */
24
25 #include "cx18-driver.h"
26 #include "cx18-io.h"
27 #include "cx18-version.h"
28 #include "cx18-mailbox.h"
29 #include "cx18-i2c.h"
30 #include "cx18-queue.h"
31 #include "cx18-fileops.h"
32 #include "cx18-vbi.h"
33 #include "cx18-audio.h"
34 #include "cx18-video.h"
35 #include "cx18-streams.h"
36 #include "cx18-ioctl.h"
37 #include "cx18-gpio.h"
38 #include "cx18-controls.h"
39 #include "cx18-cards.h"
40 #include "cx18-av-core.h"
41 #include <media/tveeprom.h>
42 #include <media/v4l2-chip-ident.h>
43 #include <linux/i2c-id.h>
44
45 u16 cx18_service2vbi(int type)
46 {
47         switch (type) {
48         case V4L2_SLICED_TELETEXT_B:
49                 return CX18_SLICED_TYPE_TELETEXT_B;
50         case V4L2_SLICED_CAPTION_525:
51                 return CX18_SLICED_TYPE_CAPTION_525;
52         case V4L2_SLICED_WSS_625:
53                 return CX18_SLICED_TYPE_WSS_625;
54         case V4L2_SLICED_VPS:
55                 return CX18_SLICED_TYPE_VPS;
56         default:
57                 return 0;
58         }
59 }
60
61 /* Check if VBI services are allowed on the (field, line) for the video std */
62 static int valid_service_line(int field, int line, int is_pal)
63 {
64         return (is_pal && line >= 6 &&
65                 ((field == 0 && line <= 23) || (field == 1 && line <= 22))) ||
66                (!is_pal && line >= 10 && line < 22);
67 }
68
69 /*
70  * For a (field, line, std) and inbound potential set of services for that line,
71  * return the first valid service of those passed in the incoming set for that
72  * line in priority order:
73  * CC, VPS, or WSS over TELETEXT for well known lines
74  * TELETEXT, before VPS, before CC, before WSS, for other lines
75  */
76 static u16 select_service_from_set(int field, int line, u16 set, int is_pal)
77 {
78         u16 valid_set = (is_pal ? V4L2_SLICED_VBI_625 : V4L2_SLICED_VBI_525);
79         int i;
80
81         set = set & valid_set;
82         if (set == 0 || !valid_service_line(field, line, is_pal))
83                 return 0;
84         if (!is_pal) {
85                 if (line == 21 && (set & V4L2_SLICED_CAPTION_525))
86                         return V4L2_SLICED_CAPTION_525;
87         } else {
88                 if (line == 16 && field == 0 && (set & V4L2_SLICED_VPS))
89                         return V4L2_SLICED_VPS;
90                 if (line == 23 && field == 0 && (set & V4L2_SLICED_WSS_625))
91                         return V4L2_SLICED_WSS_625;
92                 if (line == 23)
93                         return 0;
94         }
95         for (i = 0; i < 32; i++) {
96                 if ((1 << i) & set)
97                         return 1 << i;
98         }
99         return 0;
100 }
101
102 /*
103  * Expand the service_set of *fmt into valid service_lines for the std,
104  * and clear the passed in fmt->service_set
105  */
106 void cx18_expand_service_set(struct v4l2_sliced_vbi_format *fmt, int is_pal)
107 {
108         u16 set = fmt->service_set;
109         int f, l;
110
111         fmt->service_set = 0;
112         for (f = 0; f < 2; f++) {
113                 for (l = 0; l < 24; l++)
114                         fmt->service_lines[f][l] = select_service_from_set(f, l, set, is_pal);
115         }
116 }
117
118 /*
119  * Sanitize the service_lines in *fmt per the video std, and return 1
120  * if any service_line is left as valid after santization
121  */
122 static int check_service_set(struct v4l2_sliced_vbi_format *fmt, int is_pal)
123 {
124         int f, l;
125         u16 set = 0;
126
127         for (f = 0; f < 2; f++) {
128                 for (l = 0; l < 24; l++) {
129                         fmt->service_lines[f][l] = select_service_from_set(f, l, fmt->service_lines[f][l], is_pal);
130                         set |= fmt->service_lines[f][l];
131                 }
132         }
133         return set != 0;
134 }
135
136 /* Compute the service_set from the assumed valid service_lines of *fmt */
137 u16 cx18_get_service_set(struct v4l2_sliced_vbi_format *fmt)
138 {
139         int f, l;
140         u16 set = 0;
141
142         for (f = 0; f < 2; f++) {
143                 for (l = 0; l < 24; l++)
144                         set |= fmt->service_lines[f][l];
145         }
146         return set;
147 }
148
149 static int cx18_g_fmt_vid_cap(struct file *file, void *fh,
150                                 struct v4l2_format *fmt)
151 {
152         struct cx18_open_id *id = fh;
153         struct cx18 *cx = id->cx;
154         struct v4l2_pix_format *pixfmt = &fmt->fmt.pix;
155
156         pixfmt->width = cx->params.width;
157         pixfmt->height = cx->params.height;
158         pixfmt->colorspace = V4L2_COLORSPACE_SMPTE170M;
159         pixfmt->field = V4L2_FIELD_INTERLACED;
160         pixfmt->priv = 0;
161         if (id->type == CX18_ENC_STREAM_TYPE_YUV) {
162                 pixfmt->pixelformat = V4L2_PIX_FMT_HM12;
163                 /* YUV size is (Y=(h*720) + UV=(h*(720/2))) */
164                 pixfmt->sizeimage = pixfmt->height * 720 * 3 / 2;
165                 pixfmt->bytesperline = 720;
166         } else {
167                 pixfmt->pixelformat = V4L2_PIX_FMT_MPEG;
168                 pixfmt->sizeimage = 128 * 1024;
169                 pixfmt->bytesperline = 0;
170         }
171         return 0;
172 }
173
174 static int cx18_g_fmt_vbi_cap(struct file *file, void *fh,
175                                 struct v4l2_format *fmt)
176 {
177         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
178         struct v4l2_vbi_format *vbifmt = &fmt->fmt.vbi;
179
180         vbifmt->sampling_rate = 27000000;
181         vbifmt->offset = 248; /* FIXME - slightly wrong for both 50 & 60 Hz */
182         vbifmt->samples_per_line = vbi_active_samples - 4;
183         vbifmt->sample_format = V4L2_PIX_FMT_GREY;
184         vbifmt->start[0] = cx->vbi.start[0];
185         vbifmt->start[1] = cx->vbi.start[1];
186         vbifmt->count[0] = vbifmt->count[1] = cx->vbi.count;
187         vbifmt->flags = 0;
188         vbifmt->reserved[0] = 0;
189         vbifmt->reserved[1] = 0;
190         return 0;
191 }
192
193 static int cx18_g_fmt_sliced_vbi_cap(struct file *file, void *fh,
194                                         struct v4l2_format *fmt)
195 {
196         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
197         struct v4l2_sliced_vbi_format *vbifmt = &fmt->fmt.sliced;
198
199         /* sane, V4L2 spec compliant, defaults */
200         vbifmt->reserved[0] = 0;
201         vbifmt->reserved[1] = 0;
202         vbifmt->io_size = sizeof(struct v4l2_sliced_vbi_data) * 36;
203         memset(vbifmt->service_lines, 0, sizeof(vbifmt->service_lines));
204         vbifmt->service_set = 0;
205
206         /*
207          * Fetch the configured service_lines and total service_set from the
208          * digitizer/slicer.  Note, cx18_av_vbi() wipes the passed in
209          * fmt->fmt.sliced under valid calling conditions
210          */
211         if (cx18_av_cmd(cx, VIDIOC_G_FMT, fmt))
212                 return -EINVAL;
213
214         /* Ensure V4L2 spec compliant output */
215         vbifmt->reserved[0] = 0;
216         vbifmt->reserved[1] = 0;
217         vbifmt->io_size = sizeof(struct v4l2_sliced_vbi_data) * 36;
218         vbifmt->service_set = cx18_get_service_set(vbifmt);
219         return 0;
220 }
221
222 static int cx18_try_fmt_vid_cap(struct file *file, void *fh,
223                                 struct v4l2_format *fmt)
224 {
225         struct cx18_open_id *id = fh;
226         struct cx18 *cx = id->cx;
227         int w = fmt->fmt.pix.width;
228         int h = fmt->fmt.pix.height;
229         int min_h = 2;
230
231         w = min(w, 720);
232         w = max(w, 2);
233         if (id->type == CX18_ENC_STREAM_TYPE_YUV) {
234                 /* YUV height must be a multiple of 32 */
235                 h &= ~0x1f;
236                 min_h = 32;
237         }
238         h = min(h, cx->is_50hz ? 576 : 480);
239         h = max(h, min_h);
240
241         cx18_g_fmt_vid_cap(file, fh, fmt);
242         fmt->fmt.pix.width = w;
243         fmt->fmt.pix.height = h;
244         return 0;
245 }
246
247 static int cx18_try_fmt_vbi_cap(struct file *file, void *fh,
248                                 struct v4l2_format *fmt)
249 {
250         return cx18_g_fmt_vbi_cap(file, fh, fmt);
251 }
252
253 static int cx18_try_fmt_sliced_vbi_cap(struct file *file, void *fh,
254                                         struct v4l2_format *fmt)
255 {
256         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
257         struct v4l2_sliced_vbi_format *vbifmt = &fmt->fmt.sliced;
258
259         vbifmt->io_size = sizeof(struct v4l2_sliced_vbi_data) * 36;
260         vbifmt->reserved[0] = 0;
261         vbifmt->reserved[1] = 0;
262
263         /* If given a service set, expand it validly & clear passed in set */
264         if (vbifmt->service_set)
265                 cx18_expand_service_set(vbifmt, cx->is_50hz);
266         /* Sanitize the service_lines, and compute the new set if any valid */
267         if (check_service_set(vbifmt, cx->is_50hz))
268                 vbifmt->service_set = cx18_get_service_set(vbifmt);
269         return 0;
270 }
271
272 static int cx18_s_fmt_vid_cap(struct file *file, void *fh,
273                                 struct v4l2_format *fmt)
274 {
275         struct cx18_open_id *id = fh;
276         struct cx18 *cx = id->cx;
277         int ret;
278         int w, h;
279
280         ret = v4l2_prio_check(&cx->prio, &id->prio);
281         if (ret)
282                 return ret;
283
284         ret = cx18_try_fmt_vid_cap(file, fh, fmt);
285         if (ret)
286                 return ret;
287         w = fmt->fmt.pix.width;
288         h = fmt->fmt.pix.height;
289
290         if (cx->params.width == w && cx->params.height == h)
291                 return 0;
292
293         if (atomic_read(&cx->ana_capturing) > 0)
294                 return -EBUSY;
295
296         cx->params.width = w;
297         cx->params.height = h;
298         cx18_av_cmd(cx, VIDIOC_S_FMT, fmt);
299         return cx18_g_fmt_vid_cap(file, fh, fmt);
300 }
301
302 static int cx18_s_fmt_vbi_cap(struct file *file, void *fh,
303                                 struct v4l2_format *fmt)
304 {
305         struct cx18_open_id *id = fh;
306         struct cx18 *cx = id->cx;
307         int ret;
308
309         ret = v4l2_prio_check(&cx->prio, &id->prio);
310         if (ret)
311                 return ret;
312
313         /*
314          * Changing the Encoder's Raw VBI parameters won't have any effect
315          * if any analog capture is ongoing
316          */
317         if (!cx18_raw_vbi(cx) && atomic_read(&cx->ana_capturing) > 0)
318                 return -EBUSY;
319
320         /*
321          * Set the digitizer registers for raw active VBI.
322          * Note cx18_av_vbi_wipes out alot of the passed in fmt under valid
323          * calling conditions
324          */
325         ret = cx18_av_cmd(cx, VIDIOC_S_FMT, fmt);
326         if (ret)
327                 return ret;
328
329         /* Store our new v4l2 (non-)sliced VBI state */
330         cx->vbi.sliced_in->service_set = 0;
331         cx->vbi.in.type = V4L2_BUF_TYPE_VBI_CAPTURE;
332
333         return cx18_g_fmt_vbi_cap(file, fh, fmt);
334 }
335
336 static int cx18_s_fmt_sliced_vbi_cap(struct file *file, void *fh,
337                                         struct v4l2_format *fmt)
338 {
339         struct cx18_open_id *id = fh;
340         struct cx18 *cx = id->cx;
341         int ret;
342         struct v4l2_sliced_vbi_format *vbifmt = &fmt->fmt.sliced;
343
344         ret = v4l2_prio_check(&cx->prio, &id->prio);
345         if (ret)
346                 return ret;
347
348         cx18_try_fmt_sliced_vbi_cap(file, fh, fmt);
349
350         /*
351          * Changing the Encoder's Raw VBI parameters won't have any effect
352          * if any analog capture is ongoing
353          */
354         if (cx18_raw_vbi(cx) && atomic_read(&cx->ana_capturing) > 0)
355                 return -EBUSY;
356
357         /*
358          * Set the service_lines requested in the digitizer/slicer registers.
359          * Note, cx18_av_vbi() wipes some "impossible" service lines in the
360          * passed in fmt->fmt.sliced under valid calling conditions
361          */
362         ret = cx18_av_cmd(cx, VIDIOC_S_FMT, fmt);
363         if (ret)
364                 return ret;
365         /* Store our current v4l2 sliced VBI settings */
366         cx->vbi.in.type =  V4L2_BUF_TYPE_SLICED_VBI_CAPTURE;
367         memcpy(cx->vbi.sliced_in, vbifmt, sizeof(*cx->vbi.sliced_in));
368         return 0;
369 }
370
371 static int cx18_g_chip_ident(struct file *file, void *fh,
372                                 struct v4l2_dbg_chip_ident *chip)
373 {
374         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
375
376         chip->ident = V4L2_IDENT_NONE;
377         chip->revision = 0;
378         if (v4l2_chip_match_host(&chip->match)) {
379                 chip->ident = V4L2_IDENT_CX23418;
380                 return 0;
381         }
382         cx18_call_i2c_clients(cx, VIDIOC_DBG_G_CHIP_IDENT, chip);
383         return 0;
384 }
385
386 #ifdef CONFIG_VIDEO_ADV_DEBUG
387 static int cx18_cxc(struct cx18 *cx, unsigned int cmd, void *arg)
388 {
389         struct v4l2_dbg_register *regs = arg;
390         unsigned long flags;
391
392         if (!capable(CAP_SYS_ADMIN))
393                 return -EPERM;
394         if (regs->reg >= CX18_MEM_OFFSET + CX18_MEM_SIZE)
395                 return -EINVAL;
396
397         spin_lock_irqsave(&cx18_cards_lock, flags);
398         regs->size = 4;
399         if (cmd == VIDIOC_DBG_G_REGISTER)
400                 regs->val = cx18_read_enc(cx, regs->reg);
401         else
402                 cx18_write_enc(cx, regs->val, regs->reg);
403         spin_unlock_irqrestore(&cx18_cards_lock, flags);
404         return 0;
405 }
406
407 static int cx18_g_register(struct file *file, void *fh,
408                                 struct v4l2_dbg_register *reg)
409 {
410         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
411
412         if (v4l2_chip_match_host(&reg->match))
413                 return cx18_cxc(cx, VIDIOC_DBG_G_REGISTER, reg);
414         cx18_call_i2c_clients(cx, VIDIOC_DBG_G_REGISTER, reg);
415         return 0;
416 }
417
418 static int cx18_s_register(struct file *file, void *fh,
419                                 struct v4l2_dbg_register *reg)
420 {
421         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
422
423         if (v4l2_chip_match_host(&reg->match))
424                 return cx18_cxc(cx, VIDIOC_DBG_S_REGISTER, reg);
425         cx18_call_i2c_clients(cx, VIDIOC_DBG_S_REGISTER, reg);
426         return 0;
427 }
428 #endif
429
430 static int cx18_g_priority(struct file *file, void *fh, enum v4l2_priority *p)
431 {
432         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
433
434         *p = v4l2_prio_max(&cx->prio);
435         return 0;
436 }
437
438 static int cx18_s_priority(struct file *file, void *fh, enum v4l2_priority prio)
439 {
440         struct cx18_open_id *id = fh;
441         struct cx18 *cx = id->cx;
442
443         return v4l2_prio_change(&cx->prio, &id->prio, prio);
444 }
445
446 static int cx18_querycap(struct file *file, void *fh,
447                                 struct v4l2_capability *vcap)
448 {
449         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
450
451         strlcpy(vcap->driver, CX18_DRIVER_NAME, sizeof(vcap->driver));
452         strlcpy(vcap->card, cx->card_name, sizeof(vcap->card));
453         snprintf(vcap->bus_info, sizeof(vcap->bus_info),
454                  "PCI:%s", pci_name(cx->pci_dev));
455         vcap->version = CX18_DRIVER_VERSION;        /* version */
456         vcap->capabilities = cx->v4l2_cap;          /* capabilities */
457         return 0;
458 }
459
460 static int cx18_enumaudio(struct file *file, void *fh, struct v4l2_audio *vin)
461 {
462         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
463
464         return cx18_get_audio_input(cx, vin->index, vin);
465 }
466
467 static int cx18_g_audio(struct file *file, void *fh, struct v4l2_audio *vin)
468 {
469         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
470
471         vin->index = cx->audio_input;
472         return cx18_get_audio_input(cx, vin->index, vin);
473 }
474
475 static int cx18_s_audio(struct file *file, void *fh, struct v4l2_audio *vout)
476 {
477         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
478
479         if (vout->index >= cx->nof_audio_inputs)
480                 return -EINVAL;
481         cx->audio_input = vout->index;
482         cx18_audio_set_io(cx);
483         return 0;
484 }
485
486 static int cx18_enum_input(struct file *file, void *fh, struct v4l2_input *vin)
487 {
488         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
489
490         /* set it to defaults from our table */
491         return cx18_get_input(cx, vin->index, vin);
492 }
493
494 static int cx18_cropcap(struct file *file, void *fh,
495                         struct v4l2_cropcap *cropcap)
496 {
497         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
498
499         if (cropcap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
500                 return -EINVAL;
501         cropcap->bounds.top = cropcap->bounds.left = 0;
502         cropcap->bounds.width = 720;
503         cropcap->bounds.height = cx->is_50hz ? 576 : 480;
504         cropcap->pixelaspect.numerator = cx->is_50hz ? 59 : 10;
505         cropcap->pixelaspect.denominator = cx->is_50hz ? 54 : 11;
506         cropcap->defrect = cropcap->bounds;
507         return 0;
508 }
509
510 static int cx18_s_crop(struct file *file, void *fh, struct v4l2_crop *crop)
511 {
512         struct cx18_open_id *id = fh;
513         struct cx18 *cx = id->cx;
514         int ret;
515
516         ret = v4l2_prio_check(&cx->prio, &id->prio);
517         if (ret)
518                 return ret;
519
520         if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
521                 return -EINVAL;
522         return cx18_av_cmd(cx, VIDIOC_S_CROP, crop);
523 }
524
525 static int cx18_g_crop(struct file *file, void *fh, struct v4l2_crop *crop)
526 {
527         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
528
529         if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
530                 return -EINVAL;
531         return cx18_av_cmd(cx, VIDIOC_G_CROP, crop);
532 }
533
534 static int cx18_enum_fmt_vid_cap(struct file *file, void *fh,
535                                         struct v4l2_fmtdesc *fmt)
536 {
537         static struct v4l2_fmtdesc formats[] = {
538                 { 0, V4L2_BUF_TYPE_VIDEO_CAPTURE, 0,
539                   "HM12 (YUV 4:1:1)", V4L2_PIX_FMT_HM12, { 0, 0, 0, 0 }
540                 },
541                 { 1, V4L2_BUF_TYPE_VIDEO_CAPTURE, V4L2_FMT_FLAG_COMPRESSED,
542                   "MPEG", V4L2_PIX_FMT_MPEG, { 0, 0, 0, 0 }
543                 }
544         };
545
546         if (fmt->index > 1)
547                 return -EINVAL;
548         *fmt = formats[fmt->index];
549         return 0;
550 }
551
552 static int cx18_g_input(struct file *file, void *fh, unsigned int *i)
553 {
554         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
555
556         *i = cx->active_input;
557         return 0;
558 }
559
560 int cx18_s_input(struct file *file, void *fh, unsigned int inp)
561 {
562         struct cx18_open_id *id = fh;
563         struct cx18 *cx = id->cx;
564         int ret;
565
566         ret = v4l2_prio_check(&cx->prio, &id->prio);
567         if (ret)
568                 return ret;
569
570         if (inp < 0 || inp >= cx->nof_inputs)
571                 return -EINVAL;
572
573         if (inp == cx->active_input) {
574                 CX18_DEBUG_INFO("Input unchanged\n");
575                 return 0;
576         }
577
578         CX18_DEBUG_INFO("Changing input from %d to %d\n",
579                         cx->active_input, inp);
580
581         cx->active_input = inp;
582         /* Set the audio input to whatever is appropriate for the input type. */
583         cx->audio_input = cx->card->video_inputs[inp].audio_index;
584
585         /* prevent others from messing with the streams until
586            we're finished changing inputs. */
587         cx18_mute(cx);
588         cx18_video_set_io(cx);
589         cx18_audio_set_io(cx);
590         cx18_unmute(cx);
591         return 0;
592 }
593
594 static int cx18_g_frequency(struct file *file, void *fh,
595                                 struct v4l2_frequency *vf)
596 {
597         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
598
599         if (vf->tuner != 0)
600                 return -EINVAL;
601
602         cx18_call_i2c_clients(cx, VIDIOC_G_FREQUENCY, vf);
603         return 0;
604 }
605
606 int cx18_s_frequency(struct file *file, void *fh, struct v4l2_frequency *vf)
607 {
608         struct cx18_open_id *id = fh;
609         struct cx18 *cx = id->cx;
610         int ret;
611
612         ret = v4l2_prio_check(&cx->prio, &id->prio);
613         if (ret)
614                 return ret;
615
616         if (vf->tuner != 0)
617                 return -EINVAL;
618
619         cx18_mute(cx);
620         CX18_DEBUG_INFO("v4l2 ioctl: set frequency %d\n", vf->frequency);
621         cx18_call_i2c_clients(cx, VIDIOC_S_FREQUENCY, vf);
622         cx18_unmute(cx);
623         return 0;
624 }
625
626 static int cx18_g_std(struct file *file, void *fh, v4l2_std_id *std)
627 {
628         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
629
630         *std = cx->std;
631         return 0;
632 }
633
634 int cx18_s_std(struct file *file, void *fh, v4l2_std_id *std)
635 {
636         struct cx18_open_id *id = fh;
637         struct cx18 *cx = id->cx;
638         int ret;
639
640         ret = v4l2_prio_check(&cx->prio, &id->prio);
641         if (ret)
642                 return ret;
643
644         if ((*std & V4L2_STD_ALL) == 0)
645                 return -EINVAL;
646
647         if (*std == cx->std)
648                 return 0;
649
650         if (test_bit(CX18_F_I_RADIO_USER, &cx->i_flags) ||
651             atomic_read(&cx->ana_capturing) > 0) {
652                 /* Switching standard would turn off the radio or mess
653                    with already running streams, prevent that by
654                    returning EBUSY. */
655                 return -EBUSY;
656         }
657
658         cx->std = *std;
659         cx->is_60hz = (*std & V4L2_STD_525_60) ? 1 : 0;
660         cx->params.is_50hz = cx->is_50hz = !cx->is_60hz;
661         cx->params.width = 720;
662         cx->params.height = cx->is_50hz ? 576 : 480;
663         cx->vbi.count = cx->is_50hz ? 18 : 12;
664         cx->vbi.start[0] = cx->is_50hz ? 6 : 10;
665         cx->vbi.start[1] = cx->is_50hz ? 318 : 273;
666         CX18_DEBUG_INFO("Switching standard to %llx.\n",
667                         (unsigned long long) cx->std);
668
669         /* Tuner */
670         cx18_call_i2c_clients(cx, VIDIOC_S_STD, &cx->std);
671         return 0;
672 }
673
674 static int cx18_s_tuner(struct file *file, void *fh, struct v4l2_tuner *vt)
675 {
676         struct cx18_open_id *id = fh;
677         struct cx18 *cx = id->cx;
678         int ret;
679
680         ret = v4l2_prio_check(&cx->prio, &id->prio);
681         if (ret)
682                 return ret;
683
684         if (vt->index != 0)
685                 return -EINVAL;
686
687         /* Setting tuner can only set audio mode */
688         cx18_call_i2c_clients(cx, VIDIOC_S_TUNER, vt);
689
690         return 0;
691 }
692
693 static int cx18_g_tuner(struct file *file, void *fh, struct v4l2_tuner *vt)
694 {
695         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
696
697         if (vt->index != 0)
698                 return -EINVAL;
699
700         cx18_call_i2c_clients(cx, VIDIOC_G_TUNER, vt);
701
702         if (test_bit(CX18_F_I_RADIO_USER, &cx->i_flags)) {
703                 strlcpy(vt->name, "cx18 Radio Tuner", sizeof(vt->name));
704                 vt->type = V4L2_TUNER_RADIO;
705         } else {
706                 strlcpy(vt->name, "cx18 TV Tuner", sizeof(vt->name));
707                 vt->type = V4L2_TUNER_ANALOG_TV;
708         }
709
710         return 0;
711 }
712
713 static int cx18_g_sliced_vbi_cap(struct file *file, void *fh,
714                                         struct v4l2_sliced_vbi_cap *cap)
715 {
716         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
717         int set = cx->is_50hz ? V4L2_SLICED_VBI_625 : V4L2_SLICED_VBI_525;
718         int f, l;
719
720         if (cap->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE)
721                 return -EINVAL;
722
723         cap->service_set = 0;
724         for (f = 0; f < 2; f++) {
725                 for (l = 0; l < 24; l++) {
726                         if (valid_service_line(f, l, cx->is_50hz)) {
727                                 /*
728                                  * We can find all v4l2 supported vbi services
729                                  * for the standard, on a valid line for the std
730                                  */
731                                 cap->service_lines[f][l] = set;
732                                 cap->service_set |= set;
733                         } else
734                                 cap->service_lines[f][l] = 0;
735                 }
736         }
737         for (f = 0; f < 3; f++)
738                 cap->reserved[f] = 0;
739         return 0;
740 }
741
742 static int cx18_g_enc_index(struct file *file, void *fh,
743                                 struct v4l2_enc_idx *idx)
744 {
745         return -EINVAL;
746 }
747
748 static int cx18_encoder_cmd(struct file *file, void *fh,
749                                 struct v4l2_encoder_cmd *enc)
750 {
751         struct cx18_open_id *id = fh;
752         struct cx18 *cx = id->cx;
753         u32 h;
754
755         switch (enc->cmd) {
756         case V4L2_ENC_CMD_START:
757                 CX18_DEBUG_IOCTL("V4L2_ENC_CMD_START\n");
758                 enc->flags = 0;
759                 return cx18_start_capture(id);
760
761         case V4L2_ENC_CMD_STOP:
762                 CX18_DEBUG_IOCTL("V4L2_ENC_CMD_STOP\n");
763                 enc->flags &= V4L2_ENC_CMD_STOP_AT_GOP_END;
764                 cx18_stop_capture(id,
765                                   enc->flags & V4L2_ENC_CMD_STOP_AT_GOP_END);
766                 break;
767
768         case V4L2_ENC_CMD_PAUSE:
769                 CX18_DEBUG_IOCTL("V4L2_ENC_CMD_PAUSE\n");
770                 enc->flags = 0;
771                 if (!atomic_read(&cx->ana_capturing))
772                         return -EPERM;
773                 if (test_and_set_bit(CX18_F_I_ENC_PAUSED, &cx->i_flags))
774                         return 0;
775                 h = cx18_find_handle(cx);
776                 if (h == CX18_INVALID_TASK_HANDLE) {
777                         CX18_ERR("Can't find valid task handle for "
778                                  "V4L2_ENC_CMD_PAUSE\n");
779                         return -EBADFD;
780                 }
781                 cx18_mute(cx);
782                 cx18_vapi(cx, CX18_CPU_CAPTURE_PAUSE, 1, h);
783                 break;
784
785         case V4L2_ENC_CMD_RESUME:
786                 CX18_DEBUG_IOCTL("V4L2_ENC_CMD_RESUME\n");
787                 enc->flags = 0;
788                 if (!atomic_read(&cx->ana_capturing))
789                         return -EPERM;
790                 if (!test_and_clear_bit(CX18_F_I_ENC_PAUSED, &cx->i_flags))
791                         return 0;
792                 h = cx18_find_handle(cx);
793                 if (h == CX18_INVALID_TASK_HANDLE) {
794                         CX18_ERR("Can't find valid task handle for "
795                                  "V4L2_ENC_CMD_RESUME\n");
796                         return -EBADFD;
797                 }
798                 cx18_vapi(cx, CX18_CPU_CAPTURE_RESUME, 1, h);
799                 cx18_unmute(cx);
800                 break;
801
802         default:
803                 CX18_DEBUG_IOCTL("Unknown cmd %d\n", enc->cmd);
804                 return -EINVAL;
805         }
806         return 0;
807 }
808
809 static int cx18_try_encoder_cmd(struct file *file, void *fh,
810                                 struct v4l2_encoder_cmd *enc)
811 {
812         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
813
814         switch (enc->cmd) {
815         case V4L2_ENC_CMD_START:
816                 CX18_DEBUG_IOCTL("V4L2_ENC_CMD_START\n");
817                 enc->flags = 0;
818                 break;
819
820         case V4L2_ENC_CMD_STOP:
821                 CX18_DEBUG_IOCTL("V4L2_ENC_CMD_STOP\n");
822                 enc->flags &= V4L2_ENC_CMD_STOP_AT_GOP_END;
823                 break;
824
825         case V4L2_ENC_CMD_PAUSE:
826                 CX18_DEBUG_IOCTL("V4L2_ENC_CMD_PAUSE\n");
827                 enc->flags = 0;
828                 break;
829
830         case V4L2_ENC_CMD_RESUME:
831                 CX18_DEBUG_IOCTL("V4L2_ENC_CMD_RESUME\n");
832                 enc->flags = 0;
833                 break;
834
835         default:
836                 CX18_DEBUG_IOCTL("Unknown cmd %d\n", enc->cmd);
837                 return -EINVAL;
838         }
839         return 0;
840 }
841
842 static int cx18_log_status(struct file *file, void *fh)
843 {
844         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
845         struct v4l2_input vidin;
846         struct v4l2_audio audin;
847         int i;
848
849         CX18_INFO("=================  START STATUS CARD #%d  "
850                   "=================\n", cx->num);
851         CX18_INFO("Version: %s  Card: %s\n", CX18_VERSION, cx->card_name);
852         if (cx->hw_flags & CX18_HW_TVEEPROM) {
853                 struct tveeprom tv;
854
855                 cx18_read_eeprom(cx, &tv);
856         }
857         cx18_call_i2c_clients(cx, VIDIOC_LOG_STATUS, NULL);
858         cx18_get_input(cx, cx->active_input, &vidin);
859         cx18_get_audio_input(cx, cx->audio_input, &audin);
860         CX18_INFO("Video Input: %s\n", vidin.name);
861         CX18_INFO("Audio Input: %s\n", audin.name);
862         mutex_lock(&cx->gpio_lock);
863         CX18_INFO("GPIO:  direction 0x%08x, value 0x%08x\n",
864                 cx->gpio_dir, cx->gpio_val);
865         mutex_unlock(&cx->gpio_lock);
866         CX18_INFO("Tuner: %s\n",
867                 test_bit(CX18_F_I_RADIO_USER, &cx->i_flags) ?  "Radio" : "TV");
868         cx2341x_log_status(&cx->params, cx->name);
869         CX18_INFO("Status flags: 0x%08lx\n", cx->i_flags);
870         for (i = 0; i < CX18_MAX_STREAMS; i++) {
871                 struct cx18_stream *s = &cx->streams[i];
872
873                 if (s->video_dev == NULL || s->buffers == 0)
874                         continue;
875                 CX18_INFO("Stream %s: status 0x%04lx, %d%% of %d KiB (%d buffers) in use\n",
876                           s->name, s->s_flags,
877                           atomic_read(&s->q_full.buffers) * 100 / s->buffers,
878                           (s->buffers * s->buf_size) / 1024, s->buffers);
879         }
880         CX18_INFO("Read MPEG/VBI: %lld/%lld bytes\n",
881                         (long long)cx->mpg_data_received,
882                         (long long)cx->vbi_data_inserted);
883         CX18_INFO("==================  END STATUS CARD #%d  ==================\n", cx->num);
884         return 0;
885 }
886
887 static long cx18_default(struct file *file, void *fh, int cmd, void *arg)
888 {
889         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
890
891         switch (cmd) {
892         case VIDIOC_INT_S_AUDIO_ROUTING: {
893                 struct v4l2_routing *route = arg;
894
895                 CX18_DEBUG_IOCTL("VIDIOC_INT_S_AUDIO_ROUTING(%d, %d)\n",
896                         route->input, route->output);
897                 cx18_audio_set_route(cx, route);
898                 break;
899         }
900
901         case VIDIOC_INT_RESET: {
902                 u32 val = *(u32 *)arg;
903
904                 if ((val == 0) || (val & 0x01))
905                         cx18_reset_ir_gpio(&cx->i2c_algo_cb_data[0]);
906                 break;
907         }
908
909         default:
910                 return -EINVAL;
911         }
912         return 0;
913 }
914
915 long cx18_v4l2_ioctl(struct file *filp, unsigned int cmd,
916                     unsigned long arg)
917 {
918         struct video_device *vfd = video_devdata(filp);
919         struct cx18_open_id *id = (struct cx18_open_id *)filp->private_data;
920         struct cx18 *cx = id->cx;
921         long res;
922
923         mutex_lock(&cx->serialize_lock);
924
925         if (cx18_debug & CX18_DBGFLG_IOCTL)
926                 vfd->debug = V4L2_DEBUG_IOCTL | V4L2_DEBUG_IOCTL_ARG;
927         res = video_ioctl2(filp, cmd, arg);
928         vfd->debug = 0;
929         mutex_unlock(&cx->serialize_lock);
930         return res;
931 }
932
933 static const struct v4l2_ioctl_ops cx18_ioctl_ops = {
934         .vidioc_querycap                = cx18_querycap,
935         .vidioc_g_priority              = cx18_g_priority,
936         .vidioc_s_priority              = cx18_s_priority,
937         .vidioc_s_audio                 = cx18_s_audio,
938         .vidioc_g_audio                 = cx18_g_audio,
939         .vidioc_enumaudio               = cx18_enumaudio,
940         .vidioc_enum_input              = cx18_enum_input,
941         .vidioc_cropcap                 = cx18_cropcap,
942         .vidioc_s_crop                  = cx18_s_crop,
943         .vidioc_g_crop                  = cx18_g_crop,
944         .vidioc_g_input                 = cx18_g_input,
945         .vidioc_s_input                 = cx18_s_input,
946         .vidioc_g_frequency             = cx18_g_frequency,
947         .vidioc_s_frequency             = cx18_s_frequency,
948         .vidioc_s_tuner                 = cx18_s_tuner,
949         .vidioc_g_tuner                 = cx18_g_tuner,
950         .vidioc_g_enc_index             = cx18_g_enc_index,
951         .vidioc_g_std                   = cx18_g_std,
952         .vidioc_s_std                   = cx18_s_std,
953         .vidioc_log_status              = cx18_log_status,
954         .vidioc_enum_fmt_vid_cap        = cx18_enum_fmt_vid_cap,
955         .vidioc_encoder_cmd             = cx18_encoder_cmd,
956         .vidioc_try_encoder_cmd         = cx18_try_encoder_cmd,
957         .vidioc_g_fmt_vid_cap           = cx18_g_fmt_vid_cap,
958         .vidioc_g_fmt_vbi_cap           = cx18_g_fmt_vbi_cap,
959         .vidioc_g_fmt_sliced_vbi_cap    = cx18_g_fmt_sliced_vbi_cap,
960         .vidioc_s_fmt_vid_cap           = cx18_s_fmt_vid_cap,
961         .vidioc_s_fmt_vbi_cap           = cx18_s_fmt_vbi_cap,
962         .vidioc_s_fmt_sliced_vbi_cap    = cx18_s_fmt_sliced_vbi_cap,
963         .vidioc_try_fmt_vid_cap         = cx18_try_fmt_vid_cap,
964         .vidioc_try_fmt_vbi_cap         = cx18_try_fmt_vbi_cap,
965         .vidioc_try_fmt_sliced_vbi_cap  = cx18_try_fmt_sliced_vbi_cap,
966         .vidioc_g_sliced_vbi_cap        = cx18_g_sliced_vbi_cap,
967         .vidioc_g_chip_ident            = cx18_g_chip_ident,
968 #ifdef CONFIG_VIDEO_ADV_DEBUG
969         .vidioc_g_register              = cx18_g_register,
970         .vidioc_s_register              = cx18_s_register,
971 #endif
972         .vidioc_default                 = cx18_default,
973         .vidioc_queryctrl               = cx18_queryctrl,
974         .vidioc_querymenu               = cx18_querymenu,
975         .vidioc_g_ext_ctrls             = cx18_g_ext_ctrls,
976         .vidioc_s_ext_ctrls             = cx18_s_ext_ctrls,
977         .vidioc_try_ext_ctrls           = cx18_try_ext_ctrls,
978 };
979
980 void cx18_set_funcs(struct video_device *vdev)
981 {
982         vdev->ioctl_ops = &cx18_ioctl_ops;
983 }