V4L/DVB (6079): Cleanup: remove linux/moduleparam.h from drivers/media files
[powerpc.git] / drivers / media / video / saa7134 / saa7134-video.c
1 /*
2  *
3  * device driver for philips saa7134 based TV cards
4  * video4linux video interface
5  *
6  * (c) 2001-03 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
7  *
8  *  This program is free software; you can redistribute it and/or modify
9  *  it under the terms of the GNU General Public License as published by
10  *  the Free Software Foundation; either version 2 of the License, or
11  *  (at your option) any later version.
12  *
13  *  This program is distributed in the hope that it will be useful,
14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  *  GNU General Public License for more details.
17  *
18  *  You should have received a copy of the GNU General Public License
19  *  along with this program; if not, write to the Free Software
20  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21  */
22
23 #include <linux/init.h>
24 #include <linux/list.h>
25 #include <linux/module.h>
26 #include <linux/kernel.h>
27 #include <linux/slab.h>
28 #include <linux/sort.h>
29
30 #include "saa7134-reg.h"
31 #include "saa7134.h"
32 #include <media/v4l2-common.h>
33
34 #ifdef CONFIG_VIDEO_V4L1_COMPAT
35 /* Include V4L1 specific functions. Should be removed soon */
36 #include <linux/videodev.h>
37 #endif
38
39 /* ------------------------------------------------------------------ */
40
41 static unsigned int video_debug   = 0;
42 static unsigned int gbuffers      = 8;
43 static unsigned int noninterlaced = 1;
44 static unsigned int gbufsize      = 720*576*4;
45 static unsigned int gbufsize_max  = 720*576*4;
46 static char secam[] = "--";
47 module_param(video_debug, int, 0644);
48 MODULE_PARM_DESC(video_debug,"enable debug messages [video]");
49 module_param(gbuffers, int, 0444);
50 MODULE_PARM_DESC(gbuffers,"number of capture buffers, range 2-32");
51 module_param(noninterlaced, int, 0644);
52 MODULE_PARM_DESC(noninterlaced,"capture non interlaced video");
53 module_param_string(secam, secam, sizeof(secam), 0644);
54 MODULE_PARM_DESC(secam, "force SECAM variant, either DK,L or Lc");
55
56
57 #define dprintk(fmt, arg...)    if (video_debug) \
58         printk(KERN_DEBUG "%s/video: " fmt, dev->name , ## arg)
59
60 /* ------------------------------------------------------------------ */
61 /* Defines for Video Output Port Register at address 0x191            */
62
63 /* Bit 0: VIP code T bit polarity */
64
65 #define VP_T_CODE_P_NON_INVERTED        0x00
66 #define VP_T_CODE_P_INVERTED            0x01
67
68 /* ------------------------------------------------------------------ */
69 /* Defines for Video Output Port Register at address 0x195            */
70
71 /* Bit 2: Video output clock delay control */
72
73 #define VP_CLK_CTRL2_NOT_DELAYED        0x00
74 #define VP_CLK_CTRL2_DELAYED            0x04
75
76 /* Bit 1: Video output clock invert control */
77
78 #define VP_CLK_CTRL1_NON_INVERTED       0x00
79 #define VP_CLK_CTRL1_INVERTED           0x02
80
81 /* ------------------------------------------------------------------ */
82 /* Defines for Video Output Port Register at address 0x196            */
83
84 /* Bits 2 to 0: VSYNC pin video vertical sync type */
85
86 #define VP_VS_TYPE_MASK                 0x07
87
88 #define VP_VS_TYPE_OFF                  0x00
89 #define VP_VS_TYPE_V123                 0x01
90 #define VP_VS_TYPE_V_ITU                0x02
91 #define VP_VS_TYPE_VGATE_L              0x03
92 #define VP_VS_TYPE_RESERVED1            0x04
93 #define VP_VS_TYPE_RESERVED2            0x05
94 #define VP_VS_TYPE_F_ITU                0x06
95 #define VP_VS_TYPE_SC_FID               0x07
96
97 /* ------------------------------------------------------------------ */
98 /* data structs for video                                             */
99
100 static int video_out[][9] = {
101         [CCIR656] = { 0x00, 0xb1, 0x00, 0xa1, 0x00, 0x04, 0x06, 0x00, 0x00 },
102 };
103
104 static struct saa7134_format formats[] = {
105         {
106                 .name     = "8 bpp gray",
107                 .fourcc   = V4L2_PIX_FMT_GREY,
108                 .depth    = 8,
109                 .pm       = 0x06,
110         },{
111                 .name     = "15 bpp RGB, le",
112                 .fourcc   = V4L2_PIX_FMT_RGB555,
113                 .depth    = 16,
114                 .pm       = 0x13 | 0x80,
115         },{
116                 .name     = "15 bpp RGB, be",
117                 .fourcc   = V4L2_PIX_FMT_RGB555X,
118                 .depth    = 16,
119                 .pm       = 0x13 | 0x80,
120                 .bswap    = 1,
121         },{
122                 .name     = "16 bpp RGB, le",
123                 .fourcc   = V4L2_PIX_FMT_RGB565,
124                 .depth    = 16,
125                 .pm       = 0x10 | 0x80,
126         },{
127                 .name     = "16 bpp RGB, be",
128                 .fourcc   = V4L2_PIX_FMT_RGB565X,
129                 .depth    = 16,
130                 .pm       = 0x10 | 0x80,
131                 .bswap    = 1,
132         },{
133                 .name     = "24 bpp RGB, le",
134                 .fourcc   = V4L2_PIX_FMT_BGR24,
135                 .depth    = 24,
136                 .pm       = 0x11,
137         },{
138                 .name     = "24 bpp RGB, be",
139                 .fourcc   = V4L2_PIX_FMT_RGB24,
140                 .depth    = 24,
141                 .pm       = 0x11,
142                 .bswap    = 1,
143         },{
144                 .name     = "32 bpp RGB, le",
145                 .fourcc   = V4L2_PIX_FMT_BGR32,
146                 .depth    = 32,
147                 .pm       = 0x12,
148         },{
149                 .name     = "32 bpp RGB, be",
150                 .fourcc   = V4L2_PIX_FMT_RGB32,
151                 .depth    = 32,
152                 .pm       = 0x12,
153                 .bswap    = 1,
154                 .wswap    = 1,
155         },{
156                 .name     = "4:2:2 packed, YUYV",
157                 .fourcc   = V4L2_PIX_FMT_YUYV,
158                 .depth    = 16,
159                 .pm       = 0x00,
160                 .bswap    = 1,
161                 .yuv      = 1,
162         },{
163                 .name     = "4:2:2 packed, UYVY",
164                 .fourcc   = V4L2_PIX_FMT_UYVY,
165                 .depth    = 16,
166                 .pm       = 0x00,
167                 .yuv      = 1,
168         },{
169                 .name     = "4:2:2 planar, Y-Cb-Cr",
170                 .fourcc   = V4L2_PIX_FMT_YUV422P,
171                 .depth    = 16,
172                 .pm       = 0x09,
173                 .yuv      = 1,
174                 .planar   = 1,
175                 .hshift   = 1,
176                 .vshift   = 0,
177         },{
178                 .name     = "4:2:0 planar, Y-Cb-Cr",
179                 .fourcc   = V4L2_PIX_FMT_YUV420,
180                 .depth    = 12,
181                 .pm       = 0x0a,
182                 .yuv      = 1,
183                 .planar   = 1,
184                 .hshift   = 1,
185                 .vshift   = 1,
186         },{
187                 .name     = "4:2:0 planar, Y-Cb-Cr",
188                 .fourcc   = V4L2_PIX_FMT_YVU420,
189                 .depth    = 12,
190                 .pm       = 0x0a,
191                 .yuv      = 1,
192                 .planar   = 1,
193                 .uvswap   = 1,
194                 .hshift   = 1,
195                 .vshift   = 1,
196         }
197 };
198 #define FORMATS ARRAY_SIZE(formats)
199
200 #define NORM_625_50                     \
201                 .h_start       = 0,     \
202                 .h_stop        = 719,   \
203                 .video_v_start = 24,    \
204                 .video_v_stop  = 311,   \
205                 .vbi_v_start_0 = 7,     \
206                 .vbi_v_stop_0  = 22,    \
207                 .vbi_v_start_1 = 319,   \
208                 .src_timing    = 4
209
210 #define NORM_525_60                     \
211                 .h_start       = 0,     \
212                 .h_stop        = 703,   \
213                 .video_v_start = 23,    \
214                 .video_v_stop  = 262,   \
215                 .vbi_v_start_0 = 10,    \
216                 .vbi_v_stop_0  = 21,    \
217                 .vbi_v_start_1 = 273,   \
218                 .src_timing    = 7
219
220 static struct saa7134_tvnorm tvnorms[] = {
221         {
222                 .name          = "PAL", /* autodetect */
223                 .id            = V4L2_STD_PAL,
224                 NORM_625_50,
225
226                 .sync_control  = 0x18,
227                 .luma_control  = 0x40,
228                 .chroma_ctrl1  = 0x81,
229                 .chroma_gain   = 0x2a,
230                 .chroma_ctrl2  = 0x06,
231                 .vgate_misc    = 0x1c,
232
233         },{
234                 .name          = "PAL-BG",
235                 .id            = V4L2_STD_PAL_BG,
236                 NORM_625_50,
237
238                 .sync_control  = 0x18,
239                 .luma_control  = 0x40,
240                 .chroma_ctrl1  = 0x81,
241                 .chroma_gain   = 0x2a,
242                 .chroma_ctrl2  = 0x06,
243                 .vgate_misc    = 0x1c,
244
245         },{
246                 .name          = "PAL-I",
247                 .id            = V4L2_STD_PAL_I,
248                 NORM_625_50,
249
250                 .sync_control  = 0x18,
251                 .luma_control  = 0x40,
252                 .chroma_ctrl1  = 0x81,
253                 .chroma_gain   = 0x2a,
254                 .chroma_ctrl2  = 0x06,
255                 .vgate_misc    = 0x1c,
256
257         },{
258                 .name          = "PAL-DK",
259                 .id            = V4L2_STD_PAL_DK,
260                 NORM_625_50,
261
262                 .sync_control  = 0x18,
263                 .luma_control  = 0x40,
264                 .chroma_ctrl1  = 0x81,
265                 .chroma_gain   = 0x2a,
266                 .chroma_ctrl2  = 0x06,
267                 .vgate_misc    = 0x1c,
268
269         },{
270                 .name          = "NTSC",
271                 .id            = V4L2_STD_NTSC,
272                 NORM_525_60,
273
274                 .sync_control  = 0x59,
275                 .luma_control  = 0x40,
276                 .chroma_ctrl1  = 0x89,
277                 .chroma_gain   = 0x2a,
278                 .chroma_ctrl2  = 0x0e,
279                 .vgate_misc    = 0x18,
280
281         },{
282                 .name          = "SECAM",
283                 .id            = V4L2_STD_SECAM,
284                 NORM_625_50,
285
286                 .sync_control  = 0x18,
287                 .luma_control  = 0x1b,
288                 .chroma_ctrl1  = 0xd1,
289                 .chroma_gain   = 0x80,
290                 .chroma_ctrl2  = 0x00,
291                 .vgate_misc    = 0x1c,
292
293         },{
294                 .name          = "SECAM-DK",
295                 .id            = V4L2_STD_SECAM_DK,
296                 NORM_625_50,
297
298                 .sync_control  = 0x18,
299                 .luma_control  = 0x1b,
300                 .chroma_ctrl1  = 0xd1,
301                 .chroma_gain   = 0x80,
302                 .chroma_ctrl2  = 0x00,
303                 .vgate_misc    = 0x1c,
304
305         },{
306                 .name          = "SECAM-L",
307                 .id            = V4L2_STD_SECAM_L,
308                 NORM_625_50,
309
310                 .sync_control  = 0x18,
311                 .luma_control  = 0x1b,
312                 .chroma_ctrl1  = 0xd1,
313                 .chroma_gain   = 0x80,
314                 .chroma_ctrl2  = 0x00,
315                 .vgate_misc    = 0x1c,
316
317         },{
318                 .name          = "SECAM-Lc",
319                 .id            = V4L2_STD_SECAM_LC,
320                 NORM_625_50,
321
322                 .sync_control  = 0x18,
323                 .luma_control  = 0x1b,
324                 .chroma_ctrl1  = 0xd1,
325                 .chroma_gain   = 0x80,
326                 .chroma_ctrl2  = 0x00,
327                 .vgate_misc    = 0x1c,
328
329         },{
330                 .name          = "PAL-M",
331                 .id            = V4L2_STD_PAL_M,
332                 NORM_525_60,
333
334                 .sync_control  = 0x59,
335                 .luma_control  = 0x40,
336                 .chroma_ctrl1  = 0xb9,
337                 .chroma_gain   = 0x2a,
338                 .chroma_ctrl2  = 0x0e,
339                 .vgate_misc    = 0x18,
340
341         },{
342                 .name          = "PAL-Nc",
343                 .id            = V4L2_STD_PAL_Nc,
344                 NORM_625_50,
345
346                 .sync_control  = 0x18,
347                 .luma_control  = 0x40,
348                 .chroma_ctrl1  = 0xa1,
349                 .chroma_gain   = 0x2a,
350                 .chroma_ctrl2  = 0x06,
351                 .vgate_misc    = 0x1c,
352
353         },{
354                 .name          = "PAL-60",
355                 .id            = V4L2_STD_PAL_60,
356
357                 .h_start       = 0,
358                 .h_stop        = 719,
359                 .video_v_start = 23,
360                 .video_v_stop  = 262,
361                 .vbi_v_start_0 = 10,
362                 .vbi_v_stop_0  = 21,
363                 .vbi_v_start_1 = 273,
364                 .src_timing    = 7,
365
366                 .sync_control  = 0x18,
367                 .luma_control  = 0x40,
368                 .chroma_ctrl1  = 0x81,
369                 .chroma_gain   = 0x2a,
370                 .chroma_ctrl2  = 0x06,
371                 .vgate_misc    = 0x1c,
372         }
373 };
374 #define TVNORMS ARRAY_SIZE(tvnorms)
375
376 #define V4L2_CID_PRIVATE_INVERT      (V4L2_CID_PRIVATE_BASE + 0)
377 #define V4L2_CID_PRIVATE_Y_ODD       (V4L2_CID_PRIVATE_BASE + 1)
378 #define V4L2_CID_PRIVATE_Y_EVEN      (V4L2_CID_PRIVATE_BASE + 2)
379 #define V4L2_CID_PRIVATE_AUTOMUTE    (V4L2_CID_PRIVATE_BASE + 3)
380 #define V4L2_CID_PRIVATE_LASTP1      (V4L2_CID_PRIVATE_BASE + 4)
381
382 static const struct v4l2_queryctrl no_ctrl = {
383         .name  = "42",
384         .flags = V4L2_CTRL_FLAG_DISABLED,
385 };
386 static const struct v4l2_queryctrl video_ctrls[] = {
387         /* --- video --- */
388         {
389                 .id            = V4L2_CID_BRIGHTNESS,
390                 .name          = "Brightness",
391                 .minimum       = 0,
392                 .maximum       = 255,
393                 .step          = 1,
394                 .default_value = 128,
395                 .type          = V4L2_CTRL_TYPE_INTEGER,
396         },{
397                 .id            = V4L2_CID_CONTRAST,
398                 .name          = "Contrast",
399                 .minimum       = 0,
400                 .maximum       = 127,
401                 .step          = 1,
402                 .default_value = 68,
403                 .type          = V4L2_CTRL_TYPE_INTEGER,
404         },{
405                 .id            = V4L2_CID_SATURATION,
406                 .name          = "Saturation",
407                 .minimum       = 0,
408                 .maximum       = 127,
409                 .step          = 1,
410                 .default_value = 64,
411                 .type          = V4L2_CTRL_TYPE_INTEGER,
412         },{
413                 .id            = V4L2_CID_HUE,
414                 .name          = "Hue",
415                 .minimum       = -128,
416                 .maximum       = 127,
417                 .step          = 1,
418                 .default_value = 0,
419                 .type          = V4L2_CTRL_TYPE_INTEGER,
420         },{
421                 .id            = V4L2_CID_HFLIP,
422                 .name          = "Mirror",
423                 .minimum       = 0,
424                 .maximum       = 1,
425                 .type          = V4L2_CTRL_TYPE_BOOLEAN,
426         },
427         /* --- audio --- */
428         {
429                 .id            = V4L2_CID_AUDIO_MUTE,
430                 .name          = "Mute",
431                 .minimum       = 0,
432                 .maximum       = 1,
433                 .type          = V4L2_CTRL_TYPE_BOOLEAN,
434         },{
435                 .id            = V4L2_CID_AUDIO_VOLUME,
436                 .name          = "Volume",
437                 .minimum       = -15,
438                 .maximum       = 15,
439                 .step          = 1,
440                 .default_value = 0,
441                 .type          = V4L2_CTRL_TYPE_INTEGER,
442         },
443         /* --- private --- */
444         {
445                 .id            = V4L2_CID_PRIVATE_INVERT,
446                 .name          = "Invert",
447                 .minimum       = 0,
448                 .maximum       = 1,
449                 .type          = V4L2_CTRL_TYPE_BOOLEAN,
450         },{
451                 .id            = V4L2_CID_PRIVATE_Y_ODD,
452                 .name          = "y offset odd field",
453                 .minimum       = 0,
454                 .maximum       = 128,
455                 .default_value = 0,
456                 .type          = V4L2_CTRL_TYPE_INTEGER,
457         },{
458                 .id            = V4L2_CID_PRIVATE_Y_EVEN,
459                 .name          = "y offset even field",
460                 .minimum       = 0,
461                 .maximum       = 128,
462                 .default_value = 0,
463                 .type          = V4L2_CTRL_TYPE_INTEGER,
464         },{
465                 .id            = V4L2_CID_PRIVATE_AUTOMUTE,
466                 .name          = "automute",
467                 .minimum       = 0,
468                 .maximum       = 1,
469                 .default_value = 1,
470                 .type          = V4L2_CTRL_TYPE_BOOLEAN,
471         }
472 };
473 static const unsigned int CTRLS = ARRAY_SIZE(video_ctrls);
474
475 static const struct v4l2_queryctrl* ctrl_by_id(unsigned int id)
476 {
477         unsigned int i;
478
479         for (i = 0; i < CTRLS; i++)
480                 if (video_ctrls[i].id == id)
481                         return video_ctrls+i;
482         return NULL;
483 }
484
485 static struct saa7134_format* format_by_fourcc(unsigned int fourcc)
486 {
487         unsigned int i;
488
489         for (i = 0; i < FORMATS; i++)
490                 if (formats[i].fourcc == fourcc)
491                         return formats+i;
492         return NULL;
493 }
494
495 /* ----------------------------------------------------------------------- */
496 /* resource management                                                     */
497
498 static int res_get(struct saa7134_dev *dev, struct saa7134_fh *fh, unsigned int bit)
499 {
500         if (fh->resources & bit)
501                 /* have it already allocated */
502                 return 1;
503
504         /* is it free? */
505         mutex_lock(&dev->lock);
506         if (dev->resources & bit) {
507                 /* no, someone else uses it */
508                 mutex_unlock(&dev->lock);
509                 return 0;
510         }
511         /* it's free, grab it */
512         fh->resources  |= bit;
513         dev->resources |= bit;
514         dprintk("res: get %d\n",bit);
515         mutex_unlock(&dev->lock);
516         return 1;
517 }
518
519 static int res_check(struct saa7134_fh *fh, unsigned int bit)
520 {
521         return (fh->resources & bit);
522 }
523
524 static int res_locked(struct saa7134_dev *dev, unsigned int bit)
525 {
526         return (dev->resources & bit);
527 }
528
529 static
530 void res_free(struct saa7134_dev *dev, struct saa7134_fh *fh, unsigned int bits)
531 {
532         BUG_ON((fh->resources & bits) != bits);
533
534         mutex_lock(&dev->lock);
535         fh->resources  &= ~bits;
536         dev->resources &= ~bits;
537         dprintk("res: put %d\n",bits);
538         mutex_unlock(&dev->lock);
539 }
540
541 /* ------------------------------------------------------------------ */
542
543 static void set_tvnorm(struct saa7134_dev *dev, struct saa7134_tvnorm *norm)
544 {
545         int luma_control,sync_control,mux;
546
547         dprintk("set tv norm = %s\n",norm->name);
548         dev->tvnorm = norm;
549
550         mux = card_in(dev,dev->ctl_input).vmux;
551         luma_control = norm->luma_control;
552         sync_control = norm->sync_control;
553
554         if (mux > 5)
555                 luma_control |= 0x80; /* svideo */
556         if (noninterlaced || dev->nosignal)
557                 sync_control |= 0x20;
558
559         /* setup cropping */
560         dev->crop_bounds.left    = norm->h_start;
561         dev->crop_defrect.left   = norm->h_start;
562         dev->crop_bounds.width   = norm->h_stop - norm->h_start +1;
563         dev->crop_defrect.width  = norm->h_stop - norm->h_start +1;
564
565         dev->crop_bounds.top     = (norm->vbi_v_stop_0+1)*2;
566         dev->crop_defrect.top    = norm->video_v_start*2;
567         dev->crop_bounds.height  = ((norm->id & V4L2_STD_525_60) ? 524 : 624)
568                 - dev->crop_bounds.top;
569         dev->crop_defrect.height = (norm->video_v_stop - norm->video_v_start +1)*2;
570
571         dev->crop_current = dev->crop_defrect;
572
573         /* setup video decoder */
574         saa_writeb(SAA7134_INCR_DELAY,            0x08);
575         saa_writeb(SAA7134_ANALOG_IN_CTRL1,       0xc0 | mux);
576         saa_writeb(SAA7134_ANALOG_IN_CTRL2,       0x00);
577
578         saa_writeb(SAA7134_ANALOG_IN_CTRL3,       0x90);
579         saa_writeb(SAA7134_ANALOG_IN_CTRL4,       0x90);
580         saa_writeb(SAA7134_HSYNC_START,           0xeb);
581         saa_writeb(SAA7134_HSYNC_STOP,            0xe0);
582         saa_writeb(SAA7134_SOURCE_TIMING1,        norm->src_timing);
583
584         saa_writeb(SAA7134_SYNC_CTRL,             sync_control);
585         saa_writeb(SAA7134_LUMA_CTRL,             luma_control);
586         saa_writeb(SAA7134_DEC_LUMA_BRIGHT,       dev->ctl_bright);
587         saa_writeb(SAA7134_DEC_LUMA_CONTRAST,     dev->ctl_contrast);
588
589         saa_writeb(SAA7134_DEC_CHROMA_SATURATION, dev->ctl_saturation);
590         saa_writeb(SAA7134_DEC_CHROMA_HUE,        dev->ctl_hue);
591         saa_writeb(SAA7134_CHROMA_CTRL1,          norm->chroma_ctrl1);
592         saa_writeb(SAA7134_CHROMA_GAIN,           norm->chroma_gain);
593
594         saa_writeb(SAA7134_CHROMA_CTRL2,          norm->chroma_ctrl2);
595         saa_writeb(SAA7134_MODE_DELAY_CTRL,       0x00);
596
597         saa_writeb(SAA7134_ANALOG_ADC,            0x01);
598         saa_writeb(SAA7134_VGATE_START,           0x11);
599         saa_writeb(SAA7134_VGATE_STOP,            0xfe);
600         saa_writeb(SAA7134_MISC_VGATE_MSB,        norm->vgate_misc);
601         saa_writeb(SAA7134_RAW_DATA_GAIN,         0x40);
602         saa_writeb(SAA7134_RAW_DATA_OFFSET,       0x80);
603
604         /* only tell the tuner if this is a tv input */
605         if (card_in(dev,dev->ctl_input).tv) {
606                 if ((card(dev).tuner_type == TUNER_PHILIPS_TDA8290)
607                                 && ((card(dev).tuner_config == 1)
608                                 ||  (card(dev).tuner_config == 2)))
609                         saa7134_set_gpio(dev, 22, 5);
610                 saa7134_i2c_call_clients(dev,VIDIOC_S_STD,&norm->id);
611         }
612 }
613
614 static void video_mux(struct saa7134_dev *dev, int input)
615 {
616         dprintk("video input = %d [%s]\n",input,card_in(dev,input).name);
617         dev->ctl_input = input;
618         set_tvnorm(dev,dev->tvnorm);
619         saa7134_tvaudio_setinput(dev,&card_in(dev,input));
620 }
621
622 static void set_h_prescale(struct saa7134_dev *dev, int task, int prescale)
623 {
624         static const struct {
625                 int xpsc;
626                 int xacl;
627                 int xc2_1;
628                 int xdcg;
629                 int vpfy;
630         } vals[] = {
631                 /* XPSC XACL XC2_1 XDCG VPFY */
632                 {    1,   0,    0,    0,   0 },
633                 {    2,   2,    1,    2,   2 },
634                 {    3,   4,    1,    3,   2 },
635                 {    4,   8,    1,    4,   2 },
636                 {    5,   8,    1,    4,   2 },
637                 {    6,   8,    1,    4,   3 },
638                 {    7,   8,    1,    4,   3 },
639                 {    8,  15,    0,    4,   3 },
640                 {    9,  15,    0,    4,   3 },
641                 {   10,  16,    1,    5,   3 },
642         };
643         static const int count = ARRAY_SIZE(vals);
644         int i;
645
646         for (i = 0; i < count; i++)
647                 if (vals[i].xpsc == prescale)
648                         break;
649         if (i == count)
650                 return;
651
652         saa_writeb(SAA7134_H_PRESCALE(task), vals[i].xpsc);
653         saa_writeb(SAA7134_ACC_LENGTH(task), vals[i].xacl);
654         saa_writeb(SAA7134_LEVEL_CTRL(task),
655                    (vals[i].xc2_1 << 3) | (vals[i].xdcg));
656         saa_andorb(SAA7134_FIR_PREFILTER_CTRL(task), 0x0f,
657                    (vals[i].vpfy << 2) | vals[i].vpfy);
658 }
659
660 static void set_v_scale(struct saa7134_dev *dev, int task, int yscale)
661 {
662         int val,mirror;
663
664         saa_writeb(SAA7134_V_SCALE_RATIO1(task), yscale &  0xff);
665         saa_writeb(SAA7134_V_SCALE_RATIO2(task), yscale >> 8);
666
667         mirror = (dev->ctl_mirror) ? 0x02 : 0x00;
668         if (yscale < 2048) {
669                 /* LPI */
670                 dprintk("yscale LPI yscale=%d\n",yscale);
671                 saa_writeb(SAA7134_V_FILTER(task), 0x00 | mirror);
672                 saa_writeb(SAA7134_LUMA_CONTRAST(task), 0x40);
673                 saa_writeb(SAA7134_CHROMA_SATURATION(task), 0x40);
674         } else {
675                 /* ACM */
676                 val = 0x40 * 1024 / yscale;
677                 dprintk("yscale ACM yscale=%d val=0x%x\n",yscale,val);
678                 saa_writeb(SAA7134_V_FILTER(task), 0x01 | mirror);
679                 saa_writeb(SAA7134_LUMA_CONTRAST(task), val);
680                 saa_writeb(SAA7134_CHROMA_SATURATION(task), val);
681         }
682         saa_writeb(SAA7134_LUMA_BRIGHT(task),       0x80);
683 }
684
685 static void set_size(struct saa7134_dev *dev, int task,
686                      int width, int height, int interlace)
687 {
688         int prescale,xscale,yscale,y_even,y_odd;
689         int h_start, h_stop, v_start, v_stop;
690         int div = interlace ? 2 : 1;
691
692         /* setup video scaler */
693         h_start = dev->crop_current.left;
694         v_start = dev->crop_current.top/2;
695         h_stop  = (dev->crop_current.left + dev->crop_current.width -1);
696         v_stop  = (dev->crop_current.top + dev->crop_current.height -1)/2;
697
698         saa_writeb(SAA7134_VIDEO_H_START1(task), h_start &  0xff);
699         saa_writeb(SAA7134_VIDEO_H_START2(task), h_start >> 8);
700         saa_writeb(SAA7134_VIDEO_H_STOP1(task),  h_stop  &  0xff);
701         saa_writeb(SAA7134_VIDEO_H_STOP2(task),  h_stop  >> 8);
702         saa_writeb(SAA7134_VIDEO_V_START1(task), v_start &  0xff);
703         saa_writeb(SAA7134_VIDEO_V_START2(task), v_start >> 8);
704         saa_writeb(SAA7134_VIDEO_V_STOP1(task),  v_stop  &  0xff);
705         saa_writeb(SAA7134_VIDEO_V_STOP2(task),  v_stop  >> 8);
706
707         prescale = dev->crop_current.width / width;
708         if (0 == prescale)
709                 prescale = 1;
710         xscale = 1024 * dev->crop_current.width / prescale / width;
711         yscale = 512 * div * dev->crop_current.height / height;
712         dprintk("prescale=%d xscale=%d yscale=%d\n",prescale,xscale,yscale);
713         set_h_prescale(dev,task,prescale);
714         saa_writeb(SAA7134_H_SCALE_INC1(task),      xscale &  0xff);
715         saa_writeb(SAA7134_H_SCALE_INC2(task),      xscale >> 8);
716         set_v_scale(dev,task,yscale);
717
718         saa_writeb(SAA7134_VIDEO_PIXELS1(task),     width  & 0xff);
719         saa_writeb(SAA7134_VIDEO_PIXELS2(task),     width  >> 8);
720         saa_writeb(SAA7134_VIDEO_LINES1(task),      height/div & 0xff);
721         saa_writeb(SAA7134_VIDEO_LINES2(task),      height/div >> 8);
722
723         /* deinterlace y offsets */
724         y_odd  = dev->ctl_y_odd;
725         y_even = dev->ctl_y_even;
726         saa_writeb(SAA7134_V_PHASE_OFFSET0(task), y_odd);
727         saa_writeb(SAA7134_V_PHASE_OFFSET1(task), y_even);
728         saa_writeb(SAA7134_V_PHASE_OFFSET2(task), y_odd);
729         saa_writeb(SAA7134_V_PHASE_OFFSET3(task), y_even);
730 }
731
732 /* ------------------------------------------------------------------ */
733
734 struct cliplist {
735         __u16 position;
736         __u8  enable;
737         __u8  disable;
738 };
739
740 static void set_cliplist(struct saa7134_dev *dev, int reg,
741                         struct cliplist *cl, int entries, char *name)
742 {
743         __u8 winbits = 0;
744         int i;
745
746         for (i = 0; i < entries; i++) {
747                 winbits |= cl[i].enable;
748                 winbits &= ~cl[i].disable;
749                 if (i < 15 && cl[i].position == cl[i+1].position)
750                         continue;
751                 saa_writeb(reg + 0, winbits);
752                 saa_writeb(reg + 2, cl[i].position & 0xff);
753                 saa_writeb(reg + 3, cl[i].position >> 8);
754                 dprintk("clip: %s winbits=%02x pos=%d\n",
755                         name,winbits,cl[i].position);
756                 reg += 8;
757         }
758         for (; reg < 0x400; reg += 8) {
759                 saa_writeb(reg+ 0, 0);
760                 saa_writeb(reg + 1, 0);
761                 saa_writeb(reg + 2, 0);
762                 saa_writeb(reg + 3, 0);
763         }
764 }
765
766 static int clip_range(int val)
767 {
768         if (val < 0)
769                 val = 0;
770         return val;
771 }
772
773 /* Sort into smallest position first order */
774 static int cliplist_cmp(const void *a, const void *b)
775 {
776         const struct cliplist *cla = a;
777         const struct cliplist *clb = b;
778         if (cla->position < clb->position)
779                 return -1;
780         if (cla->position > clb->position)
781                 return 1;
782         return 0;
783 }
784
785 static int setup_clipping(struct saa7134_dev *dev, struct v4l2_clip *clips,
786                           int nclips, int interlace)
787 {
788         struct cliplist col[16], row[16];
789         int cols = 0, rows = 0, i;
790         int div = interlace ? 2 : 1;
791
792         memset(col, 0, sizeof(col));
793         memset(row, 0, sizeof(row));
794         for (i = 0; i < nclips && i < 8; i++) {
795                 col[cols].position = clip_range(clips[i].c.left);
796                 col[cols].enable   = (1 << i);
797                 cols++;
798                 col[cols].position = clip_range(clips[i].c.left+clips[i].c.width);
799                 col[cols].disable  = (1 << i);
800                 cols++;
801                 row[rows].position = clip_range(clips[i].c.top / div);
802                 row[rows].enable   = (1 << i);
803                 rows++;
804                 row[rows].position = clip_range((clips[i].c.top + clips[i].c.height)
805                                                 / div);
806                 row[rows].disable  = (1 << i);
807                 rows++;
808         }
809         sort(col, cols, sizeof col[0], cliplist_cmp, NULL);
810         sort(row, rows, sizeof row[0], cliplist_cmp, NULL);
811         set_cliplist(dev,0x380,col,cols,"cols");
812         set_cliplist(dev,0x384,row,rows,"rows");
813         return 0;
814 }
815
816 static int verify_preview(struct saa7134_dev *dev, struct v4l2_window *win)
817 {
818         enum v4l2_field field;
819         int maxw, maxh;
820
821         if (NULL == dev->ovbuf.base)
822                 return -EINVAL;
823         if (NULL == dev->ovfmt)
824                 return -EINVAL;
825         if (win->w.width < 48 || win->w.height <  32)
826                 return -EINVAL;
827         if (win->clipcount > 2048)
828                 return -EINVAL;
829
830         field = win->field;
831         maxw  = dev->crop_current.width;
832         maxh  = dev->crop_current.height;
833
834         if (V4L2_FIELD_ANY == field) {
835                 field = (win->w.height > maxh/2)
836                         ? V4L2_FIELD_INTERLACED
837                         : V4L2_FIELD_TOP;
838         }
839         switch (field) {
840         case V4L2_FIELD_TOP:
841         case V4L2_FIELD_BOTTOM:
842                 maxh = maxh / 2;
843                 break;
844         case V4L2_FIELD_INTERLACED:
845                 break;
846         default:
847                 return -EINVAL;
848         }
849
850         win->field = field;
851         if (win->w.width > maxw)
852                 win->w.width = maxw;
853         if (win->w.height > maxh)
854                 win->w.height = maxh;
855         return 0;
856 }
857
858 static int start_preview(struct saa7134_dev *dev, struct saa7134_fh *fh)
859 {
860         unsigned long base,control,bpl;
861         int err;
862
863         err = verify_preview(dev,&fh->win);
864         if (0 != err)
865                 return err;
866
867         dev->ovfield = fh->win.field;
868         dprintk("start_preview %dx%d+%d+%d %s field=%s\n",
869                 fh->win.w.width,fh->win.w.height,
870                 fh->win.w.left,fh->win.w.top,
871                 dev->ovfmt->name,v4l2_field_names[dev->ovfield]);
872
873         /* setup window + clipping */
874         set_size(dev,TASK_B,fh->win.w.width,fh->win.w.height,
875                  V4L2_FIELD_HAS_BOTH(dev->ovfield));
876         setup_clipping(dev,fh->clips,fh->nclips,
877                        V4L2_FIELD_HAS_BOTH(dev->ovfield));
878         if (dev->ovfmt->yuv)
879                 saa_andorb(SAA7134_DATA_PATH(TASK_B), 0x3f, 0x03);
880         else
881                 saa_andorb(SAA7134_DATA_PATH(TASK_B), 0x3f, 0x01);
882         saa_writeb(SAA7134_OFMT_VIDEO_B, dev->ovfmt->pm | 0x20);
883
884         /* dma: setup channel 1 (= Video Task B) */
885         base  = (unsigned long)dev->ovbuf.base;
886         base += dev->ovbuf.fmt.bytesperline * fh->win.w.top;
887         base += dev->ovfmt->depth/8         * fh->win.w.left;
888         bpl   = dev->ovbuf.fmt.bytesperline;
889         control = SAA7134_RS_CONTROL_BURST_16;
890         if (dev->ovfmt->bswap)
891                 control |= SAA7134_RS_CONTROL_BSWAP;
892         if (dev->ovfmt->wswap)
893                 control |= SAA7134_RS_CONTROL_WSWAP;
894         if (V4L2_FIELD_HAS_BOTH(dev->ovfield)) {
895                 saa_writel(SAA7134_RS_BA1(1),base);
896                 saa_writel(SAA7134_RS_BA2(1),base+bpl);
897                 saa_writel(SAA7134_RS_PITCH(1),bpl*2);
898                 saa_writel(SAA7134_RS_CONTROL(1),control);
899         } else {
900                 saa_writel(SAA7134_RS_BA1(1),base);
901                 saa_writel(SAA7134_RS_BA2(1),base);
902                 saa_writel(SAA7134_RS_PITCH(1),bpl);
903                 saa_writel(SAA7134_RS_CONTROL(1),control);
904         }
905
906         /* start dma */
907         dev->ovenable = 1;
908         saa7134_set_dmabits(dev);
909
910         return 0;
911 }
912
913 static int stop_preview(struct saa7134_dev *dev, struct saa7134_fh *fh)
914 {
915         dev->ovenable = 0;
916         saa7134_set_dmabits(dev);
917         return 0;
918 }
919
920 /* ------------------------------------------------------------------ */
921
922 static int buffer_activate(struct saa7134_dev *dev,
923                            struct saa7134_buf *buf,
924                            struct saa7134_buf *next)
925 {
926         unsigned long base,control,bpl;
927         unsigned long bpl_uv,lines_uv,base2,base3,tmp; /* planar */
928
929         dprintk("buffer_activate buf=%p\n",buf);
930         buf->vb.state = STATE_ACTIVE;
931         buf->top_seen = 0;
932
933         set_size(dev,TASK_A,buf->vb.width,buf->vb.height,
934                  V4L2_FIELD_HAS_BOTH(buf->vb.field));
935         if (buf->fmt->yuv)
936                 saa_andorb(SAA7134_DATA_PATH(TASK_A), 0x3f, 0x03);
937         else
938                 saa_andorb(SAA7134_DATA_PATH(TASK_A), 0x3f, 0x01);
939         saa_writeb(SAA7134_OFMT_VIDEO_A, buf->fmt->pm);
940
941         /* DMA: setup channel 0 (= Video Task A0) */
942         base  = saa7134_buffer_base(buf);
943         if (buf->fmt->planar)
944                 bpl = buf->vb.width;
945         else
946                 bpl = (buf->vb.width * buf->fmt->depth) / 8;
947         control = SAA7134_RS_CONTROL_BURST_16 |
948                 SAA7134_RS_CONTROL_ME |
949                 (buf->pt->dma >> 12);
950         if (buf->fmt->bswap)
951                 control |= SAA7134_RS_CONTROL_BSWAP;
952         if (buf->fmt->wswap)
953                 control |= SAA7134_RS_CONTROL_WSWAP;
954         if (V4L2_FIELD_HAS_BOTH(buf->vb.field)) {
955                 /* interlaced */
956                 saa_writel(SAA7134_RS_BA1(0),base);
957                 saa_writel(SAA7134_RS_BA2(0),base+bpl);
958                 saa_writel(SAA7134_RS_PITCH(0),bpl*2);
959         } else {
960                 /* non-interlaced */
961                 saa_writel(SAA7134_RS_BA1(0),base);
962                 saa_writel(SAA7134_RS_BA2(0),base);
963                 saa_writel(SAA7134_RS_PITCH(0),bpl);
964         }
965         saa_writel(SAA7134_RS_CONTROL(0),control);
966
967         if (buf->fmt->planar) {
968                 /* DMA: setup channel 4+5 (= planar task A) */
969                 bpl_uv   = bpl >> buf->fmt->hshift;
970                 lines_uv = buf->vb.height >> buf->fmt->vshift;
971                 base2    = base + bpl * buf->vb.height;
972                 base3    = base2 + bpl_uv * lines_uv;
973                 if (buf->fmt->uvswap)
974                         tmp = base2, base2 = base3, base3 = tmp;
975                 dprintk("uv: bpl=%ld lines=%ld base2/3=%ld/%ld\n",
976                         bpl_uv,lines_uv,base2,base3);
977                 if (V4L2_FIELD_HAS_BOTH(buf->vb.field)) {
978                         /* interlaced */
979                         saa_writel(SAA7134_RS_BA1(4),base2);
980                         saa_writel(SAA7134_RS_BA2(4),base2+bpl_uv);
981                         saa_writel(SAA7134_RS_PITCH(4),bpl_uv*2);
982                         saa_writel(SAA7134_RS_BA1(5),base3);
983                         saa_writel(SAA7134_RS_BA2(5),base3+bpl_uv);
984                         saa_writel(SAA7134_RS_PITCH(5),bpl_uv*2);
985                 } else {
986                         /* non-interlaced */
987                         saa_writel(SAA7134_RS_BA1(4),base2);
988                         saa_writel(SAA7134_RS_BA2(4),base2);
989                         saa_writel(SAA7134_RS_PITCH(4),bpl_uv);
990                         saa_writel(SAA7134_RS_BA1(5),base3);
991                         saa_writel(SAA7134_RS_BA2(5),base3);
992                         saa_writel(SAA7134_RS_PITCH(5),bpl_uv);
993                 }
994                 saa_writel(SAA7134_RS_CONTROL(4),control);
995                 saa_writel(SAA7134_RS_CONTROL(5),control);
996         }
997
998         /* start DMA */
999         saa7134_set_dmabits(dev);
1000         mod_timer(&dev->video_q.timeout, jiffies+BUFFER_TIMEOUT);
1001         return 0;
1002 }
1003
1004 static int buffer_prepare(struct videobuf_queue *q,
1005                           struct videobuf_buffer *vb,
1006                           enum v4l2_field field)
1007 {
1008         struct saa7134_fh *fh = q->priv_data;
1009         struct saa7134_dev *dev = fh->dev;
1010         struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
1011         unsigned int size;
1012         int err;
1013
1014         /* sanity checks */
1015         if (NULL == fh->fmt)
1016                 return -EINVAL;
1017         if (fh->width    < 48 ||
1018             fh->height   < 32 ||
1019             fh->width/4  > dev->crop_current.width  ||
1020             fh->height/4 > dev->crop_current.height ||
1021             fh->width    > dev->crop_bounds.width  ||
1022             fh->height   > dev->crop_bounds.height)
1023                 return -EINVAL;
1024         size = (fh->width * fh->height * fh->fmt->depth) >> 3;
1025         if (0 != buf->vb.baddr  &&  buf->vb.bsize < size)
1026                 return -EINVAL;
1027
1028         dprintk("buffer_prepare [%d,size=%dx%d,bytes=%d,fields=%s,%s]\n",
1029                 vb->i,fh->width,fh->height,size,v4l2_field_names[field],
1030                 fh->fmt->name);
1031         if (buf->vb.width  != fh->width  ||
1032             buf->vb.height != fh->height ||
1033             buf->vb.size   != size       ||
1034             buf->vb.field  != field      ||
1035             buf->fmt       != fh->fmt) {
1036                 saa7134_dma_free(q,buf);
1037         }
1038
1039         if (STATE_NEEDS_INIT == buf->vb.state) {
1040                 buf->vb.width  = fh->width;
1041                 buf->vb.height = fh->height;
1042                 buf->vb.size   = size;
1043                 buf->vb.field  = field;
1044                 buf->fmt       = fh->fmt;
1045                 buf->pt        = &fh->pt_cap;
1046
1047                 err = videobuf_iolock(q,&buf->vb,&dev->ovbuf);
1048                 if (err)
1049                         goto oops;
1050                 err = saa7134_pgtable_build(dev->pci,buf->pt,
1051                                             buf->vb.dma.sglist,
1052                                             buf->vb.dma.sglen,
1053                                             saa7134_buffer_startpage(buf));
1054                 if (err)
1055                         goto oops;
1056         }
1057         buf->vb.state = STATE_PREPARED;
1058         buf->activate = buffer_activate;
1059         return 0;
1060
1061  oops:
1062         saa7134_dma_free(q,buf);
1063         return err;
1064 }
1065
1066 static int
1067 buffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size)
1068 {
1069         struct saa7134_fh *fh = q->priv_data;
1070
1071         *size = fh->fmt->depth * fh->width * fh->height >> 3;
1072         if (0 == *count)
1073                 *count = gbuffers;
1074         *count = saa7134_buffer_count(*size,*count);
1075         return 0;
1076 }
1077
1078 static void buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb)
1079 {
1080         struct saa7134_fh *fh = q->priv_data;
1081         struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
1082
1083         saa7134_buffer_queue(fh->dev,&fh->dev->video_q,buf);
1084 }
1085
1086 static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb)
1087 {
1088         struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
1089
1090         saa7134_dma_free(q,buf);
1091 }
1092
1093 static struct videobuf_queue_ops video_qops = {
1094         .buf_setup    = buffer_setup,
1095         .buf_prepare  = buffer_prepare,
1096         .buf_queue    = buffer_queue,
1097         .buf_release  = buffer_release,
1098 };
1099
1100 /* ------------------------------------------------------------------ */
1101
1102 static int get_control(struct saa7134_dev *dev, struct v4l2_control *c)
1103 {
1104         const struct v4l2_queryctrl* ctrl;
1105
1106         ctrl = ctrl_by_id(c->id);
1107         if (NULL == ctrl)
1108                 return -EINVAL;
1109         switch (c->id) {
1110         case V4L2_CID_BRIGHTNESS:
1111                 c->value = dev->ctl_bright;
1112                 break;
1113         case V4L2_CID_HUE:
1114                 c->value = dev->ctl_hue;
1115                 break;
1116         case V4L2_CID_CONTRAST:
1117                 c->value = dev->ctl_contrast;
1118                 break;
1119         case V4L2_CID_SATURATION:
1120                 c->value = dev->ctl_saturation;
1121                 break;
1122         case V4L2_CID_AUDIO_MUTE:
1123                 c->value = dev->ctl_mute;
1124                 break;
1125         case V4L2_CID_AUDIO_VOLUME:
1126                 c->value = dev->ctl_volume;
1127                 break;
1128         case V4L2_CID_PRIVATE_INVERT:
1129                 c->value = dev->ctl_invert;
1130                 break;
1131         case V4L2_CID_HFLIP:
1132                 c->value = dev->ctl_mirror;
1133                 break;
1134         case V4L2_CID_PRIVATE_Y_EVEN:
1135                 c->value = dev->ctl_y_even;
1136                 break;
1137         case V4L2_CID_PRIVATE_Y_ODD:
1138                 c->value = dev->ctl_y_odd;
1139                 break;
1140         case V4L2_CID_PRIVATE_AUTOMUTE:
1141                 c->value = dev->ctl_automute;
1142                 break;
1143         default:
1144                 return -EINVAL;
1145         }
1146         return 0;
1147 }
1148
1149 static int set_control(struct saa7134_dev *dev, struct saa7134_fh *fh,
1150                        struct v4l2_control *c)
1151 {
1152         const struct v4l2_queryctrl* ctrl;
1153         unsigned long flags;
1154         int restart_overlay = 0;
1155
1156         ctrl = ctrl_by_id(c->id);
1157         if (NULL == ctrl)
1158                 return -EINVAL;
1159         dprintk("set_control name=%s val=%d\n",ctrl->name,c->value);
1160         switch (ctrl->type) {
1161         case V4L2_CTRL_TYPE_BOOLEAN:
1162         case V4L2_CTRL_TYPE_MENU:
1163         case V4L2_CTRL_TYPE_INTEGER:
1164                 if (c->value < ctrl->minimum)
1165                         c->value = ctrl->minimum;
1166                 if (c->value > ctrl->maximum)
1167                         c->value = ctrl->maximum;
1168                 break;
1169         default:
1170                 /* nothing */;
1171         };
1172         switch (c->id) {
1173         case V4L2_CID_BRIGHTNESS:
1174                 dev->ctl_bright = c->value;
1175                 saa_writeb(SAA7134_DEC_LUMA_BRIGHT, dev->ctl_bright);
1176                 break;
1177         case V4L2_CID_HUE:
1178                 dev->ctl_hue = c->value;
1179                 saa_writeb(SAA7134_DEC_CHROMA_HUE, dev->ctl_hue);
1180                 break;
1181         case V4L2_CID_CONTRAST:
1182                 dev->ctl_contrast = c->value;
1183                 saa_writeb(SAA7134_DEC_LUMA_CONTRAST,
1184                            dev->ctl_invert ? -dev->ctl_contrast : dev->ctl_contrast);
1185                 break;
1186         case V4L2_CID_SATURATION:
1187                 dev->ctl_saturation = c->value;
1188                 saa_writeb(SAA7134_DEC_CHROMA_SATURATION,
1189                            dev->ctl_invert ? -dev->ctl_saturation : dev->ctl_saturation);
1190                 break;
1191         case V4L2_CID_AUDIO_MUTE:
1192                 dev->ctl_mute = c->value;
1193                 saa7134_tvaudio_setmute(dev);
1194                 break;
1195         case V4L2_CID_AUDIO_VOLUME:
1196                 dev->ctl_volume = c->value;
1197                 saa7134_tvaudio_setvolume(dev,dev->ctl_volume);
1198                 break;
1199         case V4L2_CID_PRIVATE_INVERT:
1200                 dev->ctl_invert = c->value;
1201                 saa_writeb(SAA7134_DEC_LUMA_CONTRAST,
1202                            dev->ctl_invert ? -dev->ctl_contrast : dev->ctl_contrast);
1203                 saa_writeb(SAA7134_DEC_CHROMA_SATURATION,
1204                            dev->ctl_invert ? -dev->ctl_saturation : dev->ctl_saturation);
1205                 break;
1206         case V4L2_CID_HFLIP:
1207                 dev->ctl_mirror = c->value;
1208                 restart_overlay = 1;
1209                 break;
1210         case V4L2_CID_PRIVATE_Y_EVEN:
1211                 dev->ctl_y_even = c->value;
1212                 restart_overlay = 1;
1213                 break;
1214         case V4L2_CID_PRIVATE_Y_ODD:
1215                 dev->ctl_y_odd = c->value;
1216                 restart_overlay = 1;
1217                 break;
1218         case V4L2_CID_PRIVATE_AUTOMUTE:
1219                 dev->ctl_automute = c->value;
1220                 if (dev->tda9887_conf) {
1221                         if (dev->ctl_automute)
1222                                 dev->tda9887_conf |= TDA9887_AUTOMUTE;
1223                         else
1224                                 dev->tda9887_conf &= ~TDA9887_AUTOMUTE;
1225                         saa7134_i2c_call_clients(dev, TDA9887_SET_CONFIG,
1226                                                  &dev->tda9887_conf);
1227                 }
1228                 break;
1229         default:
1230                 return -EINVAL;
1231         }
1232         if (restart_overlay && fh && res_check(fh, RESOURCE_OVERLAY)) {
1233                 spin_lock_irqsave(&dev->slock,flags);
1234                 stop_preview(dev,fh);
1235                 start_preview(dev,fh);
1236                 spin_unlock_irqrestore(&dev->slock,flags);
1237         }
1238         return 0;
1239 }
1240
1241 /* ------------------------------------------------------------------ */
1242
1243 static struct videobuf_queue* saa7134_queue(struct saa7134_fh *fh)
1244 {
1245         struct videobuf_queue* q = NULL;
1246
1247         switch (fh->type) {
1248         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
1249                 q = &fh->cap;
1250                 break;
1251         case V4L2_BUF_TYPE_VBI_CAPTURE:
1252                 q = &fh->vbi;
1253                 break;
1254         default:
1255                 BUG();
1256         }
1257         return q;
1258 }
1259
1260 static int saa7134_resource(struct saa7134_fh *fh)
1261 {
1262         if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE)
1263                 return RESOURCE_VIDEO;
1264
1265         if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE)
1266                 return RESOURCE_VBI;
1267
1268         BUG();
1269         return 0;
1270 }
1271
1272 static int video_open(struct inode *inode, struct file *file)
1273 {
1274         int minor = iminor(inode);
1275         struct saa7134_dev *h,*dev = NULL;
1276         struct saa7134_fh *fh;
1277         struct list_head *list;
1278         enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1279         int radio = 0;
1280         list_for_each(list,&saa7134_devlist) {
1281                 h = list_entry(list, struct saa7134_dev, devlist);
1282                 if (h->video_dev && (h->video_dev->minor == minor))
1283                         dev = h;
1284                 if (h->radio_dev && (h->radio_dev->minor == minor)) {
1285                         radio = 1;
1286                         dev = h;
1287                 }
1288                 if (h->vbi_dev && (h->vbi_dev->minor == minor)) {
1289                         type = V4L2_BUF_TYPE_VBI_CAPTURE;
1290                         dev = h;
1291                 }
1292         }
1293         if (NULL == dev)
1294                 return -ENODEV;
1295
1296         dprintk("open minor=%d radio=%d type=%s\n",minor,radio,
1297                 v4l2_type_names[type]);
1298
1299         /* allocate + initialize per filehandle data */
1300         fh = kzalloc(sizeof(*fh),GFP_KERNEL);
1301         if (NULL == fh)
1302                 return -ENOMEM;
1303         file->private_data = fh;
1304         fh->dev      = dev;
1305         fh->radio    = radio;
1306         fh->type     = type;
1307         fh->fmt      = format_by_fourcc(V4L2_PIX_FMT_BGR24);
1308         fh->width    = 720;
1309         fh->height   = 576;
1310         v4l2_prio_open(&dev->prio,&fh->prio);
1311
1312         videobuf_queue_init(&fh->cap, &video_qops,
1313                             dev->pci, &dev->slock,
1314                             V4L2_BUF_TYPE_VIDEO_CAPTURE,
1315                             V4L2_FIELD_INTERLACED,
1316                             sizeof(struct saa7134_buf),
1317                             fh);
1318         videobuf_queue_init(&fh->vbi, &saa7134_vbi_qops,
1319                             dev->pci, &dev->slock,
1320                             V4L2_BUF_TYPE_VBI_CAPTURE,
1321                             V4L2_FIELD_SEQ_TB,
1322                             sizeof(struct saa7134_buf),
1323                             fh);
1324         saa7134_pgtable_alloc(dev->pci,&fh->pt_cap);
1325         saa7134_pgtable_alloc(dev->pci,&fh->pt_vbi);
1326
1327         if (fh->radio) {
1328                 /* switch to radio mode */
1329                 saa7134_tvaudio_setinput(dev,&card(dev).radio);
1330                 saa7134_i2c_call_clients(dev,AUDC_SET_RADIO, NULL);
1331         } else {
1332                 /* switch to video/vbi mode */
1333                 video_mux(dev,dev->ctl_input);
1334         }
1335         return 0;
1336 }
1337
1338 static ssize_t
1339 video_read(struct file *file, char __user *data, size_t count, loff_t *ppos)
1340 {
1341         struct saa7134_fh *fh = file->private_data;
1342
1343         switch (fh->type) {
1344         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
1345                 if (res_locked(fh->dev,RESOURCE_VIDEO))
1346                         return -EBUSY;
1347                 return videobuf_read_one(saa7134_queue(fh),
1348                                          data, count, ppos,
1349                                          file->f_flags & O_NONBLOCK);
1350         case V4L2_BUF_TYPE_VBI_CAPTURE:
1351                 if (!res_get(fh->dev,fh,RESOURCE_VBI))
1352                         return -EBUSY;
1353                 return videobuf_read_stream(saa7134_queue(fh),
1354                                             data, count, ppos, 1,
1355                                             file->f_flags & O_NONBLOCK);
1356                 break;
1357         default:
1358                 BUG();
1359                 return 0;
1360         }
1361 }
1362
1363 static unsigned int
1364 video_poll(struct file *file, struct poll_table_struct *wait)
1365 {
1366         struct saa7134_fh *fh = file->private_data;
1367         struct videobuf_buffer *buf = NULL;
1368
1369         if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type)
1370                 return videobuf_poll_stream(file, &fh->vbi, wait);
1371
1372         if (res_check(fh,RESOURCE_VIDEO)) {
1373                 if (!list_empty(&fh->cap.stream))
1374                         buf = list_entry(fh->cap.stream.next, struct videobuf_buffer, stream);
1375         } else {
1376                 mutex_lock(&fh->cap.lock);
1377                 if (UNSET == fh->cap.read_off) {
1378                         /* need to capture a new frame */
1379                         if (res_locked(fh->dev,RESOURCE_VIDEO)) {
1380                                 mutex_unlock(&fh->cap.lock);
1381                                 return POLLERR;
1382                         }
1383                         if (0 != fh->cap.ops->buf_prepare(&fh->cap,fh->cap.read_buf,fh->cap.field)) {
1384                                 mutex_unlock(&fh->cap.lock);
1385                                 return POLLERR;
1386                         }
1387                         fh->cap.ops->buf_queue(&fh->cap,fh->cap.read_buf);
1388                         fh->cap.read_off = 0;
1389                 }
1390                 mutex_unlock(&fh->cap.lock);
1391                 buf = fh->cap.read_buf;
1392         }
1393
1394         if (!buf)
1395                 return POLLERR;
1396
1397         poll_wait(file, &buf->done, wait);
1398         if (buf->state == STATE_DONE ||
1399             buf->state == STATE_ERROR)
1400                 return POLLIN|POLLRDNORM;
1401         return 0;
1402 }
1403
1404 static int video_release(struct inode *inode, struct file *file)
1405 {
1406         struct saa7134_fh  *fh  = file->private_data;
1407         struct saa7134_dev *dev = fh->dev;
1408         unsigned long flags;
1409
1410         /* turn off overlay */
1411         if (res_check(fh, RESOURCE_OVERLAY)) {
1412                 spin_lock_irqsave(&dev->slock,flags);
1413                 stop_preview(dev,fh);
1414                 spin_unlock_irqrestore(&dev->slock,flags);
1415                 res_free(dev,fh,RESOURCE_OVERLAY);
1416         }
1417
1418         /* stop video capture */
1419         if (res_check(fh, RESOURCE_VIDEO)) {
1420                 videobuf_streamoff(&fh->cap);
1421                 res_free(dev,fh,RESOURCE_VIDEO);
1422         }
1423         if (fh->cap.read_buf) {
1424                 buffer_release(&fh->cap,fh->cap.read_buf);
1425                 kfree(fh->cap.read_buf);
1426         }
1427
1428         /* stop vbi capture */
1429         if (res_check(fh, RESOURCE_VBI)) {
1430                 if (fh->vbi.streaming)
1431                         videobuf_streamoff(&fh->vbi);
1432                 if (fh->vbi.reading)
1433                         videobuf_read_stop(&fh->vbi);
1434                 res_free(dev,fh,RESOURCE_VBI);
1435         }
1436
1437         /* ts-capture will not work in planar mode, so turn it off Hac: 04.05*/
1438         saa_andorb(SAA7134_OFMT_VIDEO_A, 0x1f, 0);
1439         saa_andorb(SAA7134_OFMT_VIDEO_B, 0x1f, 0);
1440         saa_andorb(SAA7134_OFMT_DATA_A, 0x1f, 0);
1441         saa_andorb(SAA7134_OFMT_DATA_B, 0x1f, 0);
1442
1443         saa7134_i2c_call_clients(dev, TUNER_SET_STANDBY, NULL);
1444
1445         /* free stuff */
1446         videobuf_mmap_free(&fh->cap);
1447         videobuf_mmap_free(&fh->vbi);
1448         saa7134_pgtable_free(dev->pci,&fh->pt_cap);
1449         saa7134_pgtable_free(dev->pci,&fh->pt_vbi);
1450
1451         v4l2_prio_close(&dev->prio,&fh->prio);
1452         file->private_data = NULL;
1453         kfree(fh);
1454         return 0;
1455 }
1456
1457 static int video_mmap(struct file *file, struct vm_area_struct * vma)
1458 {
1459         struct saa7134_fh *fh = file->private_data;
1460
1461         return videobuf_mmap_mapper(saa7134_queue(fh), vma);
1462 }
1463
1464 /* ------------------------------------------------------------------ */
1465
1466 static void saa7134_vbi_fmt(struct saa7134_dev *dev, struct v4l2_format *f)
1467 {
1468         struct saa7134_tvnorm *norm = dev->tvnorm;
1469
1470         f->fmt.vbi.sampling_rate = 6750000 * 4;
1471         f->fmt.vbi.samples_per_line = 2048 /* VBI_LINE_LENGTH */;
1472         f->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY;
1473         f->fmt.vbi.offset = 64 * 4;
1474         f->fmt.vbi.start[0] = norm->vbi_v_start_0;
1475         f->fmt.vbi.count[0] = norm->vbi_v_stop_0 - norm->vbi_v_start_0 +1;
1476         f->fmt.vbi.start[1] = norm->vbi_v_start_1;
1477         f->fmt.vbi.count[1] = f->fmt.vbi.count[0];
1478         f->fmt.vbi.flags = 0; /* VBI_UNSYNC VBI_INTERLACED */
1479
1480 }
1481
1482 static int saa7134_g_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
1483                          struct v4l2_format *f)
1484 {
1485         switch (f->type) {
1486         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
1487                 memset(&f->fmt.pix,0,sizeof(f->fmt.pix));
1488                 f->fmt.pix.width        = fh->width;
1489                 f->fmt.pix.height       = fh->height;
1490                 f->fmt.pix.field        = fh->cap.field;
1491                 f->fmt.pix.pixelformat  = fh->fmt->fourcc;
1492                 f->fmt.pix.bytesperline =
1493                         (f->fmt.pix.width * fh->fmt->depth) >> 3;
1494                 f->fmt.pix.sizeimage =
1495                         f->fmt.pix.height * f->fmt.pix.bytesperline;
1496                 return 0;
1497         case V4L2_BUF_TYPE_VIDEO_OVERLAY:
1498                 if (saa7134_no_overlay > 0) {
1499                         printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1500                         return -EINVAL;
1501                 }
1502                 f->fmt.win = fh->win;
1503                 return 0;
1504         case V4L2_BUF_TYPE_VBI_CAPTURE:
1505                 saa7134_vbi_fmt(dev,f);
1506                 return 0;
1507         default:
1508                 return -EINVAL;
1509         }
1510 }
1511
1512 static int saa7134_try_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
1513                            struct v4l2_format *f)
1514 {
1515         int err;
1516
1517         switch (f->type) {
1518         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
1519         {
1520                 struct saa7134_format *fmt;
1521                 enum v4l2_field field;
1522                 unsigned int maxw, maxh;
1523
1524                 fmt = format_by_fourcc(f->fmt.pix.pixelformat);
1525                 if (NULL == fmt)
1526                         return -EINVAL;
1527
1528                 field = f->fmt.pix.field;
1529                 maxw  = min(dev->crop_current.width*4,  dev->crop_bounds.width);
1530                 maxh  = min(dev->crop_current.height*4, dev->crop_bounds.height);
1531
1532                 if (V4L2_FIELD_ANY == field) {
1533                         field = (f->fmt.pix.height > maxh/2)
1534                                 ? V4L2_FIELD_INTERLACED
1535                                 : V4L2_FIELD_BOTTOM;
1536                 }
1537                 switch (field) {
1538                 case V4L2_FIELD_TOP:
1539                 case V4L2_FIELD_BOTTOM:
1540                         maxh = maxh / 2;
1541                         break;
1542                 case V4L2_FIELD_INTERLACED:
1543                         break;
1544                 default:
1545                         return -EINVAL;
1546                 }
1547
1548                 f->fmt.pix.field = field;
1549                 if (f->fmt.pix.width  < 48)
1550                         f->fmt.pix.width  = 48;
1551                 if (f->fmt.pix.height < 32)
1552                         f->fmt.pix.height = 32;
1553                 if (f->fmt.pix.width > maxw)
1554                         f->fmt.pix.width = maxw;
1555                 if (f->fmt.pix.height > maxh)
1556                         f->fmt.pix.height = maxh;
1557                 f->fmt.pix.width &= ~0x03;
1558                 f->fmt.pix.bytesperline =
1559                         (f->fmt.pix.width * fmt->depth) >> 3;
1560                 f->fmt.pix.sizeimage =
1561                         f->fmt.pix.height * f->fmt.pix.bytesperline;
1562
1563                 return 0;
1564         }
1565         case V4L2_BUF_TYPE_VIDEO_OVERLAY:
1566                 if (saa7134_no_overlay > 0) {
1567                         printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1568                         return -EINVAL;
1569                 }
1570                 err = verify_preview(dev,&f->fmt.win);
1571                 if (0 != err)
1572                         return err;
1573                 return 0;
1574         case V4L2_BUF_TYPE_VBI_CAPTURE:
1575                 saa7134_vbi_fmt(dev,f);
1576                 return 0;
1577         default:
1578                 return -EINVAL;
1579         }
1580 }
1581
1582 static int saa7134_s_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
1583                          struct v4l2_format *f)
1584 {
1585         unsigned long flags;
1586         int err;
1587
1588         switch (f->type) {
1589         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
1590                 err = saa7134_try_fmt(dev,fh,f);
1591                 if (0 != err)
1592                         return err;
1593
1594                 fh->fmt       = format_by_fourcc(f->fmt.pix.pixelformat);
1595                 fh->width     = f->fmt.pix.width;
1596                 fh->height    = f->fmt.pix.height;
1597                 fh->cap.field = f->fmt.pix.field;
1598                 return 0;
1599         case V4L2_BUF_TYPE_VIDEO_OVERLAY:
1600                 if (saa7134_no_overlay > 0) {
1601                         printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
1602                         return -EINVAL;
1603                 }
1604                 err = verify_preview(dev,&f->fmt.win);
1605                 if (0 != err)
1606                         return err;
1607
1608                 mutex_lock(&dev->lock);
1609                 fh->win    = f->fmt.win;
1610                 fh->nclips = f->fmt.win.clipcount;
1611                 if (fh->nclips > 8)
1612                         fh->nclips = 8;
1613                 if (copy_from_user(fh->clips,f->fmt.win.clips,
1614                                    sizeof(struct v4l2_clip)*fh->nclips)) {
1615                         mutex_unlock(&dev->lock);
1616                         return -EFAULT;
1617                 }
1618
1619                 if (res_check(fh, RESOURCE_OVERLAY)) {
1620                         spin_lock_irqsave(&dev->slock,flags);
1621                         stop_preview(dev,fh);
1622                         start_preview(dev,fh);
1623                         spin_unlock_irqrestore(&dev->slock,flags);
1624                 }
1625                 mutex_unlock(&dev->lock);
1626                 return 0;
1627         case V4L2_BUF_TYPE_VBI_CAPTURE:
1628                 saa7134_vbi_fmt(dev,f);
1629                 return 0;
1630         default:
1631                 return -EINVAL;
1632         }
1633 }
1634
1635 int saa7134_common_ioctl(struct saa7134_dev *dev,
1636                          unsigned int cmd, void *arg)
1637 {
1638         int err;
1639
1640         switch (cmd) {
1641         case VIDIOC_QUERYCTRL:
1642         {
1643                 const struct v4l2_queryctrl *ctrl;
1644                 struct v4l2_queryctrl *c = arg;
1645
1646                 if ((c->id <  V4L2_CID_BASE ||
1647                      c->id >= V4L2_CID_LASTP1) &&
1648                     (c->id <  V4L2_CID_PRIVATE_BASE ||
1649                      c->id >= V4L2_CID_PRIVATE_LASTP1))
1650                         return -EINVAL;
1651                 ctrl = ctrl_by_id(c->id);
1652                 *c = (NULL != ctrl) ? *ctrl : no_ctrl;
1653                 return 0;
1654         }
1655         case VIDIOC_G_CTRL:
1656                 return get_control(dev,arg);
1657         case VIDIOC_S_CTRL:
1658         {
1659                 mutex_lock(&dev->lock);
1660                 err = set_control(dev,NULL,arg);
1661                 mutex_unlock(&dev->lock);
1662                 return err;
1663         }
1664         /* --- input switching --------------------------------------- */
1665         case VIDIOC_ENUMINPUT:
1666         {
1667                 struct v4l2_input *i = arg;
1668                 unsigned int n;
1669
1670                 n = i->index;
1671                 if (n >= SAA7134_INPUT_MAX)
1672                         return -EINVAL;
1673                 if (NULL == card_in(dev,i->index).name)
1674                         return -EINVAL;
1675                 memset(i,0,sizeof(*i));
1676                 i->index = n;
1677                 i->type  = V4L2_INPUT_TYPE_CAMERA;
1678                 strcpy(i->name,card_in(dev,n).name);
1679                 if (card_in(dev,n).tv)
1680                         i->type = V4L2_INPUT_TYPE_TUNER;
1681                 i->audioset = 1;
1682                 if (n == dev->ctl_input) {
1683                         int v1 = saa_readb(SAA7134_STATUS_VIDEO1);
1684                         int v2 = saa_readb(SAA7134_STATUS_VIDEO2);
1685
1686                         if (0 != (v1 & 0x40))
1687                                 i->status |= V4L2_IN_ST_NO_H_LOCK;
1688                         if (0 != (v2 & 0x40))
1689                                 i->status |= V4L2_IN_ST_NO_SYNC;
1690                         if (0 != (v2 & 0x0e))
1691                                 i->status |= V4L2_IN_ST_MACROVISION;
1692                 }
1693                 for (n = 0; n < TVNORMS; n++)
1694                         i->std |= tvnorms[n].id;
1695                 return 0;
1696         }
1697         case VIDIOC_G_INPUT:
1698         {
1699                 int *i = arg;
1700                 *i = dev->ctl_input;
1701                 return 0;
1702         }
1703         case VIDIOC_S_INPUT:
1704         {
1705                 int *i = arg;
1706
1707                 if (*i < 0  ||  *i >= SAA7134_INPUT_MAX)
1708                         return -EINVAL;
1709                 if (NULL == card_in(dev,*i).name)
1710                         return -EINVAL;
1711                 mutex_lock(&dev->lock);
1712                 video_mux(dev,*i);
1713                 mutex_unlock(&dev->lock);
1714                 return 0;
1715         }
1716
1717         }
1718         return 0;
1719 }
1720 EXPORT_SYMBOL(saa7134_common_ioctl);
1721
1722 /*
1723  * This function is _not_ called directly, but from
1724  * video_generic_ioctl (and maybe others).  userspace
1725  * copying is done already, arg is a kernel pointer.
1726  */
1727 static int video_do_ioctl(struct inode *inode, struct file *file,
1728                           unsigned int cmd, void *arg)
1729 {
1730         struct saa7134_fh *fh = file->private_data;
1731         struct saa7134_dev *dev = fh->dev;
1732         unsigned long flags;
1733         int err;
1734
1735         if (video_debug > 1)
1736                 v4l_print_ioctl(dev->name,cmd);
1737
1738         switch (cmd) {
1739         case VIDIOC_S_CTRL:
1740         case VIDIOC_S_STD:
1741         case VIDIOC_S_INPUT:
1742         case VIDIOC_S_TUNER:
1743         case VIDIOC_S_FREQUENCY:
1744                 err = v4l2_prio_check(&dev->prio,&fh->prio);
1745                 if (0 != err)
1746                         return err;
1747         }
1748
1749         switch (cmd) {
1750         case VIDIOC_QUERYCAP:
1751         {
1752                 struct v4l2_capability *cap = arg;
1753                 unsigned int tuner_type = dev->tuner_type;
1754
1755                 memset(cap,0,sizeof(*cap));
1756                 strcpy(cap->driver, "saa7134");
1757                 strlcpy(cap->card, saa7134_boards[dev->board].name,
1758                         sizeof(cap->card));
1759                 sprintf(cap->bus_info,"PCI:%s",pci_name(dev->pci));
1760                 cap->version = SAA7134_VERSION_CODE;
1761                 cap->capabilities =
1762                         V4L2_CAP_VIDEO_CAPTURE |
1763                         V4L2_CAP_VBI_CAPTURE |
1764                         V4L2_CAP_READWRITE |
1765                         V4L2_CAP_STREAMING |
1766                         V4L2_CAP_TUNER;
1767                 if (saa7134_no_overlay <= 0) {
1768                         cap->capabilities |= V4L2_CAP_VIDEO_OVERLAY;
1769                 }
1770
1771                 if ((tuner_type == TUNER_ABSENT) || (tuner_type == UNSET))
1772                         cap->capabilities &= ~V4L2_CAP_TUNER;
1773
1774                 return 0;
1775         }
1776
1777         /* --- tv standards ------------------------------------------ */
1778         case VIDIOC_ENUMSTD:
1779         {
1780                 struct v4l2_standard *e = arg;
1781                 unsigned int i;
1782
1783                 i = e->index;
1784                 if (i >= TVNORMS)
1785                         return -EINVAL;
1786                 err = v4l2_video_std_construct(e, tvnorms[e->index].id,
1787                                                tvnorms[e->index].name);
1788                 e->index = i;
1789                 if (err < 0)
1790                         return err;
1791                 return 0;
1792         }
1793         case VIDIOC_G_STD:
1794         {
1795                 v4l2_std_id *id = arg;
1796
1797                 *id = dev->tvnorm->id;
1798                 return 0;
1799         }
1800         case VIDIOC_S_STD:
1801         {
1802                 v4l2_std_id *id = arg;
1803                 unsigned int i;
1804                 v4l2_std_id fixup;
1805
1806                 for (i = 0; i < TVNORMS; i++)
1807                         if (*id == tvnorms[i].id)
1808                                 break;
1809                 if (i == TVNORMS)
1810                         for (i = 0; i < TVNORMS; i++)
1811                                 if (*id & tvnorms[i].id)
1812                                         break;
1813                 if (i == TVNORMS)
1814                         return -EINVAL;
1815                 if ((*id & V4L2_STD_SECAM) && (secam[0] != '-')) {
1816                         if (secam[0] == 'L' || secam[0] == 'l') {
1817                                 if (secam[1] == 'C' || secam[1] == 'c')
1818                                         fixup = V4L2_STD_SECAM_LC;
1819                                 else
1820                                         fixup = V4L2_STD_SECAM_L;
1821                         } else {
1822                                 if (secam[0] == 'D' || secam[0] == 'd')
1823                                         fixup = V4L2_STD_SECAM_DK;
1824                                 else
1825                                         fixup = V4L2_STD_SECAM;
1826                         }
1827                         for (i = 0; i < TVNORMS; i++)
1828                                 if (fixup == tvnorms[i].id)
1829                                         break;
1830                 }
1831                 mutex_lock(&dev->lock);
1832                 if (res_check(fh, RESOURCE_OVERLAY)) {
1833                         spin_lock_irqsave(&dev->slock,flags);
1834                         stop_preview(dev,fh);
1835                         set_tvnorm(dev,&tvnorms[i]);
1836                         start_preview(dev,fh);
1837                         spin_unlock_irqrestore(&dev->slock,flags);
1838                 } else
1839                         set_tvnorm(dev,&tvnorms[i]);
1840                 saa7134_tvaudio_do_scan(dev);
1841                 mutex_unlock(&dev->lock);
1842                 return 0;
1843         }
1844
1845         case VIDIOC_CROPCAP:
1846         {
1847                 struct v4l2_cropcap *cap = arg;
1848
1849                 if (cap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
1850                     cap->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
1851                         return -EINVAL;
1852                 cap->bounds  = dev->crop_bounds;
1853                 cap->defrect = dev->crop_defrect;
1854                 cap->pixelaspect.numerator   = 1;
1855                 cap->pixelaspect.denominator = 1;
1856                 if (dev->tvnorm->id & V4L2_STD_525_60) {
1857                         cap->pixelaspect.numerator   = 11;
1858                         cap->pixelaspect.denominator = 10;
1859                 }
1860                 if (dev->tvnorm->id & V4L2_STD_625_50) {
1861                         cap->pixelaspect.numerator   = 54;
1862                         cap->pixelaspect.denominator = 59;
1863                 }
1864                 return 0;
1865         }
1866
1867         case VIDIOC_G_CROP:
1868         {
1869                 struct v4l2_crop * crop = arg;
1870
1871                 if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
1872                     crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
1873                         return -EINVAL;
1874                 crop->c = dev->crop_current;
1875                 return 0;
1876         }
1877         case VIDIOC_S_CROP:
1878         {
1879                 struct v4l2_crop *crop = arg;
1880                 struct v4l2_rect *b = &dev->crop_bounds;
1881
1882                 if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
1883                     crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
1884                         return -EINVAL;
1885                 if (crop->c.height < 0)
1886                         return -EINVAL;
1887                 if (crop->c.width < 0)
1888                         return -EINVAL;
1889
1890                 if (res_locked(fh->dev,RESOURCE_OVERLAY))
1891                         return -EBUSY;
1892                 if (res_locked(fh->dev,RESOURCE_VIDEO))
1893                         return -EBUSY;
1894
1895                 if (crop->c.top < b->top)
1896                         crop->c.top = b->top;
1897                 if (crop->c.top > b->top + b->height)
1898                         crop->c.top = b->top + b->height;
1899                 if (crop->c.height > b->top - crop->c.top + b->height)
1900                         crop->c.height = b->top - crop->c.top + b->height;
1901
1902                 if (crop->c.left < b->left)
1903                         crop->c.left = b->left;
1904                 if (crop->c.left > b->left + b->width)
1905                         crop->c.left = b->left + b->width;
1906                 if (crop->c.width > b->left - crop->c.left + b->width)
1907                         crop->c.width = b->left - crop->c.left + b->width;
1908
1909                 dev->crop_current = crop->c;
1910                 return 0;
1911         }
1912
1913         /* --- tuner ioctls ------------------------------------------ */
1914         case VIDIOC_G_TUNER:
1915         {
1916                 struct v4l2_tuner *t = arg;
1917                 int n;
1918
1919                 if (0 != t->index)
1920                         return -EINVAL;
1921                 memset(t,0,sizeof(*t));
1922                 for (n = 0; n < SAA7134_INPUT_MAX; n++)
1923                         if (card_in(dev,n).tv)
1924                                 break;
1925                 if (NULL != card_in(dev,n).name) {
1926                         strcpy(t->name, "Television");
1927                         t->type = V4L2_TUNER_ANALOG_TV;
1928                         t->capability = V4L2_TUNER_CAP_NORM |
1929                                 V4L2_TUNER_CAP_STEREO |
1930                                 V4L2_TUNER_CAP_LANG1 |
1931                                 V4L2_TUNER_CAP_LANG2;
1932                         t->rangehigh = 0xffffffffUL;
1933                         t->rxsubchans = saa7134_tvaudio_getstereo(dev);
1934                         t->audmode = saa7134_tvaudio_rx2mode(t->rxsubchans);
1935                 }
1936                 if (0 != (saa_readb(SAA7134_STATUS_VIDEO1) & 0x03))
1937                         t->signal = 0xffff;
1938                 return 0;
1939         }
1940         case VIDIOC_S_TUNER:
1941         {
1942                 struct v4l2_tuner *t = arg;
1943                 int rx,mode;
1944
1945                 mode = dev->thread.mode;
1946                 if (UNSET == mode) {
1947                         rx   = saa7134_tvaudio_getstereo(dev);
1948                         mode = saa7134_tvaudio_rx2mode(t->rxsubchans);
1949                 }
1950                 if (mode != t->audmode) {
1951                         dev->thread.mode = t->audmode;
1952                 }
1953                 return 0;
1954         }
1955         case VIDIOC_G_FREQUENCY:
1956         {
1957                 struct v4l2_frequency *f = arg;
1958
1959                 memset(f,0,sizeof(*f));
1960                 f->type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV;
1961                 f->frequency = dev->ctl_freq;
1962                 return 0;
1963         }
1964         case VIDIOC_S_FREQUENCY:
1965         {
1966                 struct v4l2_frequency *f = arg;
1967
1968                 if (0 != f->tuner)
1969                         return -EINVAL;
1970                 if (0 == fh->radio && V4L2_TUNER_ANALOG_TV != f->type)
1971                         return -EINVAL;
1972                 if (1 == fh->radio && V4L2_TUNER_RADIO != f->type)
1973                         return -EINVAL;
1974                 mutex_lock(&dev->lock);
1975                 dev->ctl_freq = f->frequency;
1976
1977                 saa7134_i2c_call_clients(dev,VIDIOC_S_FREQUENCY,f);
1978
1979                 saa7134_tvaudio_do_scan(dev);
1980                 mutex_unlock(&dev->lock);
1981                 return 0;
1982         }
1983
1984         /* --- control ioctls ---------------------------------------- */
1985         case VIDIOC_ENUMINPUT:
1986         case VIDIOC_G_INPUT:
1987         case VIDIOC_S_INPUT:
1988         case VIDIOC_QUERYCTRL:
1989         case VIDIOC_G_CTRL:
1990         case VIDIOC_S_CTRL:
1991                 return saa7134_common_ioctl(dev, cmd, arg);
1992
1993         case VIDIOC_G_AUDIO:
1994         {
1995                 struct v4l2_audio *a = arg;
1996
1997                 memset(a,0,sizeof(*a));
1998                 strcpy(a->name,"audio");
1999                 return 0;
2000         }
2001         case VIDIOC_S_AUDIO:
2002                 return 0;
2003         case VIDIOC_G_PARM:
2004         {
2005                 struct v4l2_captureparm *parm = arg;
2006                 memset(parm,0,sizeof(*parm));
2007                 return 0;
2008         }
2009
2010         case VIDIOC_G_PRIORITY:
2011         {
2012                 enum v4l2_priority *p = arg;
2013
2014                 *p = v4l2_prio_max(&dev->prio);
2015                 return 0;
2016         }
2017         case VIDIOC_S_PRIORITY:
2018         {
2019                 enum v4l2_priority *prio = arg;
2020
2021                 return v4l2_prio_change(&dev->prio, &fh->prio, *prio);
2022         }
2023
2024         /* --- preview ioctls ---------------------------------------- */
2025         case VIDIOC_ENUM_FMT:
2026         {
2027                 struct v4l2_fmtdesc *f = arg;
2028                 enum v4l2_buf_type type;
2029                 unsigned int index;
2030
2031                 index = f->index;
2032                 type  = f->type;
2033                 switch (type) {
2034                 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
2035                 case V4L2_BUF_TYPE_VIDEO_OVERLAY:
2036                         if (saa7134_no_overlay > 0) {
2037                                 printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
2038                                 return -EINVAL;
2039                         }
2040                         if (index >= FORMATS)
2041                                 return -EINVAL;
2042                         if (f->type == V4L2_BUF_TYPE_VIDEO_OVERLAY &&
2043                             formats[index].planar)
2044                                 return -EINVAL;
2045                         memset(f,0,sizeof(*f));
2046                         f->index = index;
2047                         f->type  = type;
2048                         strlcpy(f->description,formats[index].name,sizeof(f->description));
2049                         f->pixelformat = formats[index].fourcc;
2050                         break;
2051                 case V4L2_BUF_TYPE_VBI_CAPTURE:
2052                         if (0 != index)
2053                                 return -EINVAL;
2054                         memset(f,0,sizeof(*f));
2055                         f->index = index;
2056                         f->type  = type;
2057                         f->pixelformat = V4L2_PIX_FMT_GREY;
2058                         strcpy(f->description,"vbi data");
2059                         break;
2060                 default:
2061                         return -EINVAL;
2062                 }
2063                 return 0;
2064         }
2065         case VIDIOC_G_FBUF:
2066         {
2067                 struct v4l2_framebuffer *fb = arg;
2068
2069                 *fb = dev->ovbuf;
2070                 fb->capability = V4L2_FBUF_CAP_LIST_CLIPPING;
2071                 return 0;
2072         }
2073         case VIDIOC_S_FBUF:
2074         {
2075                 struct v4l2_framebuffer *fb = arg;
2076                 struct saa7134_format *fmt;
2077
2078                 if(!capable(CAP_SYS_ADMIN) &&
2079                    !capable(CAP_SYS_RAWIO))
2080                         return -EPERM;
2081
2082                 /* check args */
2083                 fmt = format_by_fourcc(fb->fmt.pixelformat);
2084                 if (NULL == fmt)
2085                         return -EINVAL;
2086
2087                 /* ok, accept it */
2088                 dev->ovbuf = *fb;
2089                 dev->ovfmt = fmt;
2090                 if (0 == dev->ovbuf.fmt.bytesperline)
2091                         dev->ovbuf.fmt.bytesperline =
2092                                 dev->ovbuf.fmt.width*fmt->depth/8;
2093                 return 0;
2094         }
2095         case VIDIOC_OVERLAY:
2096         {
2097                 int *on = arg;
2098
2099                 if (*on) {
2100                         if (saa7134_no_overlay > 0) {
2101                                 printk ("no_overlay\n");
2102                                 return -EINVAL;
2103                         }
2104
2105                         if (!res_get(dev,fh,RESOURCE_OVERLAY))
2106                                 return -EBUSY;
2107                         spin_lock_irqsave(&dev->slock,flags);
2108                         start_preview(dev,fh);
2109                         spin_unlock_irqrestore(&dev->slock,flags);
2110                 }
2111                 if (!*on) {
2112                         if (!res_check(fh, RESOURCE_OVERLAY))
2113                                 return -EINVAL;
2114                         spin_lock_irqsave(&dev->slock,flags);
2115                         stop_preview(dev,fh);
2116                         spin_unlock_irqrestore(&dev->slock,flags);
2117                         res_free(dev,fh,RESOURCE_OVERLAY);
2118                 }
2119                 return 0;
2120         }
2121
2122         /* --- capture ioctls ---------------------------------------- */
2123         case VIDIOC_G_FMT:
2124         {
2125                 struct v4l2_format *f = arg;
2126                 return saa7134_g_fmt(dev,fh,f);
2127         }
2128         case VIDIOC_S_FMT:
2129         {
2130                 struct v4l2_format *f = arg;
2131                 return saa7134_s_fmt(dev,fh,f);
2132         }
2133         case VIDIOC_TRY_FMT:
2134         {
2135                 struct v4l2_format *f = arg;
2136                 return saa7134_try_fmt(dev,fh,f);
2137         }
2138 #ifdef CONFIG_VIDEO_V4L1_COMPAT
2139         case VIDIOCGMBUF:
2140         {
2141                 struct video_mbuf *mbuf = arg;
2142                 struct videobuf_queue *q;
2143                 struct v4l2_requestbuffers req;
2144                 unsigned int i;
2145
2146                 q = saa7134_queue(fh);
2147                 memset(&req,0,sizeof(req));
2148                 req.type   = q->type;
2149                 req.count  = gbuffers;
2150                 req.memory = V4L2_MEMORY_MMAP;
2151                 err = videobuf_reqbufs(q,&req);
2152                 if (err < 0)
2153                         return err;
2154                 memset(mbuf,0,sizeof(*mbuf));
2155                 mbuf->frames = req.count;
2156                 mbuf->size   = 0;
2157                 for (i = 0; i < mbuf->frames; i++) {
2158                         mbuf->offsets[i]  = q->bufs[i]->boff;
2159                         mbuf->size       += q->bufs[i]->bsize;
2160                 }
2161                 return 0;
2162         }
2163 #endif
2164         case VIDIOC_REQBUFS:
2165                 return videobuf_reqbufs(saa7134_queue(fh),arg);
2166
2167         case VIDIOC_QUERYBUF:
2168                 return videobuf_querybuf(saa7134_queue(fh),arg);
2169
2170         case VIDIOC_QBUF:
2171                 return videobuf_qbuf(saa7134_queue(fh),arg);
2172
2173         case VIDIOC_DQBUF:
2174                 return videobuf_dqbuf(saa7134_queue(fh),arg,
2175                                       file->f_flags & O_NONBLOCK);
2176
2177         case VIDIOC_STREAMON:
2178         {
2179                 int res = saa7134_resource(fh);
2180
2181                 if (!res_get(dev,fh,res))
2182                         return -EBUSY;
2183                 return videobuf_streamon(saa7134_queue(fh));
2184         }
2185         case VIDIOC_STREAMOFF:
2186         {
2187                 int res = saa7134_resource(fh);
2188
2189                 err = videobuf_streamoff(saa7134_queue(fh));
2190                 if (err < 0)
2191                         return err;
2192                 res_free(dev,fh,res);
2193                 return 0;
2194         }
2195
2196         default:
2197                 return v4l_compat_translate_ioctl(inode,file,cmd,arg,
2198                                                   video_do_ioctl);
2199         }
2200         return 0;
2201 }
2202
2203 static int video_ioctl(struct inode *inode, struct file *file,
2204                        unsigned int cmd, unsigned long arg)
2205 {
2206         return video_usercopy(inode, file, cmd, arg, video_do_ioctl);
2207 }
2208
2209 static int radio_do_ioctl(struct inode *inode, struct file *file,
2210                           unsigned int cmd, void *arg)
2211 {
2212         struct saa7134_fh *fh = file->private_data;
2213         struct saa7134_dev *dev = fh->dev;
2214
2215         if (video_debug > 1)
2216                 v4l_print_ioctl(dev->name,cmd);
2217         switch (cmd) {
2218         case VIDIOC_QUERYCAP:
2219         {
2220                 struct v4l2_capability *cap = arg;
2221
2222                 memset(cap,0,sizeof(*cap));
2223                 strcpy(cap->driver, "saa7134");
2224                 strlcpy(cap->card, saa7134_boards[dev->board].name,
2225                         sizeof(cap->card));
2226                 sprintf(cap->bus_info,"PCI:%s",pci_name(dev->pci));
2227                 cap->version = SAA7134_VERSION_CODE;
2228                 cap->capabilities = V4L2_CAP_TUNER;
2229                 return 0;
2230         }
2231         case VIDIOC_G_TUNER:
2232         {
2233                 struct v4l2_tuner *t = arg;
2234
2235                 if (0 != t->index)
2236                         return -EINVAL;
2237
2238                 memset(t,0,sizeof(*t));
2239                 strcpy(t->name, "Radio");
2240                 t->type = V4L2_TUNER_RADIO;
2241
2242                 saa7134_i2c_call_clients(dev, VIDIOC_G_TUNER, t);
2243                 if (dev->input->amux == TV) {
2244                         t->signal = 0xf800 - ((saa_readb(0x581) & 0x1f) << 11);
2245                         t->rxsubchans = (saa_readb(0x529) & 0x08) ?
2246                                         V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO;
2247                 }
2248                 return 0;
2249         }
2250         case VIDIOC_S_TUNER:
2251         {
2252                 struct v4l2_tuner *t = arg;
2253
2254                 if (0 != t->index)
2255                         return -EINVAL;
2256
2257                 saa7134_i2c_call_clients(dev,VIDIOC_S_TUNER,t);
2258
2259                 return 0;
2260         }
2261         case VIDIOC_ENUMINPUT:
2262         {
2263                 struct v4l2_input *i = arg;
2264
2265                 if (i->index != 0)
2266                         return -EINVAL;
2267                 strcpy(i->name,"Radio");
2268                 i->type = V4L2_INPUT_TYPE_TUNER;
2269                 return 0;
2270         }
2271         case VIDIOC_G_INPUT:
2272         {
2273                 int *i = arg;
2274                 *i = 0;
2275                 return 0;
2276         }
2277         case VIDIOC_G_AUDIO:
2278         {
2279                 struct v4l2_audio *a = arg;
2280
2281                 memset(a,0,sizeof(*a));
2282                 strcpy(a->name,"Radio");
2283                 return 0;
2284         }
2285         case VIDIOC_G_STD:
2286         {
2287                 v4l2_std_id *id = arg;
2288                 *id = 0;
2289                 return 0;
2290         }
2291         case VIDIOC_S_AUDIO:
2292         case VIDIOC_S_INPUT:
2293         case VIDIOC_S_STD:
2294                 return 0;
2295
2296         case VIDIOC_QUERYCTRL:
2297         {
2298                 const struct v4l2_queryctrl *ctrl;
2299                 struct v4l2_queryctrl *c = arg;
2300
2301                 if (c->id <  V4L2_CID_BASE ||
2302                     c->id >= V4L2_CID_LASTP1)
2303                         return -EINVAL;
2304                 if (c->id == V4L2_CID_AUDIO_MUTE) {
2305                         ctrl = ctrl_by_id(c->id);
2306                         *c = *ctrl;
2307                 } else
2308                         *c = no_ctrl;
2309                 return 0;
2310         }
2311
2312         case VIDIOC_G_CTRL:
2313         case VIDIOC_S_CTRL:
2314         case VIDIOC_G_FREQUENCY:
2315         case VIDIOC_S_FREQUENCY:
2316                 return video_do_ioctl(inode,file,cmd,arg);
2317
2318         default:
2319                 return v4l_compat_translate_ioctl(inode,file,cmd,arg,
2320                                                   radio_do_ioctl);
2321         }
2322         return 0;
2323 }
2324
2325 static int radio_ioctl(struct inode *inode, struct file *file,
2326                        unsigned int cmd, unsigned long arg)
2327 {
2328         return video_usercopy(inode, file, cmd, arg, radio_do_ioctl);
2329 }
2330
2331 static const struct file_operations video_fops =
2332 {
2333         .owner    = THIS_MODULE,
2334         .open     = video_open,
2335         .release  = video_release,
2336         .read     = video_read,
2337         .poll     = video_poll,
2338         .mmap     = video_mmap,
2339         .ioctl    = video_ioctl,
2340         .compat_ioctl   = v4l_compat_ioctl32,
2341         .llseek   = no_llseek,
2342 };
2343
2344 static const struct file_operations radio_fops =
2345 {
2346         .owner    = THIS_MODULE,
2347         .open     = video_open,
2348         .release  = video_release,
2349         .ioctl    = radio_ioctl,
2350         .compat_ioctl   = v4l_compat_ioctl32,
2351         .llseek   = no_llseek,
2352 };
2353
2354 /* ----------------------------------------------------------- */
2355 /* exported stuff                                              */
2356
2357 struct video_device saa7134_video_template =
2358 {
2359         .name          = "saa7134-video",
2360         .type          = VID_TYPE_CAPTURE|VID_TYPE_TUNER|
2361                          VID_TYPE_CLIPPING|VID_TYPE_SCALES,
2362         .hardware      = 0,
2363         .fops          = &video_fops,
2364         .minor         = -1,
2365 };
2366
2367 struct video_device saa7134_vbi_template =
2368 {
2369         .name          = "saa7134-vbi",
2370         .type          = VID_TYPE_TUNER|VID_TYPE_TELETEXT,
2371         .hardware      = 0,
2372         .fops          = &video_fops,
2373         .minor         = -1,
2374 };
2375
2376 struct video_device saa7134_radio_template =
2377 {
2378         .name          = "saa7134-radio",
2379         .type          = VID_TYPE_TUNER,
2380         .hardware      = 0,
2381         .fops          = &radio_fops,
2382         .minor         = -1,
2383 };
2384
2385 int saa7134_video_init1(struct saa7134_dev *dev)
2386 {
2387         /* sanitycheck insmod options */
2388         if (gbuffers < 2 || gbuffers > VIDEO_MAX_FRAME)
2389                 gbuffers = 2;
2390         if (gbufsize < 0 || gbufsize > gbufsize_max)
2391                 gbufsize = gbufsize_max;
2392         gbufsize = (gbufsize + PAGE_SIZE - 1) & PAGE_MASK;
2393
2394         /* put some sensible defaults into the data structures ... */
2395         dev->ctl_bright     = ctrl_by_id(V4L2_CID_BRIGHTNESS)->default_value;
2396         dev->ctl_contrast   = ctrl_by_id(V4L2_CID_CONTRAST)->default_value;
2397         dev->ctl_hue        = ctrl_by_id(V4L2_CID_HUE)->default_value;
2398         dev->ctl_saturation = ctrl_by_id(V4L2_CID_SATURATION)->default_value;
2399         dev->ctl_volume     = ctrl_by_id(V4L2_CID_AUDIO_VOLUME)->default_value;
2400         dev->ctl_mute       = 1; // ctrl_by_id(V4L2_CID_AUDIO_MUTE)->default_value;
2401         dev->ctl_invert     = ctrl_by_id(V4L2_CID_PRIVATE_INVERT)->default_value;
2402         dev->ctl_automute   = ctrl_by_id(V4L2_CID_PRIVATE_AUTOMUTE)->default_value;
2403
2404         if (dev->tda9887_conf && dev->ctl_automute)
2405                 dev->tda9887_conf |= TDA9887_AUTOMUTE;
2406         dev->automute       = 0;
2407
2408         INIT_LIST_HEAD(&dev->video_q.queue);
2409         init_timer(&dev->video_q.timeout);
2410         dev->video_q.timeout.function = saa7134_buffer_timeout;
2411         dev->video_q.timeout.data     = (unsigned long)(&dev->video_q);
2412         dev->video_q.dev              = dev;
2413
2414         if (saa7134_boards[dev->board].video_out) {
2415                 /* enable video output */
2416                 int vo = saa7134_boards[dev->board].video_out;
2417                 int video_reg;
2418                 unsigned int vid_port_opts = saa7134_boards[dev->board].vid_port_opts;
2419                 saa_writeb(SAA7134_VIDEO_PORT_CTRL0, video_out[vo][0]);
2420                 video_reg = video_out[vo][1];
2421                 if (vid_port_opts & SET_T_CODE_POLARITY_NON_INVERTED)
2422                         video_reg &= ~VP_T_CODE_P_INVERTED;
2423                 saa_writeb(SAA7134_VIDEO_PORT_CTRL1, video_reg);
2424                 saa_writeb(SAA7134_VIDEO_PORT_CTRL2, video_out[vo][2]);
2425                 saa_writeb(SAA7134_VIDEO_PORT_CTRL3, video_out[vo][3]);
2426                 saa_writeb(SAA7134_VIDEO_PORT_CTRL4, video_out[vo][4]);
2427                 video_reg = video_out[vo][5];
2428                 if (vid_port_opts & SET_CLOCK_NOT_DELAYED)
2429                         video_reg &= ~VP_CLK_CTRL2_DELAYED;
2430                 if (vid_port_opts & SET_CLOCK_INVERTED)
2431                         video_reg |= VP_CLK_CTRL1_INVERTED;
2432                 saa_writeb(SAA7134_VIDEO_PORT_CTRL5, video_reg);
2433                 video_reg = video_out[vo][6];
2434                 if (vid_port_opts & SET_VSYNC_OFF) {
2435                         video_reg &= ~VP_VS_TYPE_MASK;
2436                         video_reg |= VP_VS_TYPE_OFF;
2437                 }
2438                 saa_writeb(SAA7134_VIDEO_PORT_CTRL6, video_reg);
2439                 saa_writeb(SAA7134_VIDEO_PORT_CTRL7, video_out[vo][7]);
2440                 saa_writeb(SAA7134_VIDEO_PORT_CTRL8, video_out[vo][8]);
2441         }
2442
2443         return 0;
2444 }
2445
2446 int saa7134_video_init2(struct saa7134_dev *dev)
2447 {
2448         /* init video hw */
2449         set_tvnorm(dev,&tvnorms[0]);
2450         video_mux(dev,0);
2451         saa7134_tvaudio_setmute(dev);
2452         saa7134_tvaudio_setvolume(dev,dev->ctl_volume);
2453         return 0;
2454 }
2455
2456 void saa7134_irq_video_intl(struct saa7134_dev *dev)
2457 {
2458         static const char *st[] = {
2459                 "(no signal)", "NTSC", "PAL", "SECAM" };
2460         u32 st1,st2;
2461
2462         st1 = saa_readb(SAA7134_STATUS_VIDEO1);
2463         st2 = saa_readb(SAA7134_STATUS_VIDEO2);
2464         dprintk("DCSDT: pll: %s, sync: %s, norm: %s\n",
2465                 (st1 & 0x40) ? "not locked" : "locked",
2466                 (st2 & 0x40) ? "no"         : "yes",
2467                 st[st1 & 0x03]);
2468         dev->nosignal = (st1 & 0x40) || (st2 & 0x40);
2469
2470         if (dev->nosignal) {
2471                 /* no video signal -> mute audio */
2472                 if (dev->ctl_automute)
2473                         dev->automute = 1;
2474                 saa7134_tvaudio_setmute(dev);
2475                 saa_setb(SAA7134_SYNC_CTRL, 0x20);
2476         } else {
2477                 /* wake up tvaudio audio carrier scan thread */
2478                 saa7134_tvaudio_do_scan(dev);
2479                 if (!noninterlaced)
2480                         saa_clearb(SAA7134_SYNC_CTRL, 0x20);
2481         }
2482         if (dev->mops && dev->mops->signal_change)
2483                 dev->mops->signal_change(dev);
2484 }
2485
2486 void saa7134_irq_video_done(struct saa7134_dev *dev, unsigned long status)
2487 {
2488         enum v4l2_field field;
2489
2490         spin_lock(&dev->slock);
2491         if (dev->video_q.curr) {
2492                 dev->video_fieldcount++;
2493                 field = dev->video_q.curr->vb.field;
2494                 if (V4L2_FIELD_HAS_BOTH(field)) {
2495                         /* make sure we have seen both fields */
2496                         if ((status & 0x10) == 0x00) {
2497                                 dev->video_q.curr->top_seen = 1;
2498                                 goto done;
2499                         }
2500                         if (!dev->video_q.curr->top_seen)
2501                                 goto done;
2502                 } else if (field == V4L2_FIELD_TOP) {
2503                         if ((status & 0x10) != 0x10)
2504                                 goto done;
2505                 } else if (field == V4L2_FIELD_BOTTOM) {
2506                         if ((status & 0x10) != 0x00)
2507                                 goto done;
2508                 }
2509                 dev->video_q.curr->vb.field_count = dev->video_fieldcount;
2510                 saa7134_buffer_finish(dev,&dev->video_q,STATE_DONE);
2511         }
2512         saa7134_buffer_next(dev,&dev->video_q);
2513
2514  done:
2515         spin_unlock(&dev->slock);
2516 }
2517
2518 /* ----------------------------------------------------------- */
2519 /*
2520  * Local variables:
2521  * c-basic-offset: 8
2522  * End:
2523  */