Version:  2.0.40 2.2.26 2.4.37 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17 3.18 3.19 4.0 4.1 4.2 4.3 4.4 4.5 4.6

Linux/drivers/media/pci/bt8xx/bttv-driver.c

  1 /*
  2 
  3     bttv - Bt848 frame grabber driver
  4 
  5     Copyright (C) 1996,97,98 Ralph  Metzler <rjkm@thp.uni-koeln.de>
  6                            & Marcus Metzler <mocm@thp.uni-koeln.de>
  7     (c) 1999-2002 Gerd Knorr <kraxel@bytesex.org>
  8 
  9     some v4l2 code lines are taken from Justin's bttv2 driver which is
 10     (c) 2000 Justin Schoeman <justin@suntiger.ee.up.ac.za>
 11 
 12     V4L1 removal from:
 13     (c) 2005-2006 Nickolay V. Shmyrev <nshmyrev@yandex.ru>
 14 
 15     Fixes to be fully V4L2 compliant by
 16     (c) 2006 Mauro Carvalho Chehab <mchehab@infradead.org>
 17 
 18     Cropping and overscan support
 19     Copyright (C) 2005, 2006 Michael H. Schimek <mschimek@gmx.at>
 20     Sponsored by OPQ Systems AB
 21 
 22     This program is free software; you can redistribute it and/or modify
 23     it under the terms of the GNU General Public License as published by
 24     the Free Software Foundation; either version 2 of the License, or
 25     (at your option) any later version.
 26 
 27     This program is distributed in the hope that it will be useful,
 28     but WITHOUT ANY WARRANTY; without even the implied warranty of
 29     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 30     GNU General Public License for more details.
 31 
 32     You should have received a copy of the GNU General Public License
 33     along with this program; if not, write to the Free Software
 34     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 35 */
 36 
 37 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 38 
 39 #include <linux/init.h>
 40 #include <linux/module.h>
 41 #include <linux/delay.h>
 42 #include <linux/slab.h>
 43 #include <linux/errno.h>
 44 #include <linux/fs.h>
 45 #include <linux/kernel.h>
 46 #include <linux/sched.h>
 47 #include <linux/interrupt.h>
 48 #include <linux/kdev_t.h>
 49 #include "bttvp.h"
 50 #include <media/v4l2-common.h>
 51 #include <media/v4l2-ioctl.h>
 52 #include <media/v4l2-event.h>
 53 #include <media/i2c/tvaudio.h>
 54 #include <media/drv-intf/msp3400.h>
 55 
 56 #include <linux/dma-mapping.h>
 57 
 58 #include <asm/io.h>
 59 #include <asm/byteorder.h>
 60 
 61 #include <media/i2c/saa6588.h>
 62 
 63 #define BTTV_VERSION "0.9.19"
 64 
 65 unsigned int bttv_num;                  /* number of Bt848s in use */
 66 struct bttv *bttvs[BTTV_MAX];
 67 
 68 unsigned int bttv_debug;
 69 unsigned int bttv_verbose = 1;
 70 unsigned int bttv_gpio;
 71 
 72 /* config variables */
 73 #ifdef __BIG_ENDIAN
 74 static unsigned int bigendian=1;
 75 #else
 76 static unsigned int bigendian;
 77 #endif
 78 static unsigned int radio[BTTV_MAX];
 79 static unsigned int irq_debug;
 80 static unsigned int gbuffers = 8;
 81 static unsigned int gbufsize = 0x208000;
 82 static unsigned int reset_crop = 1;
 83 
 84 static int video_nr[BTTV_MAX] = { [0 ... (BTTV_MAX-1)] = -1 };
 85 static int radio_nr[BTTV_MAX] = { [0 ... (BTTV_MAX-1)] = -1 };
 86 static int vbi_nr[BTTV_MAX] = { [0 ... (BTTV_MAX-1)] = -1 };
 87 static int debug_latency;
 88 static int disable_ir;
 89 
 90 static unsigned int fdsr;
 91 
 92 /* options */
 93 static unsigned int combfilter;
 94 static unsigned int lumafilter;
 95 static unsigned int automute    = 1;
 96 static unsigned int chroma_agc;
 97 static unsigned int agc_crush   = 1;
 98 static unsigned int whitecrush_upper = 0xCF;
 99 static unsigned int whitecrush_lower = 0x7F;
100 static unsigned int vcr_hack;
101 static unsigned int irq_iswitch;
102 static unsigned int uv_ratio    = 50;
103 static unsigned int full_luma_range;
104 static unsigned int coring;
105 
106 /* API features (turn on/off stuff for testing) */
107 static unsigned int v4l2        = 1;
108 
109 /* insmod args */
110 module_param(bttv_verbose,      int, 0644);
111 module_param(bttv_gpio,         int, 0644);
112 module_param(bttv_debug,        int, 0644);
113 module_param(irq_debug,         int, 0644);
114 module_param(debug_latency,     int, 0644);
115 module_param(disable_ir,        int, 0444);
116 
117 module_param(fdsr,              int, 0444);
118 module_param(gbuffers,          int, 0444);
119 module_param(gbufsize,          int, 0444);
120 module_param(reset_crop,        int, 0444);
121 
122 module_param(v4l2,              int, 0644);
123 module_param(bigendian,         int, 0644);
124 module_param(irq_iswitch,       int, 0644);
125 module_param(combfilter,        int, 0444);
126 module_param(lumafilter,        int, 0444);
127 module_param(automute,          int, 0444);
128 module_param(chroma_agc,        int, 0444);
129 module_param(agc_crush,         int, 0444);
130 module_param(whitecrush_upper,  int, 0444);
131 module_param(whitecrush_lower,  int, 0444);
132 module_param(vcr_hack,          int, 0444);
133 module_param(uv_ratio,          int, 0444);
134 module_param(full_luma_range,   int, 0444);
135 module_param(coring,            int, 0444);
136 
137 module_param_array(radio,       int, NULL, 0444);
138 module_param_array(video_nr,    int, NULL, 0444);
139 module_param_array(radio_nr,    int, NULL, 0444);
140 module_param_array(vbi_nr,      int, NULL, 0444);
141 
142 MODULE_PARM_DESC(radio, "The TV card supports radio, default is 0 (no)");
143 MODULE_PARM_DESC(bigendian, "byte order of the framebuffer, default is native endian");
144 MODULE_PARM_DESC(bttv_verbose, "verbose startup messages, default is 1 (yes)");
145 MODULE_PARM_DESC(bttv_gpio, "log gpio changes, default is 0 (no)");
146 MODULE_PARM_DESC(bttv_debug, "debug messages, default is 0 (no)");
147 MODULE_PARM_DESC(irq_debug, "irq handler debug messages, default is 0 (no)");
148 MODULE_PARM_DESC(disable_ir, "disable infrared remote support");
149 MODULE_PARM_DESC(gbuffers, "number of capture buffers. range 2-32, default 8");
150 MODULE_PARM_DESC(gbufsize, "size of the capture buffers, default is 0x208000");
151 MODULE_PARM_DESC(reset_crop, "reset cropping parameters at open(), default "
152                  "is 1 (yes) for compatibility with older applications");
153 MODULE_PARM_DESC(automute, "mute audio on bad/missing video signal, default is 1 (yes)");
154 MODULE_PARM_DESC(chroma_agc, "enables the AGC of chroma signal, default is 0 (no)");
155 MODULE_PARM_DESC(agc_crush, "enables the luminance AGC crush, default is 1 (yes)");
156 MODULE_PARM_DESC(whitecrush_upper, "sets the white crush upper value, default is 207");
157 MODULE_PARM_DESC(whitecrush_lower, "sets the white crush lower value, default is 127");
158 MODULE_PARM_DESC(vcr_hack, "enables the VCR hack (improves synch on poor VCR tapes), default is 0 (no)");
159 MODULE_PARM_DESC(irq_iswitch, "switch inputs in irq handler");
160 MODULE_PARM_DESC(uv_ratio, "ratio between u and v gains, default is 50");
161 MODULE_PARM_DESC(full_luma_range, "use the full luma range, default is 0 (no)");
162 MODULE_PARM_DESC(coring, "set the luma coring level, default is 0 (no)");
163 MODULE_PARM_DESC(video_nr, "video device numbers");
164 MODULE_PARM_DESC(vbi_nr, "vbi device numbers");
165 MODULE_PARM_DESC(radio_nr, "radio device numbers");
166 
167 MODULE_DESCRIPTION("bttv - v4l/v4l2 driver module for bt848/878 based cards");
168 MODULE_AUTHOR("Ralph Metzler & Marcus Metzler & Gerd Knorr");
169 MODULE_LICENSE("GPL");
170 MODULE_VERSION(BTTV_VERSION);
171 
172 #define V4L2_CID_PRIVATE_COMBFILTER             (V4L2_CID_USER_BTTV_BASE + 0)
173 #define V4L2_CID_PRIVATE_AUTOMUTE               (V4L2_CID_USER_BTTV_BASE + 1)
174 #define V4L2_CID_PRIVATE_LUMAFILTER             (V4L2_CID_USER_BTTV_BASE + 2)
175 #define V4L2_CID_PRIVATE_AGC_CRUSH              (V4L2_CID_USER_BTTV_BASE + 3)
176 #define V4L2_CID_PRIVATE_VCR_HACK               (V4L2_CID_USER_BTTV_BASE + 4)
177 #define V4L2_CID_PRIVATE_WHITECRUSH_LOWER       (V4L2_CID_USER_BTTV_BASE + 5)
178 #define V4L2_CID_PRIVATE_WHITECRUSH_UPPER       (V4L2_CID_USER_BTTV_BASE + 6)
179 #define V4L2_CID_PRIVATE_UV_RATIO               (V4L2_CID_USER_BTTV_BASE + 7)
180 #define V4L2_CID_PRIVATE_FULL_LUMA_RANGE        (V4L2_CID_USER_BTTV_BASE + 8)
181 #define V4L2_CID_PRIVATE_CORING                 (V4L2_CID_USER_BTTV_BASE + 9)
182 
183 /* ----------------------------------------------------------------------- */
184 /* sysfs                                                                   */
185 
186 static ssize_t show_card(struct device *cd,
187                          struct device_attribute *attr, char *buf)
188 {
189         struct video_device *vfd = to_video_device(cd);
190         struct bttv *btv = video_get_drvdata(vfd);
191         return sprintf(buf, "%d\n", btv ? btv->c.type : UNSET);
192 }
193 static DEVICE_ATTR(card, S_IRUGO, show_card, NULL);
194 
195 /* ----------------------------------------------------------------------- */
196 /* dvb auto-load setup                                                     */
197 #if defined(CONFIG_MODULES) && defined(MODULE)
198 static void request_module_async(struct work_struct *work)
199 {
200         request_module("dvb-bt8xx");
201 }
202 
203 static void request_modules(struct bttv *dev)
204 {
205         INIT_WORK(&dev->request_module_wk, request_module_async);
206         schedule_work(&dev->request_module_wk);
207 }
208 
209 static void flush_request_modules(struct bttv *dev)
210 {
211         flush_work(&dev->request_module_wk);
212 }
213 #else
214 #define request_modules(dev)
215 #define flush_request_modules(dev) do {} while(0)
216 #endif /* CONFIG_MODULES */
217 
218 
219 /* ----------------------------------------------------------------------- */
220 /* static data                                                             */
221 
222 /* special timing tables from conexant... */
223 static u8 SRAM_Table[][60] =
224 {
225         /* PAL digital input over GPIO[7:0] */
226         {
227                 45, // 45 bytes following
228                 0x36,0x11,0x01,0x00,0x90,0x02,0x05,0x10,0x04,0x16,
229                 0x12,0x05,0x11,0x00,0x04,0x12,0xC0,0x00,0x31,0x00,
230                 0x06,0x51,0x08,0x03,0x89,0x08,0x07,0xC0,0x44,0x00,
231                 0x81,0x01,0x01,0xA9,0x0D,0x02,0x02,0x50,0x03,0x37,
232                 0x37,0x00,0xAF,0x21,0x00
233         },
234         /* NTSC digital input over GPIO[7:0] */
235         {
236                 51, // 51 bytes following
237                 0x0C,0xC0,0x00,0x00,0x90,0x02,0x03,0x10,0x03,0x06,
238                 0x10,0x04,0x12,0x12,0x05,0x02,0x13,0x04,0x19,0x00,
239                 0x04,0x39,0x00,0x06,0x59,0x08,0x03,0x83,0x08,0x07,
240                 0x03,0x50,0x00,0xC0,0x40,0x00,0x86,0x01,0x01,0xA6,
241                 0x0D,0x02,0x03,0x11,0x01,0x05,0x37,0x00,0xAC,0x21,
242                 0x00,
243         },
244         // TGB_NTSC392 // quartzsight
245         // This table has been modified to be used for Fusion Rev D
246         {
247                 0x2A, // size of table = 42
248                 0x06, 0x08, 0x04, 0x0a, 0xc0, 0x00, 0x18, 0x08, 0x03, 0x24,
249                 0x08, 0x07, 0x02, 0x90, 0x02, 0x08, 0x10, 0x04, 0x0c, 0x10,
250                 0x05, 0x2c, 0x11, 0x04, 0x55, 0x48, 0x00, 0x05, 0x50, 0x00,
251                 0xbf, 0x0c, 0x02, 0x2f, 0x3d, 0x00, 0x2f, 0x3f, 0x00, 0xc3,
252                 0x20, 0x00
253         }
254 };
255 
256 /* minhdelayx1  first video pixel we can capture on a line and
257    hdelayx1     start of active video, both relative to rising edge of
258                 /HRESET pulse (0H) in 1 / fCLKx1.
259    swidth       width of active video and
260    totalwidth   total line width, both in 1 / fCLKx1.
261    sqwidth      total line width in square pixels.
262    vdelay       start of active video in 2 * field lines relative to
263                 trailing edge of /VRESET pulse (VDELAY register).
264    sheight      height of active video in 2 * field lines.
265    extraheight  Added to sheight for cropcap.bounds.height only
266    videostart0  ITU-R frame line number of the line corresponding
267                 to vdelay in the first field. */
268 #define CROPCAP(minhdelayx1, hdelayx1, swidth, totalwidth, sqwidth,      \
269                 vdelay, sheight, extraheight, videostart0)               \
270         .cropcap.bounds.left = minhdelayx1,                              \
271         /* * 2 because vertically we count field lines times two, */     \
272         /* e.g. 23 * 2 to 23 * 2 + 576 in PAL-BGHI defrect. */           \
273         .cropcap.bounds.top = (videostart0) * 2 - (vdelay) + MIN_VDELAY, \
274         /* 4 is a safety margin at the end of the line. */               \
275         .cropcap.bounds.width = (totalwidth) - (minhdelayx1) - 4,        \
276         .cropcap.bounds.height = (sheight) + (extraheight) + (vdelay) -  \
277                                  MIN_VDELAY,                             \
278         .cropcap.defrect.left = hdelayx1,                                \
279         .cropcap.defrect.top = (videostart0) * 2,                        \
280         .cropcap.defrect.width = swidth,                                 \
281         .cropcap.defrect.height = sheight,                               \
282         .cropcap.pixelaspect.numerator = totalwidth,                     \
283         .cropcap.pixelaspect.denominator = sqwidth,
284 
285 const struct bttv_tvnorm bttv_tvnorms[] = {
286         /* PAL-BDGHI */
287         /* max. active video is actually 922, but 924 is divisible by 4 and 3! */
288         /* actually, max active PAL with HSCALE=0 is 948, NTSC is 768 - nil */
289         {
290                 .v4l2_id        = V4L2_STD_PAL,
291                 .name           = "PAL",
292                 .Fsc            = 35468950,
293                 .swidth         = 924,
294                 .sheight        = 576,
295                 .totalwidth     = 1135,
296                 .adelay         = 0x7f,
297                 .bdelay         = 0x72,
298                 .iform          = (BT848_IFORM_PAL_BDGHI|BT848_IFORM_XT1),
299                 .scaledtwidth   = 1135,
300                 .hdelayx1       = 186,
301                 .hactivex1      = 924,
302                 .vdelay         = 0x20,
303                 .vbipack        = 255, /* min (2048 / 4, 0x1ff) & 0xff */
304                 .sram           = 0,
305                 /* ITU-R frame line number of the first VBI line
306                    we can capture, of the first and second field.
307                    The last line is determined by cropcap.bounds. */
308                 .vbistart       = { 7, 320 },
309                 CROPCAP(/* minhdelayx1 */ 68,
310                         /* hdelayx1 */ 186,
311                         /* Should be (768 * 1135 + 944 / 2) / 944.
312                            cropcap.defrect is used for image width
313                            checks, so we keep the old value 924. */
314                         /* swidth */ 924,
315                         /* totalwidth */ 1135,
316                         /* sqwidth */ 944,
317                         /* vdelay */ 0x20,
318                         /* sheight */ 576,
319                         /* bt878 (and bt848?) can capture another
320                            line below active video. */
321                         /* extraheight */ 2,
322                         /* videostart0 */ 23)
323         },{
324                 .v4l2_id        = V4L2_STD_NTSC_M | V4L2_STD_NTSC_M_KR,
325                 .name           = "NTSC",
326                 .Fsc            = 28636363,
327                 .swidth         = 768,
328                 .sheight        = 480,
329                 .totalwidth     = 910,
330                 .adelay         = 0x68,
331                 .bdelay         = 0x5d,
332                 .iform          = (BT848_IFORM_NTSC|BT848_IFORM_XT0),
333                 .scaledtwidth   = 910,
334                 .hdelayx1       = 128,
335                 .hactivex1      = 910,
336                 .vdelay         = 0x1a,
337                 .vbipack        = 144, /* min (1600 / 4, 0x1ff) & 0xff */
338                 .sram           = 1,
339                 .vbistart       = { 10, 273 },
340                 CROPCAP(/* minhdelayx1 */ 68,
341                         /* hdelayx1 */ 128,
342                         /* Should be (640 * 910 + 780 / 2) / 780? */
343                         /* swidth */ 768,
344                         /* totalwidth */ 910,
345                         /* sqwidth */ 780,
346                         /* vdelay */ 0x1a,
347                         /* sheight */ 480,
348                         /* extraheight */ 0,
349                         /* videostart0 */ 23)
350         },{
351                 .v4l2_id        = V4L2_STD_SECAM,
352                 .name           = "SECAM",
353                 .Fsc            = 35468950,
354                 .swidth         = 924,
355                 .sheight        = 576,
356                 .totalwidth     = 1135,
357                 .adelay         = 0x7f,
358                 .bdelay         = 0xb0,
359                 .iform          = (BT848_IFORM_SECAM|BT848_IFORM_XT1),
360                 .scaledtwidth   = 1135,
361                 .hdelayx1       = 186,
362                 .hactivex1      = 922,
363                 .vdelay         = 0x20,
364                 .vbipack        = 255,
365                 .sram           = 0, /* like PAL, correct? */
366                 .vbistart       = { 7, 320 },
367                 CROPCAP(/* minhdelayx1 */ 68,
368                         /* hdelayx1 */ 186,
369                         /* swidth */ 924,
370                         /* totalwidth */ 1135,
371                         /* sqwidth */ 944,
372                         /* vdelay */ 0x20,
373                         /* sheight */ 576,
374                         /* extraheight */ 0,
375                         /* videostart0 */ 23)
376         },{
377                 .v4l2_id        = V4L2_STD_PAL_Nc,
378                 .name           = "PAL-Nc",
379                 .Fsc            = 28636363,
380                 .swidth         = 640,
381                 .sheight        = 576,
382                 .totalwidth     = 910,
383                 .adelay         = 0x68,
384                 .bdelay         = 0x5d,
385                 .iform          = (BT848_IFORM_PAL_NC|BT848_IFORM_XT0),
386                 .scaledtwidth   = 780,
387                 .hdelayx1       = 130,
388                 .hactivex1      = 734,
389                 .vdelay         = 0x1a,
390                 .vbipack        = 144,
391                 .sram           = -1,
392                 .vbistart       = { 7, 320 },
393                 CROPCAP(/* minhdelayx1 */ 68,
394                         /* hdelayx1 */ 130,
395                         /* swidth */ (640 * 910 + 780 / 2) / 780,
396                         /* totalwidth */ 910,
397                         /* sqwidth */ 780,
398                         /* vdelay */ 0x1a,
399                         /* sheight */ 576,
400                         /* extraheight */ 0,
401                         /* videostart0 */ 23)
402         },{
403                 .v4l2_id        = V4L2_STD_PAL_M,
404                 .name           = "PAL-M",
405                 .Fsc            = 28636363,
406                 .swidth         = 640,
407                 .sheight        = 480,
408                 .totalwidth     = 910,
409                 .adelay         = 0x68,
410                 .bdelay         = 0x5d,
411                 .iform          = (BT848_IFORM_PAL_M|BT848_IFORM_XT0),
412                 .scaledtwidth   = 780,
413                 .hdelayx1       = 135,
414                 .hactivex1      = 754,
415                 .vdelay         = 0x1a,
416                 .vbipack        = 144,
417                 .sram           = -1,
418                 .vbistart       = { 10, 273 },
419                 CROPCAP(/* minhdelayx1 */ 68,
420                         /* hdelayx1 */ 135,
421                         /* swidth */ (640 * 910 + 780 / 2) / 780,
422                         /* totalwidth */ 910,
423                         /* sqwidth */ 780,
424                         /* vdelay */ 0x1a,
425                         /* sheight */ 480,
426                         /* extraheight */ 0,
427                         /* videostart0 */ 23)
428         },{
429                 .v4l2_id        = V4L2_STD_PAL_N,
430                 .name           = "PAL-N",
431                 .Fsc            = 35468950,
432                 .swidth         = 768,
433                 .sheight        = 576,
434                 .totalwidth     = 1135,
435                 .adelay         = 0x7f,
436                 .bdelay         = 0x72,
437                 .iform          = (BT848_IFORM_PAL_N|BT848_IFORM_XT1),
438                 .scaledtwidth   = 944,
439                 .hdelayx1       = 186,
440                 .hactivex1      = 922,
441                 .vdelay         = 0x20,
442                 .vbipack        = 144,
443                 .sram           = -1,
444                 .vbistart       = { 7, 320 },
445                 CROPCAP(/* minhdelayx1 */ 68,
446                         /* hdelayx1 */ 186,
447                         /* swidth */ (768 * 1135 + 944 / 2) / 944,
448                         /* totalwidth */ 1135,
449                         /* sqwidth */ 944,
450                         /* vdelay */ 0x20,
451                         /* sheight */ 576,
452                         /* extraheight */ 0,
453                         /* videostart0 */ 23)
454         },{
455                 .v4l2_id        = V4L2_STD_NTSC_M_JP,
456                 .name           = "NTSC-JP",
457                 .Fsc            = 28636363,
458                 .swidth         = 640,
459                 .sheight        = 480,
460                 .totalwidth     = 910,
461                 .adelay         = 0x68,
462                 .bdelay         = 0x5d,
463                 .iform          = (BT848_IFORM_NTSC_J|BT848_IFORM_XT0),
464                 .scaledtwidth   = 780,
465                 .hdelayx1       = 135,
466                 .hactivex1      = 754,
467                 .vdelay         = 0x16,
468                 .vbipack        = 144,
469                 .sram           = -1,
470                 .vbistart       = { 10, 273 },
471                 CROPCAP(/* minhdelayx1 */ 68,
472                         /* hdelayx1 */ 135,
473                         /* swidth */ (640 * 910 + 780 / 2) / 780,
474                         /* totalwidth */ 910,
475                         /* sqwidth */ 780,
476                         /* vdelay */ 0x16,
477                         /* sheight */ 480,
478                         /* extraheight */ 0,
479                         /* videostart0 */ 23)
480         },{
481                 /* that one hopefully works with the strange timing
482                  * which video recorders produce when playing a NTSC
483                  * tape on a PAL TV ... */
484                 .v4l2_id        = V4L2_STD_PAL_60,
485                 .name           = "PAL-60",
486                 .Fsc            = 35468950,
487                 .swidth         = 924,
488                 .sheight        = 480,
489                 .totalwidth     = 1135,
490                 .adelay         = 0x7f,
491                 .bdelay         = 0x72,
492                 .iform          = (BT848_IFORM_PAL_BDGHI|BT848_IFORM_XT1),
493                 .scaledtwidth   = 1135,
494                 .hdelayx1       = 186,
495                 .hactivex1      = 924,
496                 .vdelay         = 0x1a,
497                 .vbipack        = 255,
498                 .vtotal         = 524,
499                 .sram           = -1,
500                 .vbistart       = { 10, 273 },
501                 CROPCAP(/* minhdelayx1 */ 68,
502                         /* hdelayx1 */ 186,
503                         /* swidth */ 924,
504                         /* totalwidth */ 1135,
505                         /* sqwidth */ 944,
506                         /* vdelay */ 0x1a,
507                         /* sheight */ 480,
508                         /* extraheight */ 0,
509                         /* videostart0 */ 23)
510         }
511 };
512 static const unsigned int BTTV_TVNORMS = ARRAY_SIZE(bttv_tvnorms);
513 
514 /* ----------------------------------------------------------------------- */
515 /* bttv format list
516    packed pixel formats must come first */
517 static const struct bttv_format formats[] = {
518         {
519                 .name     = "8 bpp, gray",
520                 .fourcc   = V4L2_PIX_FMT_GREY,
521                 .btformat = BT848_COLOR_FMT_Y8,
522                 .depth    = 8,
523                 .flags    = FORMAT_FLAGS_PACKED,
524         },{
525                 .name     = "8 bpp, dithered color",
526                 .fourcc   = V4L2_PIX_FMT_HI240,
527                 .btformat = BT848_COLOR_FMT_RGB8,
528                 .depth    = 8,
529                 .flags    = FORMAT_FLAGS_PACKED | FORMAT_FLAGS_DITHER,
530         },{
531                 .name     = "15 bpp RGB, le",
532                 .fourcc   = V4L2_PIX_FMT_RGB555,
533                 .btformat = BT848_COLOR_FMT_RGB15,
534                 .depth    = 16,
535                 .flags    = FORMAT_FLAGS_PACKED,
536         },{
537                 .name     = "15 bpp RGB, be",
538                 .fourcc   = V4L2_PIX_FMT_RGB555X,
539                 .btformat = BT848_COLOR_FMT_RGB15,
540                 .btswap   = 0x03, /* byteswap */
541                 .depth    = 16,
542                 .flags    = FORMAT_FLAGS_PACKED,
543         },{
544                 .name     = "16 bpp RGB, le",
545                 .fourcc   = V4L2_PIX_FMT_RGB565,
546                 .btformat = BT848_COLOR_FMT_RGB16,
547                 .depth    = 16,
548                 .flags    = FORMAT_FLAGS_PACKED,
549         },{
550                 .name     = "16 bpp RGB, be",
551                 .fourcc   = V4L2_PIX_FMT_RGB565X,
552                 .btformat = BT848_COLOR_FMT_RGB16,
553                 .btswap   = 0x03, /* byteswap */
554                 .depth    = 16,
555                 .flags    = FORMAT_FLAGS_PACKED,
556         },{
557                 .name     = "24 bpp RGB, le",
558                 .fourcc   = V4L2_PIX_FMT_BGR24,
559                 .btformat = BT848_COLOR_FMT_RGB24,
560                 .depth    = 24,
561                 .flags    = FORMAT_FLAGS_PACKED,
562         },{
563                 .name     = "32 bpp RGB, le",
564                 .fourcc   = V4L2_PIX_FMT_BGR32,
565                 .btformat = BT848_COLOR_FMT_RGB32,
566                 .depth    = 32,
567                 .flags    = FORMAT_FLAGS_PACKED,
568         },{
569                 .name     = "32 bpp RGB, be",
570                 .fourcc   = V4L2_PIX_FMT_RGB32,
571                 .btformat = BT848_COLOR_FMT_RGB32,
572                 .btswap   = 0x0f, /* byte+word swap */
573                 .depth    = 32,
574                 .flags    = FORMAT_FLAGS_PACKED,
575         },{
576                 .name     = "4:2:2, packed, YUYV",
577                 .fourcc   = V4L2_PIX_FMT_YUYV,
578                 .btformat = BT848_COLOR_FMT_YUY2,
579                 .depth    = 16,
580                 .flags    = FORMAT_FLAGS_PACKED,
581         },{
582                 .name     = "4:2:2, packed, UYVY",
583                 .fourcc   = V4L2_PIX_FMT_UYVY,
584                 .btformat = BT848_COLOR_FMT_YUY2,
585                 .btswap   = 0x03, /* byteswap */
586                 .depth    = 16,
587                 .flags    = FORMAT_FLAGS_PACKED,
588         },{
589                 .name     = "4:2:2, planar, Y-Cb-Cr",
590                 .fourcc   = V4L2_PIX_FMT_YUV422P,
591                 .btformat = BT848_COLOR_FMT_YCrCb422,
592                 .depth    = 16,
593                 .flags    = FORMAT_FLAGS_PLANAR,
594                 .hshift   = 1,
595                 .vshift   = 0,
596         },{
597                 .name     = "4:2:0, planar, Y-Cb-Cr",
598                 .fourcc   = V4L2_PIX_FMT_YUV420,
599                 .btformat = BT848_COLOR_FMT_YCrCb422,
600                 .depth    = 12,
601                 .flags    = FORMAT_FLAGS_PLANAR,
602                 .hshift   = 1,
603                 .vshift   = 1,
604         },{
605                 .name     = "4:2:0, planar, Y-Cr-Cb",
606                 .fourcc   = V4L2_PIX_FMT_YVU420,
607                 .btformat = BT848_COLOR_FMT_YCrCb422,
608                 .depth    = 12,
609                 .flags    = FORMAT_FLAGS_PLANAR | FORMAT_FLAGS_CrCb,
610                 .hshift   = 1,
611                 .vshift   = 1,
612         },{
613                 .name     = "4:1:1, planar, Y-Cb-Cr",
614                 .fourcc   = V4L2_PIX_FMT_YUV411P,
615                 .btformat = BT848_COLOR_FMT_YCrCb411,
616                 .depth    = 12,
617                 .flags    = FORMAT_FLAGS_PLANAR,
618                 .hshift   = 2,
619                 .vshift   = 0,
620         },{
621                 .name     = "4:1:0, planar, Y-Cb-Cr",
622                 .fourcc   = V4L2_PIX_FMT_YUV410,
623                 .btformat = BT848_COLOR_FMT_YCrCb411,
624                 .depth    = 9,
625                 .flags    = FORMAT_FLAGS_PLANAR,
626                 .hshift   = 2,
627                 .vshift   = 2,
628         },{
629                 .name     = "4:1:0, planar, Y-Cr-Cb",
630                 .fourcc   = V4L2_PIX_FMT_YVU410,
631                 .btformat = BT848_COLOR_FMT_YCrCb411,
632                 .depth    = 9,
633                 .flags    = FORMAT_FLAGS_PLANAR | FORMAT_FLAGS_CrCb,
634                 .hshift   = 2,
635                 .vshift   = 2,
636         },{
637                 .name     = "raw scanlines",
638                 .fourcc   = -1,
639                 .btformat = BT848_COLOR_FMT_RAW,
640                 .depth    = 8,
641                 .flags    = FORMAT_FLAGS_RAW,
642         }
643 };
644 static const unsigned int FORMATS = ARRAY_SIZE(formats);
645 
646 /* ----------------------------------------------------------------------- */
647 /* resource management                                                     */
648 
649 /*
650    RESOURCE_    allocated by                freed by
651 
652    VIDEO_READ   bttv_read 1)                bttv_read 2)
653 
654    VIDEO_STREAM VIDIOC_STREAMON             VIDIOC_STREAMOFF
655                  VIDIOC_QBUF 1)              bttv_release
656                  VIDIOCMCAPTURE 1)
657 
658    OVERLAY       VIDIOCCAPTURE on            VIDIOCCAPTURE off
659                  VIDIOC_OVERLAY on           VIDIOC_OVERLAY off
660                  3)                          bttv_release
661 
662    VBI           VIDIOC_STREAMON             VIDIOC_STREAMOFF
663                  VIDIOC_QBUF 1)              bttv_release
664                  bttv_read, bttv_poll 1) 4)
665 
666    1) The resource must be allocated when we enter buffer prepare functions
667       and remain allocated while buffers are in the DMA queue.
668    2) This is a single frame read.
669    3) VIDIOC_S_FBUF and VIDIOC_S_FMT (OVERLAY) still work when
670       RESOURCE_OVERLAY is allocated.
671    4) This is a continuous read, implies VIDIOC_STREAMON.
672 
673    Note this driver permits video input and standard changes regardless if
674    resources are allocated.
675 */
676 
677 #define VBI_RESOURCES (RESOURCE_VBI)
678 #define VIDEO_RESOURCES (RESOURCE_VIDEO_READ | \
679                          RESOURCE_VIDEO_STREAM | \
680                          RESOURCE_OVERLAY)
681 
682 static
683 int check_alloc_btres_lock(struct bttv *btv, struct bttv_fh *fh, int bit)
684 {
685         int xbits; /* mutual exclusive resources */
686 
687         if (fh->resources & bit)
688                 /* have it already allocated */
689                 return 1;
690 
691         xbits = bit;
692         if (bit & (RESOURCE_VIDEO_READ | RESOURCE_VIDEO_STREAM))
693                 xbits |= RESOURCE_VIDEO_READ | RESOURCE_VIDEO_STREAM;
694 
695         /* is it free? */
696         if (btv->resources & xbits) {
697                 /* no, someone else uses it */
698                 goto fail;
699         }
700 
701         if ((bit & VIDEO_RESOURCES)
702             && 0 == (btv->resources & VIDEO_RESOURCES)) {
703                 /* Do crop - use current, don't - use default parameters. */
704                 __s32 top = btv->crop[!!fh->do_crop].rect.top;
705 
706                 if (btv->vbi_end > top)
707                         goto fail;
708 
709                 /* We cannot capture the same line as video and VBI data.
710                    Claim scan lines crop[].rect.top to bottom. */
711                 btv->crop_start = top;
712         } else if (bit & VBI_RESOURCES) {
713                 __s32 end = fh->vbi_fmt.end;
714 
715                 if (end > btv->crop_start)
716                         goto fail;
717 
718                 /* Claim scan lines above fh->vbi_fmt.end. */
719                 btv->vbi_end = end;
720         }
721 
722         /* it's free, grab it */
723         fh->resources  |= bit;
724         btv->resources |= bit;
725         return 1;
726 
727  fail:
728         return 0;
729 }
730 
731 static
732 int check_btres(struct bttv_fh *fh, int bit)
733 {
734         return (fh->resources & bit);
735 }
736 
737 static
738 int locked_btres(struct bttv *btv, int bit)
739 {
740         return (btv->resources & bit);
741 }
742 
743 /* Call with btv->lock down. */
744 static void
745 disclaim_vbi_lines(struct bttv *btv)
746 {
747         btv->vbi_end = 0;
748 }
749 
750 /* Call with btv->lock down. */
751 static void
752 disclaim_video_lines(struct bttv *btv)
753 {
754         const struct bttv_tvnorm *tvnorm;
755         u8 crop;
756 
757         tvnorm = &bttv_tvnorms[btv->tvnorm];
758         btv->crop_start = tvnorm->cropcap.bounds.top
759                 + tvnorm->cropcap.bounds.height;
760 
761         /* VBI capturing ends at VDELAY, start of video capturing, no
762            matter how many lines the VBI RISC program expects. When video
763            capturing is off, it shall no longer "preempt" VBI capturing,
764            so we set VDELAY to maximum. */
765         crop = btread(BT848_E_CROP) | 0xc0;
766         btwrite(crop, BT848_E_CROP);
767         btwrite(0xfe, BT848_E_VDELAY_LO);
768         btwrite(crop, BT848_O_CROP);
769         btwrite(0xfe, BT848_O_VDELAY_LO);
770 }
771 
772 static
773 void free_btres_lock(struct bttv *btv, struct bttv_fh *fh, int bits)
774 {
775         if ((fh->resources & bits) != bits) {
776                 /* trying to free resources not allocated by us ... */
777                 pr_err("BUG! (btres)\n");
778         }
779         fh->resources  &= ~bits;
780         btv->resources &= ~bits;
781 
782         bits = btv->resources;
783 
784         if (0 == (bits & VIDEO_RESOURCES))
785                 disclaim_video_lines(btv);
786 
787         if (0 == (bits & VBI_RESOURCES))
788                 disclaim_vbi_lines(btv);
789 }
790 
791 /* ----------------------------------------------------------------------- */
792 /* If Bt848a or Bt849, use PLL for PAL/SECAM and crystal for NTSC          */
793 
794 /* Frequency = (F_input / PLL_X) * PLL_I.PLL_F/PLL_C
795    PLL_X = Reference pre-divider (0=1, 1=2)
796    PLL_C = Post divider (0=6, 1=4)
797    PLL_I = Integer input
798    PLL_F = Fractional input
799 
800    F_input = 28.636363 MHz:
801    PAL (CLKx2 = 35.46895 MHz): PLL_X = 1, PLL_I = 0x0E, PLL_F = 0xDCF9, PLL_C = 0
802 */
803 
804 static void set_pll_freq(struct bttv *btv, unsigned int fin, unsigned int fout)
805 {
806         unsigned char fl, fh, fi;
807 
808         /* prevent overflows */
809         fin/=4;
810         fout/=4;
811 
812         fout*=12;
813         fi=fout/fin;
814 
815         fout=(fout%fin)*256;
816         fh=fout/fin;
817 
818         fout=(fout%fin)*256;
819         fl=fout/fin;
820 
821         btwrite(fl, BT848_PLL_F_LO);
822         btwrite(fh, BT848_PLL_F_HI);
823         btwrite(fi|BT848_PLL_X, BT848_PLL_XCI);
824 }
825 
826 static void set_pll(struct bttv *btv)
827 {
828         int i;
829 
830         if (!btv->pll.pll_crystal)
831                 return;
832 
833         if (btv->pll.pll_ofreq == btv->pll.pll_current) {
834                 dprintk("%d: PLL: no change required\n", btv->c.nr);
835                 return;
836         }
837 
838         if (btv->pll.pll_ifreq == btv->pll.pll_ofreq) {
839                 /* no PLL needed */
840                 if (btv->pll.pll_current == 0)
841                         return;
842                 if (bttv_verbose)
843                         pr_info("%d: PLL can sleep, using XTAL (%d)\n",
844                                 btv->c.nr, btv->pll.pll_ifreq);
845                 btwrite(0x00,BT848_TGCTRL);
846                 btwrite(0x00,BT848_PLL_XCI);
847                 btv->pll.pll_current = 0;
848                 return;
849         }
850 
851         if (bttv_verbose)
852                 pr_info("%d: Setting PLL: %d => %d (needs up to 100ms)\n",
853                         btv->c.nr,
854                         btv->pll.pll_ifreq, btv->pll.pll_ofreq);
855         set_pll_freq(btv, btv->pll.pll_ifreq, btv->pll.pll_ofreq);
856 
857         for (i=0; i<10; i++) {
858                 /*  Let other people run while the PLL stabilizes */
859                 msleep(10);
860 
861                 if (btread(BT848_DSTATUS) & BT848_DSTATUS_PLOCK) {
862                         btwrite(0,BT848_DSTATUS);
863                 } else {
864                         btwrite(0x08,BT848_TGCTRL);
865                         btv->pll.pll_current = btv->pll.pll_ofreq;
866                         if (bttv_verbose)
867                                 pr_info("PLL set ok\n");
868                         return;
869                 }
870         }
871         btv->pll.pll_current = -1;
872         if (bttv_verbose)
873                 pr_info("Setting PLL failed\n");
874         return;
875 }
876 
877 /* used to switch between the bt848's analog/digital video capture modes */
878 static void bt848A_set_timing(struct bttv *btv)
879 {
880         int i, len;
881         int table_idx = bttv_tvnorms[btv->tvnorm].sram;
882         int fsc       = bttv_tvnorms[btv->tvnorm].Fsc;
883 
884         if (btv->input == btv->dig) {
885                 dprintk("%d: load digital timing table (table_idx=%d)\n",
886                         btv->c.nr,table_idx);
887 
888                 /* timing change...reset timing generator address */
889                 btwrite(0x00, BT848_TGCTRL);
890                 btwrite(0x02, BT848_TGCTRL);
891                 btwrite(0x00, BT848_TGCTRL);
892 
893                 len=SRAM_Table[table_idx][0];
894                 for(i = 1; i <= len; i++)
895                         btwrite(SRAM_Table[table_idx][i],BT848_TGLB);
896                 btv->pll.pll_ofreq = 27000000;
897 
898                 set_pll(btv);
899                 btwrite(0x11, BT848_TGCTRL);
900                 btwrite(0x41, BT848_DVSIF);
901         } else {
902                 btv->pll.pll_ofreq = fsc;
903                 set_pll(btv);
904                 btwrite(0x0, BT848_DVSIF);
905         }
906 }
907 
908 /* ----------------------------------------------------------------------- */
909 
910 static void bt848_bright(struct bttv *btv, int bright)
911 {
912         int value;
913 
914         // printk("set bright: %d\n", bright); // DEBUG
915         btv->bright = bright;
916 
917         /* We want -128 to 127 we get 0-65535 */
918         value = (bright >> 8) - 128;
919         btwrite(value & 0xff, BT848_BRIGHT);
920 }
921 
922 static void bt848_hue(struct bttv *btv, int hue)
923 {
924         int value;
925 
926         btv->hue = hue;
927 
928         /* -128 to 127 */
929         value = (hue >> 8) - 128;
930         btwrite(value & 0xff, BT848_HUE);
931 }
932 
933 static void bt848_contrast(struct bttv *btv, int cont)
934 {
935         int value,hibit;
936 
937         btv->contrast = cont;
938 
939         /* 0-511 */
940         value = (cont  >> 7);
941         hibit = (value >> 6) & 4;
942         btwrite(value & 0xff, BT848_CONTRAST_LO);
943         btaor(hibit, ~4, BT848_E_CONTROL);
944         btaor(hibit, ~4, BT848_O_CONTROL);
945 }
946 
947 static void bt848_sat(struct bttv *btv, int color)
948 {
949         int val_u,val_v,hibits;
950 
951         btv->saturation = color;
952 
953         /* 0-511 for the color */
954         val_u   = ((color * btv->opt_uv_ratio) / 50) >> 7;
955         val_v   = (((color * (100 - btv->opt_uv_ratio) / 50) >>7)*180L)/254;
956         hibits  = (val_u >> 7) & 2;
957         hibits |= (val_v >> 8) & 1;
958         btwrite(val_u & 0xff, BT848_SAT_U_LO);
959         btwrite(val_v & 0xff, BT848_SAT_V_LO);
960         btaor(hibits, ~3, BT848_E_CONTROL);
961         btaor(hibits, ~3, BT848_O_CONTROL);
962 }
963 
964 /* ----------------------------------------------------------------------- */
965 
966 static int
967 video_mux(struct bttv *btv, unsigned int input)
968 {
969         int mux,mask2;
970 
971         if (input >= bttv_tvcards[btv->c.type].video_inputs)
972                 return -EINVAL;
973 
974         /* needed by RemoteVideo MX */
975         mask2 = bttv_tvcards[btv->c.type].gpiomask2;
976         if (mask2)
977                 gpio_inout(mask2,mask2);
978 
979         if (input == btv->svhs)  {
980                 btor(BT848_CONTROL_COMP, BT848_E_CONTROL);
981                 btor(BT848_CONTROL_COMP, BT848_O_CONTROL);
982         } else {
983                 btand(~BT848_CONTROL_COMP, BT848_E_CONTROL);
984                 btand(~BT848_CONTROL_COMP, BT848_O_CONTROL);
985         }
986         mux = bttv_muxsel(btv, input);
987         btaor(mux<<5, ~(3<<5), BT848_IFORM);
988         dprintk("%d: video mux: input=%d mux=%d\n", btv->c.nr, input, mux);
989 
990         /* card specific hook */
991         if(bttv_tvcards[btv->c.type].muxsel_hook)
992                 bttv_tvcards[btv->c.type].muxsel_hook (btv, input);
993         return 0;
994 }
995 
996 static char *audio_modes[] = {
997         "audio: tuner", "audio: radio", "audio: extern",
998         "audio: intern", "audio: mute"
999 };
1000 
1001 static void
1002 audio_mux_gpio(struct bttv *btv, int input, int mute)
1003 {
1004         int gpio_val, signal, mute_gpio;
1005 
1006         gpio_inout(bttv_tvcards[btv->c.type].gpiomask,
1007                    bttv_tvcards[btv->c.type].gpiomask);
1008         signal = btread(BT848_DSTATUS) & BT848_DSTATUS_HLOC;
1009 
1010         /* automute */
1011         mute_gpio = mute || (btv->opt_automute && (!signal || !btv->users)
1012                                 && !btv->has_radio_tuner);
1013 
1014         if (mute_gpio)
1015                 gpio_val = bttv_tvcards[btv->c.type].gpiomute;
1016         else
1017                 gpio_val = bttv_tvcards[btv->c.type].gpiomux[input];
1018 
1019         switch (btv->c.type) {
1020         case BTTV_BOARD_VOODOOTV_FM:
1021         case BTTV_BOARD_VOODOOTV_200:
1022                 gpio_val = bttv_tda9880_setnorm(btv, gpio_val);
1023                 break;
1024 
1025         default:
1026                 gpio_bits(bttv_tvcards[btv->c.type].gpiomask, gpio_val);
1027         }
1028 
1029         if (bttv_gpio)
1030                 bttv_gpio_tracking(btv, audio_modes[mute_gpio ? 4 : input]);
1031 }
1032 
1033 static int
1034 audio_mute(struct bttv *btv, int mute)
1035 {
1036         struct v4l2_ctrl *ctrl;
1037 
1038         audio_mux_gpio(btv, btv->audio_input, mute);
1039 
1040         if (btv->sd_msp34xx) {
1041                 ctrl = v4l2_ctrl_find(btv->sd_msp34xx->ctrl_handler, V4L2_CID_AUDIO_MUTE);
1042                 if (ctrl)
1043                         v4l2_ctrl_s_ctrl(ctrl, mute);
1044         }
1045         if (btv->sd_tvaudio) {
1046                 ctrl = v4l2_ctrl_find(btv->sd_tvaudio->ctrl_handler, V4L2_CID_AUDIO_MUTE);
1047                 if (ctrl)
1048                         v4l2_ctrl_s_ctrl(ctrl, mute);
1049         }
1050         if (btv->sd_tda7432) {
1051                 ctrl = v4l2_ctrl_find(btv->sd_tda7432->ctrl_handler, V4L2_CID_AUDIO_MUTE);
1052                 if (ctrl)
1053                         v4l2_ctrl_s_ctrl(ctrl, mute);
1054         }
1055         return 0;
1056 }
1057 
1058 static int
1059 audio_input(struct bttv *btv, int input)
1060 {
1061         audio_mux_gpio(btv, input, btv->mute);
1062 
1063         if (btv->sd_msp34xx) {
1064                 u32 in;
1065 
1066                 /* Note: the inputs tuner/radio/extern/intern are translated
1067                    to msp routings. This assumes common behavior for all msp3400
1068                    based TV cards. When this assumption fails, then the
1069                    specific MSP routing must be added to the card table.
1070                    For now this is sufficient. */
1071                 switch (input) {
1072                 case TVAUDIO_INPUT_RADIO:
1073                         /* Some boards need the msp do to the radio demod */
1074                         if (btv->radio_uses_msp_demodulator) {
1075                                 in = MSP_INPUT_DEFAULT;
1076                                 break;
1077                         }
1078                         in = MSP_INPUT(MSP_IN_SCART2, MSP_IN_TUNER1,
1079                                     MSP_DSP_IN_SCART, MSP_DSP_IN_SCART);
1080                         break;
1081                 case TVAUDIO_INPUT_EXTERN:
1082                         in = MSP_INPUT(MSP_IN_SCART1, MSP_IN_TUNER1,
1083                                     MSP_DSP_IN_SCART, MSP_DSP_IN_SCART);
1084                         break;
1085                 case TVAUDIO_INPUT_INTERN:
1086                         /* Yes, this is the same input as for RADIO. I doubt
1087                            if this is ever used. The only board with an INTERN
1088                            input is the BTTV_BOARD_AVERMEDIA98. I wonder how
1089                            that was tested. My guess is that the whole INTERN
1090                            input does not work. */
1091                         in = MSP_INPUT(MSP_IN_SCART2, MSP_IN_TUNER1,
1092                                     MSP_DSP_IN_SCART, MSP_DSP_IN_SCART);
1093                         break;
1094                 case TVAUDIO_INPUT_TUNER:
1095                 default:
1096                         /* This is the only card that uses TUNER2, and afaik,
1097                            is the only difference between the VOODOOTV_FM
1098                            and VOODOOTV_200 */
1099                         if (btv->c.type == BTTV_BOARD_VOODOOTV_200)
1100                                 in = MSP_INPUT(MSP_IN_SCART1, MSP_IN_TUNER2, \
1101                                         MSP_DSP_IN_TUNER, MSP_DSP_IN_TUNER);
1102                         else
1103                                 in = MSP_INPUT_DEFAULT;
1104                         break;
1105                 }
1106                 v4l2_subdev_call(btv->sd_msp34xx, audio, s_routing,
1107                                in, MSP_OUTPUT_DEFAULT, 0);
1108         }
1109         if (btv->sd_tvaudio) {
1110                 v4l2_subdev_call(btv->sd_tvaudio, audio, s_routing,
1111                                  input, 0, 0);
1112         }
1113         return 0;
1114 }
1115 
1116 static void
1117 bttv_crop_calc_limits(struct bttv_crop *c)
1118 {
1119         /* Scale factor min. 1:1, max. 16:1. Min. image size
1120            48 x 32. Scaled width must be a multiple of 4. */
1121 
1122         if (1) {
1123                 /* For bug compatibility with VIDIOCGCAP and image
1124                    size checks in earlier driver versions. */
1125                 c->min_scaled_width = 48;
1126                 c->min_scaled_height = 32;
1127         } else {
1128                 c->min_scaled_width =
1129                         (max_t(unsigned int, 48, c->rect.width >> 4) + 3) & ~3;
1130                 c->min_scaled_height =
1131                         max_t(unsigned int, 32, c->rect.height >> 4);
1132         }
1133 
1134         c->max_scaled_width  = c->rect.width & ~3;
1135         c->max_scaled_height = c->rect.height;
1136 }
1137 
1138 static void
1139 bttv_crop_reset(struct bttv_crop *c, unsigned int norm)
1140 {
1141         c->rect = bttv_tvnorms[norm].cropcap.defrect;
1142         bttv_crop_calc_limits(c);
1143 }
1144 
1145 /* Call with btv->lock down. */
1146 static int
1147 set_tvnorm(struct bttv *btv, unsigned int norm)
1148 {
1149         const struct bttv_tvnorm *tvnorm;
1150         v4l2_std_id id;
1151 
1152         BUG_ON(norm >= BTTV_TVNORMS);
1153         BUG_ON(btv->tvnorm >= BTTV_TVNORMS);
1154 
1155         tvnorm = &bttv_tvnorms[norm];
1156 
1157         if (memcmp(&bttv_tvnorms[btv->tvnorm].cropcap, &tvnorm->cropcap,
1158                     sizeof (tvnorm->cropcap))) {
1159                 bttv_crop_reset(&btv->crop[0], norm);
1160                 btv->crop[1] = btv->crop[0]; /* current = default */
1161 
1162                 if (0 == (btv->resources & VIDEO_RESOURCES)) {
1163                         btv->crop_start = tvnorm->cropcap.bounds.top
1164                                 + tvnorm->cropcap.bounds.height;
1165                 }
1166         }
1167 
1168         btv->tvnorm = norm;
1169 
1170         btwrite(tvnorm->adelay, BT848_ADELAY);
1171         btwrite(tvnorm->bdelay, BT848_BDELAY);
1172         btaor(tvnorm->iform,~(BT848_IFORM_NORM|BT848_IFORM_XTBOTH),
1173               BT848_IFORM);
1174         btwrite(tvnorm->vbipack, BT848_VBI_PACK_SIZE);
1175         btwrite(1, BT848_VBI_PACK_DEL);
1176         bt848A_set_timing(btv);
1177 
1178         switch (btv->c.type) {
1179         case BTTV_BOARD_VOODOOTV_FM:
1180         case BTTV_BOARD_VOODOOTV_200:
1181                 bttv_tda9880_setnorm(btv, gpio_read());
1182                 break;
1183         }
1184         id = tvnorm->v4l2_id;
1185         bttv_call_all(btv, video, s_std, id);
1186 
1187         return 0;
1188 }
1189 
1190 /* Call with btv->lock down. */
1191 static void
1192 set_input(struct bttv *btv, unsigned int input, unsigned int norm)
1193 {
1194         unsigned long flags;
1195 
1196         btv->input = input;
1197         if (irq_iswitch) {
1198                 spin_lock_irqsave(&btv->s_lock,flags);
1199                 if (btv->curr.frame_irq) {
1200                         /* active capture -> delayed input switch */
1201                         btv->new_input = input;
1202                 } else {
1203                         video_mux(btv,input);
1204                 }
1205                 spin_unlock_irqrestore(&btv->s_lock,flags);
1206         } else {
1207                 video_mux(btv,input);
1208         }
1209         btv->audio_input = (btv->tuner_type != TUNER_ABSENT && input == 0) ?
1210                                 TVAUDIO_INPUT_TUNER : TVAUDIO_INPUT_EXTERN;
1211         audio_input(btv, btv->audio_input);
1212         set_tvnorm(btv, norm);
1213 }
1214 
1215 static void init_irqreg(struct bttv *btv)
1216 {
1217         /* clear status */
1218         btwrite(0xfffffUL, BT848_INT_STAT);
1219 
1220         if (bttv_tvcards[btv->c.type].no_video) {
1221                 /* i2c only */
1222                 btwrite(BT848_INT_I2CDONE,
1223                         BT848_INT_MASK);
1224         } else {
1225                 /* full video */
1226                 btwrite((btv->triton1)  |
1227                         (btv->gpioirq ? BT848_INT_GPINT : 0) |
1228                         BT848_INT_SCERR |
1229                         (fdsr ? BT848_INT_FDSR : 0) |
1230                         BT848_INT_RISCI | BT848_INT_OCERR |
1231                         BT848_INT_FMTCHG|BT848_INT_HLOCK|
1232                         BT848_INT_I2CDONE,
1233                         BT848_INT_MASK);
1234         }
1235 }
1236 
1237 static void init_bt848(struct bttv *btv)
1238 {
1239         if (bttv_tvcards[btv->c.type].no_video) {
1240                 /* very basic init only */
1241                 init_irqreg(btv);
1242                 return;
1243         }
1244 
1245         btwrite(0x00, BT848_CAP_CTL);
1246         btwrite(BT848_COLOR_CTL_GAMMA, BT848_COLOR_CTL);
1247         btwrite(BT848_IFORM_XTAUTO | BT848_IFORM_AUTO, BT848_IFORM);
1248 
1249         /* set planar and packed mode trigger points and         */
1250         /* set rising edge of inverted GPINTR pin as irq trigger */
1251         btwrite(BT848_GPIO_DMA_CTL_PKTP_32|
1252                 BT848_GPIO_DMA_CTL_PLTP1_16|
1253                 BT848_GPIO_DMA_CTL_PLTP23_16|
1254                 BT848_GPIO_DMA_CTL_GPINTC|
1255                 BT848_GPIO_DMA_CTL_GPINTI,
1256                 BT848_GPIO_DMA_CTL);
1257 
1258         btwrite(0x20, BT848_E_VSCALE_HI);
1259         btwrite(0x20, BT848_O_VSCALE_HI);
1260 
1261         v4l2_ctrl_handler_setup(&btv->ctrl_handler);
1262 
1263         /* interrupt */
1264         init_irqreg(btv);
1265 }
1266 
1267 static void bttv_reinit_bt848(struct bttv *btv)
1268 {
1269         unsigned long flags;
1270 
1271         if (bttv_verbose)
1272                 pr_info("%d: reset, reinitialize\n", btv->c.nr);
1273         spin_lock_irqsave(&btv->s_lock,flags);
1274         btv->errors=0;
1275         bttv_set_dma(btv,0);
1276         spin_unlock_irqrestore(&btv->s_lock,flags);
1277 
1278         init_bt848(btv);
1279         btv->pll.pll_current = -1;
1280         set_input(btv, btv->input, btv->tvnorm);
1281 }
1282 
1283 static int bttv_s_ctrl(struct v4l2_ctrl *c)
1284 {
1285         struct bttv *btv = container_of(c->handler, struct bttv, ctrl_handler);
1286         int val;
1287 
1288         switch (c->id) {
1289         case V4L2_CID_BRIGHTNESS:
1290                 bt848_bright(btv, c->val);
1291                 break;
1292         case V4L2_CID_HUE:
1293                 bt848_hue(btv, c->val);
1294                 break;
1295         case V4L2_CID_CONTRAST:
1296                 bt848_contrast(btv, c->val);
1297                 break;
1298         case V4L2_CID_SATURATION:
1299                 bt848_sat(btv, c->val);
1300                 break;
1301         case V4L2_CID_COLOR_KILLER:
1302                 if (c->val) {
1303                         btor(BT848_SCLOOP_CKILL, BT848_E_SCLOOP);
1304                         btor(BT848_SCLOOP_CKILL, BT848_O_SCLOOP);
1305                 } else {
1306                         btand(~BT848_SCLOOP_CKILL, BT848_E_SCLOOP);
1307                         btand(~BT848_SCLOOP_CKILL, BT848_O_SCLOOP);
1308                 }
1309                 break;
1310         case V4L2_CID_AUDIO_MUTE:
1311                 audio_mute(btv, c->val);
1312                 btv->mute = c->val;
1313                 break;
1314         case V4L2_CID_AUDIO_VOLUME:
1315                 btv->volume_gpio(btv, c->val);
1316                 break;
1317 
1318         case V4L2_CID_CHROMA_AGC:
1319                 val = c->val ? BT848_SCLOOP_CAGC : 0;
1320                 btwrite(val, BT848_E_SCLOOP);
1321                 btwrite(val, BT848_O_SCLOOP);
1322                 break;
1323         case V4L2_CID_PRIVATE_COMBFILTER:
1324                 btv->opt_combfilter = c->val;
1325                 break;
1326         case V4L2_CID_PRIVATE_LUMAFILTER:
1327                 if (c->val) {
1328                         btand(~BT848_CONTROL_LDEC, BT848_E_CONTROL);
1329                         btand(~BT848_CONTROL_LDEC, BT848_O_CONTROL);
1330                 } else {
1331                         btor(BT848_CONTROL_LDEC, BT848_E_CONTROL);
1332                         btor(BT848_CONTROL_LDEC, BT848_O_CONTROL);
1333                 }
1334                 break;
1335         case V4L2_CID_PRIVATE_AUTOMUTE:
1336                 btv->opt_automute = c->val;
1337                 break;
1338         case V4L2_CID_PRIVATE_AGC_CRUSH:
1339                 btwrite(BT848_ADC_RESERVED |
1340                                 (c->val ? BT848_ADC_CRUSH : 0),
1341                                 BT848_ADC);
1342                 break;
1343         case V4L2_CID_PRIVATE_VCR_HACK:
1344                 btv->opt_vcr_hack = c->val;
1345                 break;
1346         case V4L2_CID_PRIVATE_WHITECRUSH_UPPER:
1347                 btwrite(c->val, BT848_WC_UP);
1348                 break;
1349         case V4L2_CID_PRIVATE_WHITECRUSH_LOWER:
1350                 btwrite(c->val, BT848_WC_DOWN);
1351                 break;
1352         case V4L2_CID_PRIVATE_UV_RATIO:
1353                 btv->opt_uv_ratio = c->val;
1354                 bt848_sat(btv, btv->saturation);
1355                 break;
1356         case V4L2_CID_PRIVATE_FULL_LUMA_RANGE:
1357                 btaor((c->val << 7), ~BT848_OFORM_RANGE, BT848_OFORM);
1358                 break;
1359         case V4L2_CID_PRIVATE_CORING:
1360                 btaor((c->val << 5), ~BT848_OFORM_CORE32, BT848_OFORM);
1361                 break;
1362         default:
1363                 return -EINVAL;
1364         }
1365         return 0;
1366 }
1367 
1368 /* ----------------------------------------------------------------------- */
1369 
1370 static const struct v4l2_ctrl_ops bttv_ctrl_ops = {
1371         .s_ctrl = bttv_s_ctrl,
1372 };
1373 
1374 static struct v4l2_ctrl_config bttv_ctrl_combfilter = {
1375         .ops = &bttv_ctrl_ops,
1376         .id = V4L2_CID_PRIVATE_COMBFILTER,
1377         .name = "Comb Filter",
1378         .type = V4L2_CTRL_TYPE_BOOLEAN,
1379         .min = 0,
1380         .max = 1,
1381         .step = 1,
1382         .def = 1,
1383 };
1384 
1385 static struct v4l2_ctrl_config bttv_ctrl_automute = {
1386         .ops = &bttv_ctrl_ops,
1387         .id = V4L2_CID_PRIVATE_AUTOMUTE,
1388         .name = "Auto Mute",
1389         .type = V4L2_CTRL_TYPE_BOOLEAN,
1390         .min = 0,
1391         .max = 1,
1392         .step = 1,
1393         .def = 1,
1394 };
1395 
1396 static struct v4l2_ctrl_config bttv_ctrl_lumafilter = {
1397         .ops = &bttv_ctrl_ops,
1398         .id = V4L2_CID_PRIVATE_LUMAFILTER,
1399         .name = "Luma Decimation Filter",
1400         .type = V4L2_CTRL_TYPE_BOOLEAN,
1401         .min = 0,
1402         .max = 1,
1403         .step = 1,
1404         .def = 1,
1405 };
1406 
1407 static struct v4l2_ctrl_config bttv_ctrl_agc_crush = {
1408         .ops = &bttv_ctrl_ops,
1409         .id = V4L2_CID_PRIVATE_AGC_CRUSH,
1410         .name = "AGC Crush",
1411         .type = V4L2_CTRL_TYPE_BOOLEAN,
1412         .min = 0,
1413         .max = 1,
1414         .step = 1,
1415         .def = 1,
1416 };
1417 
1418 static struct v4l2_ctrl_config bttv_ctrl_vcr_hack = {
1419         .ops = &bttv_ctrl_ops,
1420         .id = V4L2_CID_PRIVATE_VCR_HACK,
1421         .name = "VCR Hack",
1422         .type = V4L2_CTRL_TYPE_BOOLEAN,
1423         .min = 0,
1424         .max = 1,
1425         .step = 1,
1426         .def = 1,
1427 };
1428 
1429 static struct v4l2_ctrl_config bttv_ctrl_whitecrush_lower = {
1430         .ops = &bttv_ctrl_ops,
1431         .id = V4L2_CID_PRIVATE_WHITECRUSH_LOWER,
1432         .name = "Whitecrush Lower",
1433         .type = V4L2_CTRL_TYPE_INTEGER,
1434         .min = 0,
1435         .max = 255,
1436         .step = 1,
1437         .def = 0x7f,
1438 };
1439 
1440 static struct v4l2_ctrl_config bttv_ctrl_whitecrush_upper = {
1441         .ops = &bttv_ctrl_ops,
1442         .id = V4L2_CID_PRIVATE_WHITECRUSH_UPPER,
1443         .name = "Whitecrush Upper",
1444         .type = V4L2_CTRL_TYPE_INTEGER,
1445         .min = 0,
1446         .max = 255,
1447         .step = 1,
1448         .def = 0xcf,
1449 };
1450 
1451 static struct v4l2_ctrl_config bttv_ctrl_uv_ratio = {
1452         .ops = &bttv_ctrl_ops,
1453         .id = V4L2_CID_PRIVATE_UV_RATIO,
1454         .name = "UV Ratio",
1455         .type = V4L2_CTRL_TYPE_INTEGER,
1456         .min = 0,
1457         .max = 100,
1458         .step = 1,
1459         .def = 50,
1460 };
1461 
1462 static struct v4l2_ctrl_config bttv_ctrl_full_luma = {
1463         .ops = &bttv_ctrl_ops,
1464         .id = V4L2_CID_PRIVATE_FULL_LUMA_RANGE,
1465         .name = "Full Luma Range",
1466         .type = V4L2_CTRL_TYPE_BOOLEAN,
1467         .min = 0,
1468         .max = 1,
1469         .step = 1,
1470 };
1471 
1472 static struct v4l2_ctrl_config bttv_ctrl_coring = {
1473         .ops = &bttv_ctrl_ops,
1474         .id = V4L2_CID_PRIVATE_CORING,
1475         .name = "Coring",
1476         .type = V4L2_CTRL_TYPE_INTEGER,
1477         .min = 0,
1478         .max = 3,
1479         .step = 1,
1480 };
1481 
1482 
1483 /* ----------------------------------------------------------------------- */
1484 
1485 void bttv_gpio_tracking(struct bttv *btv, char *comment)
1486 {
1487         unsigned int outbits, data;
1488         outbits = btread(BT848_GPIO_OUT_EN);
1489         data    = btread(BT848_GPIO_DATA);
1490         pr_debug("%d: gpio: en=%08x, out=%08x in=%08x [%s]\n",
1491                  btv->c.nr, outbits, data & outbits, data & ~outbits, comment);
1492 }
1493 
1494 static void bttv_field_count(struct bttv *btv)
1495 {
1496         int need_count = 0;
1497 
1498         if (btv->users)
1499                 need_count++;
1500 
1501         if (need_count) {
1502                 /* start field counter */
1503                 btor(BT848_INT_VSYNC,BT848_INT_MASK);
1504         } else {
1505                 /* stop field counter */
1506                 btand(~BT848_INT_VSYNC,BT848_INT_MASK);
1507                 btv->field_count = 0;
1508         }
1509 }
1510 
1511 static const struct bttv_format*
1512 format_by_fourcc(int fourcc)
1513 {
1514         unsigned int i;
1515 
1516         for (i = 0; i < FORMATS; i++) {
1517                 if (-1 == formats[i].fourcc)
1518                         continue;
1519                 if (formats[i].fourcc == fourcc)
1520                         return formats+i;
1521         }
1522         return NULL;
1523 }
1524 
1525 /* ----------------------------------------------------------------------- */
1526 /* misc helpers                                                            */
1527 
1528 static int
1529 bttv_switch_overlay(struct bttv *btv, struct bttv_fh *fh,
1530                     struct bttv_buffer *new)
1531 {
1532         struct bttv_buffer *old;
1533         unsigned long flags;
1534 
1535         dprintk("switch_overlay: enter [new=%p]\n", new);
1536         if (new)
1537                 new->vb.state = VIDEOBUF_DONE;
1538         spin_lock_irqsave(&btv->s_lock,flags);
1539         old = btv->screen;
1540         btv->screen = new;
1541         btv->loop_irq |= 1;
1542         bttv_set_dma(btv, 0x03);
1543         spin_unlock_irqrestore(&btv->s_lock,flags);
1544         if (NULL != old) {
1545                 dprintk("switch_overlay: old=%p state is %d\n",
1546                         old, old->vb.state);
1547                 bttv_dma_free(&fh->cap,btv, old);
1548                 kfree(old);
1549         }
1550         if (NULL == new)
1551                 free_btres_lock(btv,fh,RESOURCE_OVERLAY);
1552         dprintk("switch_overlay: done\n");
1553         return 0;
1554 }
1555 
1556 /* ----------------------------------------------------------------------- */
1557 /* video4linux (1) interface                                               */
1558 
1559 static int bttv_prepare_buffer(struct videobuf_queue *q,struct bttv *btv,
1560                                struct bttv_buffer *buf,
1561                                const struct bttv_format *fmt,
1562                                unsigned int width, unsigned int height,
1563                                enum v4l2_field field)
1564 {
1565         struct bttv_fh *fh = q->priv_data;
1566         int redo_dma_risc = 0;
1567         struct bttv_crop c;
1568         int norm;
1569         int rc;
1570 
1571         /* check settings */
1572         if (NULL == fmt)
1573                 return -EINVAL;
1574         if (fmt->btformat == BT848_COLOR_FMT_RAW) {
1575                 width  = RAW_BPL;
1576                 height = RAW_LINES*2;
1577                 if (width*height > buf->vb.bsize)
1578                         return -EINVAL;
1579                 buf->vb.size = buf->vb.bsize;
1580 
1581                 /* Make sure tvnorm and vbi_end remain consistent
1582                    until we're done. */
1583 
1584                 norm = btv->tvnorm;
1585 
1586                 /* In this mode capturing always starts at defrect.top
1587                    (default VDELAY), ignoring cropping parameters. */
1588                 if (btv->vbi_end > bttv_tvnorms[norm].cropcap.defrect.top) {
1589                         return -EINVAL;
1590                 }
1591 
1592                 c.rect = bttv_tvnorms[norm].cropcap.defrect;
1593         } else {
1594                 norm = btv->tvnorm;
1595                 c = btv->crop[!!fh->do_crop];
1596 
1597                 if (width < c.min_scaled_width ||
1598                     width > c.max_scaled_width ||
1599                     height < c.min_scaled_height)
1600                         return -EINVAL;
1601 
1602                 switch (field) {
1603                 case V4L2_FIELD_TOP:
1604                 case V4L2_FIELD_BOTTOM:
1605                 case V4L2_FIELD_ALTERNATE:
1606                         /* btv->crop counts frame lines. Max. scale
1607                            factor is 16:1 for frames, 8:1 for fields. */
1608                         if (height * 2 > c.max_scaled_height)
1609                                 return -EINVAL;
1610                         break;
1611 
1612                 default:
1613                         if (height > c.max_scaled_height)
1614                                 return -EINVAL;
1615                         break;
1616                 }
1617 
1618                 buf->vb.size = (width * height * fmt->depth) >> 3;
1619                 if (0 != buf->vb.baddr  &&  buf->vb.bsize < buf->vb.size)
1620                         return -EINVAL;
1621         }
1622 
1623         /* alloc + fill struct bttv_buffer (if changed) */
1624         if (buf->vb.width != width || buf->vb.height != height ||
1625             buf->vb.field != field ||
1626             buf->tvnorm != norm || buf->fmt != fmt ||
1627             buf->crop.top != c.rect.top ||
1628             buf->crop.left != c.rect.left ||
1629             buf->crop.width != c.rect.width ||
1630             buf->crop.height != c.rect.height) {
1631                 buf->vb.width  = width;
1632                 buf->vb.height = height;
1633                 buf->vb.field  = field;
1634                 buf->tvnorm    = norm;
1635                 buf->fmt       = fmt;
1636                 buf->crop      = c.rect;
1637                 redo_dma_risc = 1;
1638         }
1639 
1640         /* alloc risc memory */
1641         if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {
1642                 redo_dma_risc = 1;
1643                 if (0 != (rc = videobuf_iolock(q,&buf->vb,&btv->fbuf)))
1644                         goto fail;
1645         }
1646 
1647         if (redo_dma_risc)
1648                 if (0 != (rc = bttv_buffer_risc(btv,buf)))
1649                         goto fail;
1650 
1651         buf->vb.state = VIDEOBUF_PREPARED;
1652         return 0;
1653 
1654  fail:
1655         bttv_dma_free(q,btv,buf);
1656         return rc;
1657 }
1658 
1659 static int
1660 buffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size)
1661 {
1662         struct bttv_fh *fh = q->priv_data;
1663 
1664         *size = fh->fmt->depth*fh->width*fh->height >> 3;
1665         if (0 == *count)
1666                 *count = gbuffers;
1667         if (*size * *count > gbuffers * gbufsize)
1668                 *count = (gbuffers * gbufsize) / *size;
1669         return 0;
1670 }
1671 
1672 static int
1673 buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
1674                enum v4l2_field field)
1675 {
1676         struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb);
1677         struct bttv_fh *fh = q->priv_data;
1678 
1679         return bttv_prepare_buffer(q,fh->btv, buf, fh->fmt,
1680                                    fh->width, fh->height, field);
1681 }
1682 
1683 static void
1684 buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb)
1685 {
1686         struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb);
1687         struct bttv_fh *fh = q->priv_data;
1688         struct bttv    *btv = fh->btv;
1689 
1690         buf->vb.state = VIDEOBUF_QUEUED;
1691         list_add_tail(&buf->vb.queue,&btv->capture);
1692         if (!btv->curr.frame_irq) {
1693                 btv->loop_irq |= 1;
1694                 bttv_set_dma(btv, 0x03);
1695         }
1696 }
1697 
1698 static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb)
1699 {
1700         struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb);
1701         struct bttv_fh *fh = q->priv_data;
1702 
1703         bttv_dma_free(q,fh->btv,buf);
1704 }
1705 
1706 static struct videobuf_queue_ops bttv_video_qops = {
1707         .buf_setup    = buffer_setup,
1708         .buf_prepare  = buffer_prepare,
1709         .buf_queue    = buffer_queue,
1710         .buf_release  = buffer_release,
1711 };
1712 
1713 static void radio_enable(struct bttv *btv)
1714 {
1715         /* Switch to the radio tuner */
1716         if (!btv->has_radio_tuner) {
1717                 btv->has_radio_tuner = 1;
1718                 bttv_call_all(btv, tuner, s_radio);
1719                 btv->audio_input = TVAUDIO_INPUT_RADIO;
1720                 audio_input(btv, btv->audio_input);
1721         }
1722 }
1723 
1724 static int bttv_s_std(struct file *file, void *priv, v4l2_std_id id)
1725 {
1726         struct bttv_fh *fh  = priv;
1727         struct bttv *btv = fh->btv;
1728         unsigned int i;
1729 
1730         for (i = 0; i < BTTV_TVNORMS; i++)
1731                 if (id & bttv_tvnorms[i].v4l2_id)
1732                         break;
1733         if (i == BTTV_TVNORMS)
1734                 return -EINVAL;
1735         btv->std = id;
1736         set_tvnorm(btv, i);
1737         return 0;
1738 }
1739 
1740 static int bttv_g_std(struct file *file, void *priv, v4l2_std_id *id)
1741 {
1742         struct bttv_fh *fh  = priv;
1743         struct bttv *btv = fh->btv;
1744 
1745         *id = btv->std;
1746         return 0;
1747 }
1748 
1749 static int bttv_querystd(struct file *file, void *f, v4l2_std_id *id)
1750 {
1751         struct bttv_fh *fh = f;
1752         struct bttv *btv = fh->btv;
1753 
1754         if (btread(BT848_DSTATUS) & BT848_DSTATUS_NUML)
1755                 *id &= V4L2_STD_625_50;
1756         else
1757                 *id &= V4L2_STD_525_60;
1758         return 0;
1759 }
1760 
1761 static int bttv_enum_input(struct file *file, void *priv,
1762                                         struct v4l2_input *i)
1763 {
1764         struct bttv_fh *fh = priv;
1765         struct bttv *btv = fh->btv;
1766 
1767         if (i->index >= bttv_tvcards[btv->c.type].video_inputs)
1768                 return -EINVAL;
1769 
1770         i->type     = V4L2_INPUT_TYPE_CAMERA;
1771         i->audioset = 0;
1772 
1773         if (btv->tuner_type != TUNER_ABSENT && i->index == 0) {
1774                 sprintf(i->name, "Television");
1775                 i->type  = V4L2_INPUT_TYPE_TUNER;
1776                 i->tuner = 0;
1777         } else if (i->index == btv->svhs) {
1778                 sprintf(i->name, "S-Video");
1779         } else {
1780                 sprintf(i->name, "Composite%d", i->index);
1781         }
1782 
1783         if (i->index == btv->input) {
1784                 __u32 dstatus = btread(BT848_DSTATUS);
1785                 if (0 == (dstatus & BT848_DSTATUS_PRES))
1786                         i->status |= V4L2_IN_ST_NO_SIGNAL;
1787                 if (0 == (dstatus & BT848_DSTATUS_HLOC))
1788                         i->status |= V4L2_IN_ST_NO_H_LOCK;
1789         }
1790 
1791         i->std = BTTV_NORMS;
1792         return 0;
1793 }
1794 
1795 static int bttv_g_input(struct file *file, void *priv, unsigned int *i)
1796 {
1797         struct bttv_fh *fh = priv;
1798         struct bttv *btv = fh->btv;
1799 
1800         *i = btv->input;
1801 
1802         return 0;
1803 }
1804 
1805 static int bttv_s_input(struct file *file, void *priv, unsigned int i)
1806 {
1807         struct bttv_fh *fh  = priv;
1808         struct bttv *btv = fh->btv;
1809 
1810         if (i >= bttv_tvcards[btv->c.type].video_inputs)
1811                 return -EINVAL;
1812 
1813         set_input(btv, i, btv->tvnorm);
1814         return 0;
1815 }
1816 
1817 static int bttv_s_tuner(struct file *file, void *priv,
1818                                         const struct v4l2_tuner *t)
1819 {
1820         struct bttv_fh *fh  = priv;
1821         struct bttv *btv = fh->btv;
1822 
1823         if (t->index)
1824                 return -EINVAL;
1825 
1826         bttv_call_all(btv, tuner, s_tuner, t);
1827 
1828         if (btv->audio_mode_gpio) {
1829                 struct v4l2_tuner copy = *t;
1830 
1831                 btv->audio_mode_gpio(btv, &copy, 1);
1832         }
1833         return 0;
1834 }
1835 
1836 static int bttv_g_frequency(struct file *file, void *priv,
1837                                         struct v4l2_frequency *f)
1838 {
1839         struct bttv_fh *fh  = priv;
1840         struct bttv *btv = fh->btv;
1841 
1842         if (f->tuner)
1843                 return -EINVAL;
1844 
1845         if (f->type == V4L2_TUNER_RADIO)
1846                 radio_enable(btv);
1847         f->frequency = f->type == V4L2_TUNER_RADIO ?
1848                                 btv->radio_freq : btv->tv_freq;
1849 
1850         return 0;
1851 }
1852 
1853 static void bttv_set_frequency(struct bttv *btv, const struct v4l2_frequency *f)
1854 {
1855         struct v4l2_frequency new_freq = *f;
1856 
1857         bttv_call_all(btv, tuner, s_frequency, f);
1858         /* s_frequency may clamp the frequency, so get the actual
1859            frequency before assigning radio/tv_freq. */
1860         bttv_call_all(btv, tuner, g_frequency, &new_freq);
1861         if (new_freq.type == V4L2_TUNER_RADIO) {
1862                 radio_enable(btv);
1863                 btv->radio_freq = new_freq.frequency;
1864                 if (btv->has_tea575x) {
1865                         btv->tea.freq = btv->radio_freq;
1866                         snd_tea575x_set_freq(&btv->tea);
1867                 }
1868         } else {
1869                 btv->tv_freq = new_freq.frequency;
1870         }
1871 }
1872 
1873 static int bttv_s_frequency(struct file *file, void *priv,
1874                                         const struct v4l2_frequency *f)
1875 {
1876         struct bttv_fh *fh  = priv;
1877         struct bttv *btv = fh->btv;
1878 
1879         if (f->tuner)
1880                 return -EINVAL;
1881 
1882         bttv_set_frequency(btv, f);
1883         return 0;
1884 }
1885 
1886 static int bttv_log_status(struct file *file, void *f)
1887 {
1888         struct video_device *vdev = video_devdata(file);
1889         struct bttv_fh *fh  = f;
1890         struct bttv *btv = fh->btv;
1891 
1892         v4l2_ctrl_handler_log_status(vdev->ctrl_handler, btv->c.v4l2_dev.name);
1893         bttv_call_all(btv, core, log_status);
1894         return 0;
1895 }
1896 
1897 #ifdef CONFIG_VIDEO_ADV_DEBUG
1898 static int bttv_g_register(struct file *file, void *f,
1899                                         struct v4l2_dbg_register *reg)
1900 {
1901         struct bttv_fh *fh = f;
1902         struct bttv *btv = fh->btv;
1903 
1904         /* bt848 has a 12-bit register space */
1905         reg->reg &= 0xfff;
1906         reg->val = btread(reg->reg);
1907         reg->size = 1;
1908 
1909         return 0;
1910 }
1911 
1912 static int bttv_s_register(struct file *file, void *f,
1913                                         const struct v4l2_dbg_register *reg)
1914 {
1915         struct bttv_fh *fh = f;
1916         struct bttv *btv = fh->btv;
1917 
1918         /* bt848 has a 12-bit register space */
1919         btwrite(reg->val, reg->reg & 0xfff);
1920 
1921         return 0;
1922 }
1923 #endif
1924 
1925 /* Given cropping boundaries b and the scaled width and height of a
1926    single field or frame, which must not exceed hardware limits, this
1927    function adjusts the cropping parameters c. */
1928 static void
1929 bttv_crop_adjust        (struct bttv_crop *             c,
1930                          const struct v4l2_rect *       b,
1931                          __s32                          width,
1932                          __s32                          height,
1933                          enum v4l2_field                field)
1934 {
1935         __s32 frame_height = height << !V4L2_FIELD_HAS_BOTH(field);
1936         __s32 max_left;
1937         __s32 max_top;
1938 
1939         if (width < c->min_scaled_width) {
1940                 /* Max. hor. scale factor 16:1. */
1941                 c->rect.width = width * 16;
1942         } else if (width > c->max_scaled_width) {
1943                 /* Min. hor. scale factor 1:1. */
1944                 c->rect.width = width;
1945 
1946                 max_left = b->left + b->width - width;
1947                 max_left = min(max_left, (__s32) MAX_HDELAY);
1948                 if (c->rect.left > max_left)
1949                         c->rect.left = max_left;
1950         }
1951 
1952         if (height < c->min_scaled_height) {
1953                 /* Max. vert. scale factor 16:1, single fields 8:1. */
1954                 c->rect.height = height * 16;
1955         } else if (frame_height > c->max_scaled_height) {
1956                 /* Min. vert. scale factor 1:1.
1957                    Top and height count field lines times two. */
1958                 c->rect.height = (frame_height + 1) & ~1;
1959 
1960                 max_top = b->top + b->height - c->rect.height;
1961                 if (c->rect.top > max_top)
1962                         c->rect.top = max_top;
1963         }
1964 
1965         bttv_crop_calc_limits(c);
1966 }
1967 
1968 /* Returns an error if scaling to a frame or single field with the given
1969    width and height is not possible with the current cropping parameters
1970    and width aligned according to width_mask. If adjust_size is TRUE the
1971    function may adjust the width and/or height instead, rounding width
1972    to (width + width_bias) & width_mask. If adjust_crop is TRUE it may
1973    also adjust the current cropping parameters to get closer to the
1974    desired image size. */
1975 static int
1976 limit_scaled_size_lock       (struct bttv_fh *               fh,
1977                          __s32 *                        width,
1978                          __s32 *                        height,
1979                          enum v4l2_field                field,
1980                          unsigned int                   width_mask,
1981                          unsigned int                   width_bias,
1982                          int                            adjust_size,
1983                          int                            adjust_crop)
1984 {
1985         struct bttv *btv = fh->btv;
1986         const struct v4l2_rect *b;
1987         struct bttv_crop *c;
1988         __s32 min_width;
1989         __s32 min_height;
1990         __s32 max_width;
1991         __s32 max_height;
1992         int rc;
1993 
1994         BUG_ON((int) width_mask >= 0 ||
1995                width_bias >= (unsigned int) -width_mask);
1996 
1997         /* Make sure tvnorm, vbi_end and the current cropping parameters
1998            remain consistent until we're done. */
1999 
2000         b = &bttv_tvnorms[btv->tvnorm].cropcap.bounds;
2001 
2002         /* Do crop - use current, don't - use default parameters. */
2003         c = &btv->crop[!!fh->do_crop];
2004 
2005         if (fh->do_crop
2006             && adjust_size
2007             && adjust_crop
2008             && !locked_btres(btv, VIDEO_RESOURCES)) {
2009                 min_width = 48;
2010                 min_height = 32;
2011 
2012                 /* We cannot scale up. When the scaled image is larger
2013                    than crop.rect we adjust the crop.rect as required
2014                    by the V4L2 spec, hence cropcap.bounds are our limit. */
2015                 max_width = min_t(unsigned int, b->width, MAX_HACTIVE);
2016                 max_height = b->height;
2017 
2018                 /* We cannot capture the same line as video and VBI data.
2019                    Note btv->vbi_end is really a minimum, see
2020                    bttv_vbi_try_fmt(). */
2021                 if (btv->vbi_end > b->top) {
2022                         max_height -= btv->vbi_end - b->top;
2023                         rc = -EBUSY;
2024                         if (min_height > max_height)
2025                                 goto fail;
2026                 }
2027         } else {
2028                 rc = -EBUSY;
2029                 if (btv->vbi_end > c->rect.top)
2030                         goto fail;
2031 
2032                 min_width  = c->min_scaled_width;
2033                 min_height = c->min_scaled_height;
2034                 max_width  = c->max_scaled_width;
2035                 max_height = c->max_scaled_height;
2036 
2037                 adjust_crop = 0;
2038         }
2039 
2040         min_width = (min_width - width_mask - 1) & width_mask;
2041         max_width = max_width & width_mask;
2042 
2043         /* Max. scale factor is 16:1 for frames, 8:1 for fields. */
2044         min_height = min_height;
2045         /* Min. scale factor is 1:1. */
2046         max_height >>= !V4L2_FIELD_HAS_BOTH(field);
2047 
2048         if (adjust_size) {
2049                 *width = clamp(*width, min_width, max_width);
2050                 *height = clamp(*height, min_height, max_height);
2051 
2052                 /* Round after clamping to avoid overflow. */
2053                 *width = (*width + width_bias) & width_mask;
2054 
2055                 if (adjust_crop) {
2056                         bttv_crop_adjust(c, b, *width, *height, field);
2057 
2058                         if (btv->vbi_end > c->rect.top) {
2059                                 /* Move the crop window out of the way. */
2060                                 c->rect.top = btv->vbi_end;
2061                         }
2062                 }
2063         } else {
2064                 rc = -EINVAL;
2065                 if (*width  < min_width ||
2066                     *height < min_height ||
2067                     *width  > max_width ||
2068                     *height > max_height ||
2069                     0 != (*width & ~width_mask))
2070                         goto fail;
2071         }
2072 
2073         rc = 0; /* success */
2074 
2075  fail:
2076 
2077         return rc;
2078 }
2079 
2080 /* Returns an error if the given overlay window dimensions are not
2081    possible with the current cropping parameters. If adjust_size is
2082    TRUE the function may adjust the window width and/or height
2083    instead, however it always rounds the horizontal position and
2084    width as btcx_align() does. If adjust_crop is TRUE the function
2085    may also adjust the current cropping parameters to get closer
2086    to the desired window size. */
2087 static int
2088 verify_window_lock(struct bttv_fh *fh, struct v4l2_window *win,
2089                          int adjust_size, int adjust_crop)
2090 {
2091         enum v4l2_field field;
2092         unsigned int width_mask;
2093         int rc;
2094 
2095         if (win->w.width < 48)
2096                 win->w.width = 48;
2097         if (win->w.height < 32)
2098                 win->w.height = 32;
2099         if (win->clipcount > 2048)
2100                 win->clipcount = 2048;
2101 
2102         win->chromakey = 0;
2103         win->global_alpha = 0;
2104         field = win->field;
2105 
2106         switch (field) {
2107         case V4L2_FIELD_TOP:
2108         case V4L2_FIELD_BOTTOM:
2109         case V4L2_FIELD_INTERLACED:
2110                 break;
2111         default:
2112                 field = V4L2_FIELD_ANY;
2113                 break;
2114         }
2115         if (V4L2_FIELD_ANY == field) {
2116                 __s32 height2;
2117 
2118                 height2 = fh->btv->crop[!!fh->do_crop].rect.height >> 1;
2119                 field = (win->w.height > height2)
2120                         ? V4L2_FIELD_INTERLACED
2121                         : V4L2_FIELD_TOP;
2122         }
2123         win->field = field;
2124 
2125         if (NULL == fh->ovfmt)
2126                 return -EINVAL;
2127         /* 4-byte alignment. */
2128         width_mask = ~0;
2129         switch (fh->ovfmt->depth) {
2130         case 8:
2131         case 24:
2132                 width_mask = ~3;
2133                 break;
2134         case 16:
2135                 width_mask = ~1;
2136                 break;
2137         case 32:
2138                 break;
2139         default:
2140                 BUG();
2141         }
2142 
2143         win->w.width -= win->w.left & ~width_mask;
2144         win->w.left = (win->w.left - width_mask - 1) & width_mask;
2145 
2146         rc = limit_scaled_size_lock(fh, &win->w.width, &win->w.height,
2147                                field, width_mask,
2148                                /* width_bias: round down */ 0,
2149                                adjust_size, adjust_crop);
2150         if (0 != rc)
2151                 return rc;
2152         return 0;
2153 }
2154 
2155 static int setup_window_lock(struct bttv_fh *fh, struct bttv *btv,
2156                         struct v4l2_window *win, int fixup)
2157 {
2158         struct v4l2_clip *clips = NULL;
2159         int n,size,retval = 0;
2160 
2161         if (NULL == fh->ovfmt)
2162                 return -EINVAL;
2163         if (!(fh->ovfmt->flags & FORMAT_FLAGS_PACKED))
2164                 return -EINVAL;
2165         retval = verify_window_lock(fh, win,
2166                                /* adjust_size */ fixup,
2167                                /* adjust_crop */ fixup);
2168         if (0 != retval)
2169                 return retval;
2170 
2171         /* copy clips  --  luckily v4l1 + v4l2 are binary
2172            compatible here ...*/
2173         n = win->clipcount;
2174         size = sizeof(*clips)*(n+4);
2175         clips = kmalloc(size,GFP_KERNEL);
2176         if (NULL == clips)
2177                 return -ENOMEM;
2178         if (n > 0) {
2179                 if (copy_from_user(clips,win->clips,sizeof(struct v4l2_clip)*n)) {
2180                         kfree(clips);
2181                         return -EFAULT;
2182                 }
2183         }
2184 
2185         /* clip against screen */
2186         if (NULL != btv->fbuf.base)
2187                 n = btcx_screen_clips(btv->fbuf.fmt.width, btv->fbuf.fmt.height,
2188                                       &win->w, clips, n);
2189         btcx_sort_clips(clips,n);
2190 
2191         /* 4-byte alignments */
2192         switch (fh->ovfmt->depth) {
2193         case 8:
2194         case 24:
2195                 btcx_align(&win->w, clips, n, 3);
2196                 break;
2197         case 16:
2198                 btcx_align(&win->w, clips, n, 1);
2199                 break;
2200         case 32:
2201                 /* no alignment fixups needed */
2202                 break;
2203         default:
2204                 BUG();
2205         }
2206 
2207         kfree(fh->ov.clips);
2208         fh->ov.clips    = clips;
2209         fh->ov.nclips   = n;
2210 
2211         fh->ov.w        = win->w;
2212         fh->ov.field    = win->field;
2213         fh->ov.setup_ok = 1;
2214 
2215         btv->init.ov.w.width   = win->w.width;
2216         btv->init.ov.w.height  = win->w.height;
2217         btv->init.ov.field     = win->field;
2218 
2219         /* update overlay if needed */
2220         retval = 0;
2221         if (check_btres(fh, RESOURCE_OVERLAY)) {
2222                 struct bttv_buffer *new;
2223 
2224                 new = videobuf_sg_alloc(sizeof(*new));
2225                 new->crop = btv->crop[!!fh->do_crop].rect;
2226                 bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new);
2227                 retval = bttv_switch_overlay(btv,fh,new);
2228         }
2229         return retval;
2230 }
2231 
2232 /* ----------------------------------------------------------------------- */
2233 
2234 static struct videobuf_queue* bttv_queue(struct bttv_fh *fh)
2235 {
2236         struct videobuf_queue* q = NULL;
2237 
2238         switch (fh->type) {
2239         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
2240                 q = &fh->cap;
2241                 break;
2242         case V4L2_BUF_TYPE_VBI_CAPTURE:
2243                 q = &fh->vbi;
2244                 break;
2245         default:
2246                 BUG();
2247         }
2248         return q;
2249 }
2250 
2251 static int bttv_resource(struct bttv_fh *fh)
2252 {
2253         int res = 0;
2254 
2255         switch (fh->type) {
2256         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
2257                 res = RESOURCE_VIDEO_STREAM;
2258                 break;
2259         case V4L2_BUF_TYPE_VBI_CAPTURE:
2260                 res = RESOURCE_VBI;
2261                 break;
2262         default:
2263                 BUG();
2264         }
2265         return res;
2266 }
2267 
2268 static int bttv_switch_type(struct bttv_fh *fh, enum v4l2_buf_type type)
2269 {
2270         struct videobuf_queue *q = bttv_queue(fh);
2271         int res = bttv_resource(fh);
2272 
2273         if (check_btres(fh,res))
2274                 return -EBUSY;
2275         if (videobuf_queue_is_busy(q))
2276                 return -EBUSY;
2277         fh->type = type;
2278         return 0;
2279 }
2280 
2281 static void
2282 pix_format_set_size     (struct v4l2_pix_format *       f,
2283                          const struct bttv_format *     fmt,
2284                          unsigned int                   width,
2285                          unsigned int                   height)
2286 {
2287         f->width = width;
2288         f->height = height;
2289 
2290         if (fmt->flags & FORMAT_FLAGS_PLANAR) {
2291                 f->bytesperline = width; /* Y plane */
2292                 f->sizeimage = (width * height * fmt->depth) >> 3;
2293         } else {
2294                 f->bytesperline = (width * fmt->depth) >> 3;
2295                 f->sizeimage = height * f->bytesperline;
2296         }
2297 }
2298 
2299 static int bttv_g_fmt_vid_cap(struct file *file, void *priv,
2300                                         struct v4l2_format *f)
2301 {
2302         struct bttv_fh *fh  = priv;
2303 
2304         pix_format_set_size(&f->fmt.pix, fh->fmt,
2305                                 fh->width, fh->height);
2306         f->fmt.pix.field        = fh->cap.field;
2307         f->fmt.pix.pixelformat  = fh->fmt->fourcc;
2308         f->fmt.pix.colorspace   = V4L2_COLORSPACE_SMPTE170M;
2309 
2310         return 0;
2311 }
2312 
2313 static int bttv_g_fmt_vid_overlay(struct file *file, void *priv,
2314                                         struct v4l2_format *f)
2315 {
2316         struct bttv_fh *fh  = priv;
2317 
2318         f->fmt.win.w     = fh->ov.w;
2319         f->fmt.win.field = fh->ov.field;
2320 
2321         return 0;
2322 }
2323 
2324 static void bttv_get_width_mask_vid_cap(const struct bttv_format *fmt,
2325                                         unsigned int *width_mask,
2326                                         unsigned int *width_bias)
2327 {
2328         if (fmt->flags & FORMAT_FLAGS_PLANAR) {
2329                 *width_mask = ~15; /* width must be a multiple of 16 pixels */
2330                 *width_bias = 8;   /* nearest */
2331         } else {
2332                 *width_mask = ~3; /* width must be a multiple of 4 pixels */
2333                 *width_bias = 2;  /* nearest */
2334         }
2335 }
2336 
2337 static int bttv_try_fmt_vid_cap(struct file *file, void *priv,
2338                                                 struct v4l2_format *f)
2339 {
2340         const struct bttv_format *fmt;
2341         struct bttv_fh *fh = priv;
2342         struct bttv *btv = fh->btv;
2343         enum v4l2_field field;
2344         __s32 width, height;
2345         __s32 height2;
2346         unsigned int width_mask, width_bias;
2347         int rc;
2348 
2349         fmt = format_by_fourcc(f->fmt.pix.pixelformat);
2350         if (NULL == fmt)
2351                 return -EINVAL;
2352 
2353         field = f->fmt.pix.field;
2354 
2355         switch (field) {
2356         case V4L2_FIELD_TOP:
2357         case V4L2_FIELD_BOTTOM:
2358         case V4L2_FIELD_ALTERNATE:
2359         case V4L2_FIELD_INTERLACED:
2360                 break;
2361         case V4L2_FIELD_SEQ_BT:
2362         case V4L2_FIELD_SEQ_TB:
2363                 if (!(fmt->flags & FORMAT_FLAGS_PLANAR)) {
2364                         field = V4L2_FIELD_SEQ_TB;
2365                         break;
2366                 }
2367                 /* fall through */
2368         default: /* FIELD_ANY case */
2369                 height2 = btv->crop[!!fh->do_crop].rect.height >> 1;
2370                 field = (f->fmt.pix.height > height2)
2371                         ? V4L2_FIELD_INTERLACED
2372                         : V4L2_FIELD_BOTTOM;
2373                 break;
2374         }
2375 
2376         width = f->fmt.pix.width;
2377         height = f->fmt.pix.height;
2378 
2379         bttv_get_width_mask_vid_cap(fmt, &width_mask, &width_bias);
2380         rc = limit_scaled_size_lock(fh, &width, &height, field,
2381                                width_mask, width_bias,
2382                                /* adjust_size */ 1,
2383                                /* adjust_crop */ 0);
2384         if (0 != rc)
2385                 return rc;
2386 
2387         /* update data for the application */
2388         f->fmt.pix.field = field;
2389         pix_format_set_size(&f->fmt.pix, fmt, width, height);
2390         f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
2391 
2392         return 0;
2393 }
2394 
2395 static int bttv_try_fmt_vid_overlay(struct file *file, void *priv,
2396                                                 struct v4l2_format *f)
2397 {
2398         struct bttv_fh *fh = priv;
2399 
2400         verify_window_lock(fh, &f->fmt.win,
2401                         /* adjust_size */ 1,
2402                         /* adjust_crop */ 0);
2403         return 0;
2404 }
2405 
2406 static int bttv_s_fmt_vid_cap(struct file *file, void *priv,
2407                                 struct v4l2_format *f)
2408 {
2409         int retval;
2410         const struct bttv_format *fmt;
2411         struct bttv_fh *fh = priv;
2412         struct bttv *btv = fh->btv;
2413         __s32 width, height;
2414         unsigned int width_mask, width_bias;
2415         enum v4l2_field field;
2416 
2417         retval = bttv_switch_type(fh, f->type);
2418         if (0 != retval)
2419                 return retval;
2420 
2421         retval = bttv_try_fmt_vid_cap(file, priv, f);
2422         if (0 != retval)
2423                 return retval;
2424 
2425         width = f->fmt.pix.width;
2426         height = f->fmt.pix.height;
2427         field = f->fmt.pix.field;
2428 
2429         fmt = format_by_fourcc(f->fmt.pix.pixelformat);
2430         bttv_get_width_mask_vid_cap(fmt, &width_mask, &width_bias);
2431         retval = limit_scaled_size_lock(fh, &width, &height, f->fmt.pix.field,
2432                                width_mask, width_bias,
2433                                /* adjust_size */ 1,
2434                                /* adjust_crop */ 1);
2435         if (0 != retval)
2436                 return retval;
2437 
2438         f->fmt.pix.field = field;
2439 
2440         /* update our state informations */
2441         fh->fmt              = fmt;
2442         fh->cap.field        = f->fmt.pix.field;
2443         fh->cap.last         = V4L2_FIELD_NONE;
2444         fh->width            = f->fmt.pix.width;
2445         fh->height           = f->fmt.pix.height;
2446         btv->init.fmt        = fmt;
2447         btv->init.width      = f->fmt.pix.width;
2448         btv->init.height     = f->fmt.pix.height;
2449 
2450         return 0;
2451 }
2452 
2453 static int bttv_s_fmt_vid_overlay(struct file *file, void *priv,
2454                                 struct v4l2_format *f)
2455 {
2456         struct bttv_fh *fh = priv;
2457         struct bttv *btv = fh->btv;
2458 
2459         if (no_overlay > 0) {
2460                 pr_err("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
2461                 return -EINVAL;
2462         }
2463 
2464         return setup_window_lock(fh, btv, &f->fmt.win, 1);
2465 }
2466 
2467 static int bttv_querycap(struct file *file, void  *priv,
2468                                 struct v4l2_capability *cap)
2469 {
2470         struct video_device *vdev = video_devdata(file);
2471         struct bttv_fh *fh = priv;
2472         struct bttv *btv = fh->btv;
2473 
2474         if (0 == v4l2)
2475                 return -EINVAL;
2476 
2477         strlcpy(cap->driver, "bttv", sizeof(cap->driver));
2478         strlcpy(cap->card, btv->video_dev.name, sizeof(cap->card));
2479         snprintf(cap->bus_info, sizeof(cap->bus_info),
2480                  "PCI:%s", pci_name(btv->c.pci));
2481         cap->capabilities =
2482                 V4L2_CAP_VIDEO_CAPTURE |
2483                 V4L2_CAP_READWRITE |
2484                 V4L2_CAP_STREAMING |
2485                 V4L2_CAP_DEVICE_CAPS;
2486         if (no_overlay <= 0)
2487                 cap->capabilities |= V4L2_CAP_VIDEO_OVERLAY;
2488         if (video_is_registered(&btv->vbi_dev))
2489                 cap->capabilities |= V4L2_CAP_VBI_CAPTURE;
2490         if (video_is_registered(&btv->radio_dev))
2491                 cap->capabilities |= V4L2_CAP_RADIO;
2492 
2493         /*
2494          * No need to lock here: those vars are initialized during board
2495          * probe and remains untouched during the rest of the driver lifecycle
2496          */
2497         if (btv->has_saa6588)
2498                 cap->capabilities |= V4L2_CAP_RDS_CAPTURE;
2499         if (btv->tuner_type != TUNER_ABSENT)
2500                 cap->capabilities |= V4L2_CAP_TUNER;
2501         if (vdev->vfl_type == VFL_TYPE_GRABBER)
2502                 cap->device_caps = cap->capabilities &
2503                         (V4L2_CAP_VIDEO_CAPTURE |
2504                          V4L2_CAP_READWRITE |
2505                          V4L2_CAP_STREAMING |
2506                          V4L2_CAP_VIDEO_OVERLAY |
2507                          V4L2_CAP_TUNER);
2508         else if (vdev->vfl_type == VFL_TYPE_VBI)
2509                 cap->device_caps = cap->capabilities &
2510                         (V4L2_CAP_VBI_CAPTURE |
2511                          V4L2_CAP_READWRITE |
2512                          V4L2_CAP_STREAMING |
2513                          V4L2_CAP_TUNER);
2514         else {
2515                 cap->device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER;
2516                 if (btv->has_saa6588)
2517                         cap->device_caps |= V4L2_CAP_READWRITE |
2518                                                 V4L2_CAP_RDS_CAPTURE;
2519                 if (btv->has_tea575x)
2520                         cap->device_caps |= V4L2_CAP_HW_FREQ_SEEK;
2521         }
2522         return 0;
2523 }
2524 
2525 static int bttv_enum_fmt_cap_ovr(struct v4l2_fmtdesc *f)
2526 {
2527         int index = -1, i;
2528 
2529         for (i = 0; i < FORMATS; i++) {
2530                 if (formats[i].fourcc != -1)
2531                         index++;
2532                 if ((unsigned int)index == f->index)
2533                         break;
2534         }
2535         if (FORMATS == i)
2536                 return -EINVAL;
2537 
2538         f->pixelformat = formats[i].fourcc;
2539         strlcpy(f->description, formats[i].name, sizeof(f->description));
2540 
2541         return i;
2542 }
2543 
2544 static int bttv_enum_fmt_vid_cap(struct file *file, void  *priv,
2545                                 struct v4l2_fmtdesc *f)
2546 {
2547         int rc = bttv_enum_fmt_cap_ovr(f);
2548 
2549         if (rc < 0)
2550                 return rc;
2551 
2552         return 0;
2553 }
2554 
2555 static int bttv_enum_fmt_vid_overlay(struct file *file, void  *priv,
2556                                         struct v4l2_fmtdesc *f)
2557 {
2558         int rc;
2559 
2560         if (no_overlay > 0) {
2561                 pr_err("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
2562                 return -EINVAL;
2563         }
2564 
2565         rc = bttv_enum_fmt_cap_ovr(f);
2566 
2567         if (rc < 0)
2568                 return rc;
2569 
2570         if (!(formats[rc].flags & FORMAT_FLAGS_PACKED))
2571                 return -EINVAL;
2572 
2573         return 0;
2574 }
2575 
2576 static int bttv_g_fbuf(struct file *file, void *f,
2577                                 struct v4l2_framebuffer *fb)
2578 {
2579         struct bttv_fh *fh = f;
2580         struct bttv *btv = fh->btv;
2581 
2582         *fb = btv->fbuf;
2583         fb->capability = V4L2_FBUF_CAP_LIST_CLIPPING;
2584         fb->flags = V4L2_FBUF_FLAG_PRIMARY;
2585         if (fh->ovfmt)
2586                 fb->fmt.pixelformat  = fh->ovfmt->fourcc;
2587         return 0;
2588 }
2589 
2590 static int bttv_overlay(struct file *file, void *f, unsigned int on)
2591 {
2592         struct bttv_fh *fh = f;
2593         struct bttv *btv = fh->btv;
2594         struct bttv_buffer *new;
2595         int retval = 0;
2596 
2597         if (on) {
2598                 /* verify args */
2599                 if (unlikely(!btv->fbuf.base)) {
2600                         return -EINVAL;
2601                 }
2602                 if (unlikely(!fh->ov.setup_ok)) {
2603                         dprintk("%d: overlay: !setup_ok\n", btv->c.nr);
2604                         retval = -EINVAL;
2605                 }
2606                 if (retval)
2607                         return retval;
2608         }
2609 
2610         if (!check_alloc_btres_lock(btv, fh, RESOURCE_OVERLAY))
2611                 return -EBUSY;
2612 
2613         if (on) {
2614                 fh->ov.tvnorm = btv->tvnorm;
2615                 new = videobuf_sg_alloc(sizeof(*new));
2616                 new->crop = btv->crop[!!fh->do_crop].rect;
2617                 bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new);
2618         } else {
2619                 new = NULL;
2620         }
2621 
2622         /* switch over */
2623         retval = bttv_switch_overlay(btv, fh, new);
2624         return retval;
2625 }
2626 
2627 static int bttv_s_fbuf(struct file *file, void *f,
2628                                 const struct v4l2_framebuffer *fb)
2629 {
2630         struct bttv_fh *fh = f;
2631         struct bttv *btv = fh->btv;
2632         const struct bttv_format *fmt;
2633         int retval;
2634 
2635         if (!capable(CAP_SYS_ADMIN) &&
2636                 !capable(CAP_SYS_RAWIO))
2637                 return -EPERM;
2638 
2639         /* check args */
2640         fmt = format_by_fourcc(fb->fmt.pixelformat);
2641         if (NULL == fmt)
2642                 return -EINVAL;
2643         if (0 == (fmt->flags & FORMAT_FLAGS_PACKED))
2644                 return -EINVAL;
2645 
2646         retval = -EINVAL;
2647         if (fb->flags & V4L2_FBUF_FLAG_OVERLAY) {
2648                 __s32 width = fb->fmt.width;
2649                 __s32 height = fb->fmt.height;
2650 
2651                 retval = limit_scaled_size_lock(fh, &width, &height,
2652                                            V4L2_FIELD_INTERLACED,
2653                                            /* width_mask */ ~3,
2654                                            /* width_bias */ 2,
2655                                            /* adjust_size */ 0,
2656                                            /* adjust_crop */ 0);
2657                 if (0 != retval)
2658                         return retval;
2659         }
2660 
2661         /* ok, accept it */
2662         btv->fbuf.base       = fb->base;
2663         btv->fbuf.fmt.width  = fb->fmt.width;
2664         btv->fbuf.fmt.height = fb->fmt.height;
2665         if (0 != fb->fmt.bytesperline)
2666                 btv->fbuf.fmt.bytesperline = fb->fmt.bytesperline;
2667         else
2668                 btv->fbuf.fmt.bytesperline = btv->fbuf.fmt.width*fmt->depth/8;
2669 
2670         retval = 0;
2671         fh->ovfmt = fmt;
2672         btv->init.ovfmt = fmt;
2673         if (fb->flags & V4L2_FBUF_FLAG_OVERLAY) {
2674                 fh->ov.w.left   = 0;
2675                 fh->ov.w.top    = 0;
2676                 fh->ov.w.width  = fb->fmt.width;
2677                 fh->ov.w.height = fb->fmt.height;
2678                 btv->init.ov.w.width  = fb->fmt.width;
2679                 btv->init.ov.w.height = fb->fmt.height;
2680 
2681                 kfree(fh->ov.clips);
2682                 fh->ov.clips = NULL;
2683                 fh->ov.nclips = 0;
2684 
2685                 if (check_btres(fh, RESOURCE_OVERLAY)) {
2686                         struct bttv_buffer *new;
2687 
2688                         new = videobuf_sg_alloc(sizeof(*new));
2689                         new->crop = btv->crop[!!fh->do_crop].rect;
2690                         bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new);
2691                         retval = bttv_switch_overlay(btv, fh, new);
2692                 }
2693         }
2694         return retval;
2695 }
2696 
2697 static int bttv_reqbufs(struct file *file, void *priv,
2698                                 struct v4l2_requestbuffers *p)
2699 {
2700         struct bttv_fh *fh = priv;
2701         return videobuf_reqbufs(bttv_queue(fh), p);
2702 }
2703 
2704 static int bttv_querybuf(struct file *file, void *priv,
2705                                 struct v4l2_buffer *b)
2706 {
2707         struct bttv_fh *fh = priv;
2708         return videobuf_querybuf(bttv_queue(fh), b);
2709 }
2710 
2711 static int bttv_qbuf(struct file *file, void *priv, struct v4l2_buffer *b)
2712 {
2713         struct bttv_fh *fh = priv;
2714         struct bttv *btv = fh->btv;
2715         int res = bttv_resource(fh);
2716 
2717         if (!check_alloc_btres_lock(btv, fh, res))
2718                 return -EBUSY;
2719 
2720         return videobuf_qbuf(bttv_queue(fh), b);
2721 }
2722 
2723 static int bttv_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b)
2724 {
2725         struct bttv_fh *fh = priv;
2726         return videobuf_dqbuf(bttv_queue(fh), b,
2727                         file->f_flags & O_NONBLOCK);
2728 }
2729 
2730 static int bttv_streamon(struct file *file, void *priv,
2731                                         enum v4l2_buf_type type)
2732 {
2733         struct bttv_fh *fh = priv;
2734         struct bttv *btv = fh->btv;
2735         int res = bttv_resource(fh);
2736 
2737         if (!check_alloc_btres_lock(btv, fh, res))
2738                 return -EBUSY;
2739         return videobuf_streamon(bttv_queue(fh));
2740 }
2741 
2742 
2743 static int bttv_streamoff(struct file *file, void *priv,
2744                                         enum v4l2_buf_type type)
2745 {
2746         struct bttv_fh *fh = priv;
2747         struct bttv *btv = fh->btv;
2748         int retval;
2749         int res = bttv_resource(fh);
2750 
2751 
2752         retval = videobuf_streamoff(bttv_queue(fh));
2753         if (retval < 0)
2754                 return retval;
2755         free_btres_lock(btv, fh, res);
2756         return 0;
2757 }
2758 
2759 static int bttv_g_parm(struct file *file, void *f,
2760                                 struct v4l2_streamparm *parm)
2761 {
2762         struct bttv_fh *fh = f;
2763         struct bttv *btv = fh->btv;
2764 
2765         if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
2766                 return -EINVAL;
2767         parm->parm.capture.readbuffers = gbuffers;
2768         v4l2_video_std_frame_period(bttv_tvnorms[btv->tvnorm].v4l2_id,
2769                                     &parm->parm.capture.timeperframe);
2770 
2771         return 0;
2772 }
2773 
2774 static int bttv_g_tuner(struct file *file, void *priv,
2775                                 struct v4l2_tuner *t)
2776 {
2777         struct bttv_fh *fh = priv;
2778         struct bttv *btv = fh->btv;
2779 
2780         if (0 != t->index)
2781                 return -EINVAL;
2782 
2783         t->rxsubchans = V4L2_TUNER_SUB_MONO;
2784         t->capability = V4L2_TUNER_CAP_NORM;
2785         bttv_call_all(btv, tuner, g_tuner, t);
2786         strcpy(t->name, "Television");
2787         t->type       = V4L2_TUNER_ANALOG_TV;
2788         if (btread(BT848_DSTATUS)&BT848_DSTATUS_HLOC)
2789                 t->signal = 0xffff;
2790 
2791         if (btv->audio_mode_gpio)
2792                 btv->audio_mode_gpio(btv, t, 0);
2793 
2794         return 0;
2795 }
2796 
2797 static int bttv_cropcap(struct file *file, void *priv,
2798                                 struct v4l2_cropcap *cap)
2799 {
2800         struct bttv_fh *fh = priv;
2801         struct bttv *btv = fh->btv;
2802 
2803         if (cap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
2804             cap->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
2805                 return -EINVAL;
2806 
2807         *cap = bttv_tvnorms[btv->tvnorm].cropcap;
2808 
2809         return 0;
2810 }
2811 
2812 static int bttv_g_crop(struct file *file, void *f, struct v4l2_crop *crop)
2813 {
2814         struct bttv_fh *fh = f;
2815         struct bttv *btv = fh->btv;
2816 
2817         if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
2818             crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
2819                 return -EINVAL;
2820 
2821         /* No fh->do_crop = 1; because btv->crop[1] may be
2822            inconsistent with fh->width or fh->height and apps
2823            do not expect a change here. */
2824 
2825         crop->c = btv->crop[!!fh->do_crop].rect;
2826 
2827         return 0;
2828 }
2829 
2830 static int bttv_s_crop(struct file *file, void *f, const struct v4l2_crop *crop)
2831 {
2832         struct bttv_fh *fh = f;
2833         struct bttv *btv = fh->btv;
2834         const struct v4l2_rect *b;
2835         int retval;
2836         struct bttv_crop c;
2837         __s32 b_left;
2838         __s32 b_top;
2839         __s32 b_right;
2840         __s32 b_bottom;
2841 
2842         if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
2843             crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
2844                 return -EINVAL;
2845 
2846         /* Make sure tvnorm, vbi_end and the current cropping
2847            parameters remain consistent until we're done. Note
2848            read() may change vbi_end in check_alloc_btres_lock(). */
2849         retval = -EBUSY;
2850 
2851         if (locked_btres(fh->btv, VIDEO_RESOURCES)) {
2852                 return retval;
2853         }
2854 
2855         b = &bttv_tvnorms[btv->tvnorm].cropcap.bounds;
2856 
2857         b_left = b->left;
2858         b_right = b_left + b->width;
2859         b_bottom = b->top + b->height;
2860 
2861         b_top = max(b->top, btv->vbi_end);
2862         if (b_top + 32 >= b_bottom) {
2863                 return retval;
2864         }
2865 
2866         /* Min. scaled size 48 x 32. */
2867         c.rect.left = clamp_t(s32, crop->c.left, b_left, b_right - 48);
2868         c.rect.left = min(c.rect.left, (__s32) MAX_HDELAY);
2869 
2870         c.rect.width = clamp_t(s32, crop->c.width,
2871                              48, b_right - c.rect.left);
2872 
2873         c.rect.top = clamp_t(s32, crop->c.top, b_top, b_bottom - 32);
2874         /* Top and height must be a multiple of two. */
2875         c.rect.top = (c.rect.top + 1) & ~1;
2876 
2877         c.rect.height = clamp_t(s32, crop->c.height,
2878                               32, b_bottom - c.rect.top);
2879         c.rect.height = (c.rect.height + 1) & ~1;
2880 
2881         bttv_crop_calc_limits(&c);
2882 
2883         btv->crop[1] = c;
2884 
2885         fh->do_crop = 1;
2886 
2887         if (fh->width < c.min_scaled_width) {
2888                 fh->width = c.min_scaled_width;
2889                 btv->init.width = c.min_scaled_width;
2890         } else if (fh->width > c.max_scaled_width) {
2891                 fh->width = c.max_scaled_width;
2892                 btv->init.width = c.max_scaled_width;
2893         }
2894 
2895         if (fh->height < c.min_scaled_height) {
2896                 fh->height = c.min_scaled_height;
2897                 btv->init.height = c.min_scaled_height;
2898         } else if (fh->height > c.max_scaled_height) {
2899                 fh->height = c.max_scaled_height;
2900                 btv->init.height = c.max_scaled_height;
2901         }
2902 
2903         return 0;
2904 }
2905 
2906 static ssize_t bttv_read(struct file *file, char __user *data,
2907                          size_t count, loff_t *ppos)
2908 {
2909         struct bttv_fh *fh = file->private_data;
2910         int retval = 0;
2911 
2912         if (fh->btv->errors)
2913                 bttv_reinit_bt848(fh->btv);
2914         dprintk("%d: read count=%d type=%s\n",
2915                 fh->btv->c.nr, (int)count, v4l2_type_names[fh->type]);
2916 
2917         switch (fh->type) {
2918         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
2919                 if (!check_alloc_btres_lock(fh->btv, fh, RESOURCE_VIDEO_READ)) {
2920                         /* VIDEO_READ in use by another fh,
2921                            or VIDEO_STREAM by any fh. */
2922                         return -EBUSY;
2923                 }
2924                 retval = videobuf_read_one(&fh->cap, data, count, ppos,
2925                                            file->f_flags & O_NONBLOCK);
2926                 free_btres_lock(fh->btv, fh, RESOURCE_VIDEO_READ);
2927                 break;
2928         case V4L2_BUF_TYPE_VBI_CAPTURE:
2929                 if (!check_alloc_btres_lock(fh->btv,fh,RESOURCE_VBI))
2930                         return -EBUSY;
2931                 retval = videobuf_read_stream(&fh->vbi, data, count, ppos, 1,
2932                                               file->f_flags & O_NONBLOCK);
2933                 break;
2934         default:
2935                 BUG();
2936         }
2937         return retval;
2938 }
2939 
2940 static unsigned int bttv_poll(struct file *file, poll_table *wait)
2941 {
2942         struct bttv_fh *fh = file->private_data;
2943         struct bttv_buffer *buf;
2944         enum v4l2_field field;
2945         unsigned int rc = 0;
2946         unsigned long req_events = poll_requested_events(wait);
2947 
2948         if (v4l2_event_pending(&fh->fh))
2949                 rc = POLLPRI;
2950         else if (req_events & POLLPRI)
2951                 poll_wait(file, &fh->fh.wait, wait);
2952 
2953         if (!(req_events & (POLLIN | POLLRDNORM)))
2954                 return rc;
2955 
2956         if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type) {
2957                 if (!check_alloc_btres_lock(fh->btv,fh,RESOURCE_VBI))
2958                         return rc | POLLERR;
2959                 return rc | videobuf_poll_stream(file, &fh->vbi, wait);
2960         }
2961 
2962         if (check_btres(fh,RESOURCE_VIDEO_STREAM)) {
2963                 /* streaming capture */
2964                 if (list_empty(&fh->cap.stream))
2965                         return rc | POLLERR;
2966                 buf = list_entry(fh->cap.stream.next,struct bttv_buffer,vb.stream);
2967         } else {
2968                 /* read() capture */
2969                 if (NULL == fh->cap.read_buf) {
2970                         /* need to capture a new frame */
2971                         if (locked_btres(fh->btv,RESOURCE_VIDEO_STREAM))
2972                                 return rc | POLLERR;
2973                         fh->cap.read_buf = videobuf_sg_alloc(fh->cap.msize);
2974                         if (NULL == fh->cap.read_buf)
2975                                 return rc | POLLERR;
2976                         fh->cap.read_buf->memory = V4L2_MEMORY_USERPTR;
2977                         field = videobuf_next_field(&fh->cap);
2978                         if (0 != fh->cap.ops->buf_prepare(&fh->cap,fh->cap.read_buf,field)) {
2979                                 kfree (fh->cap.read_buf);
2980                                 fh->cap.read_buf = NULL;
2981                                 return rc | POLLERR;
2982                         }
2983                         fh->cap.ops->buf_queue(&fh->cap,fh->cap.read_buf);
2984                         fh->cap.read_off = 0;
2985                 }
2986                 buf = (struct bttv_buffer*)fh->cap.read_buf;
2987         }
2988 
2989         poll_wait(file, &buf->vb.done, wait);
2990         if (buf->vb.state == VIDEOBUF_DONE ||
2991             buf->vb.state == VIDEOBUF_ERROR)
2992                 rc = rc | POLLIN|POLLRDNORM;
2993         return rc;
2994 }
2995 
2996 static int bttv_open(struct file *file)
2997 {
2998         struct video_device *vdev = video_devdata(file);
2999         struct bttv *btv = video_drvdata(file);
3000         struct bttv_fh *fh;
3001         enum v4l2_buf_type type = 0;
3002 
3003         dprintk("open dev=%s\n", video_device_node_name(vdev));
3004 
3005         if (vdev->vfl_type == VFL_TYPE_GRABBER) {
3006                 type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
3007         } else if (vdev->vfl_type == VFL_TYPE_VBI) {
3008                 type = V4L2_BUF_TYPE_VBI_CAPTURE;
3009         } else {
3010                 WARN_ON(1);
3011                 return -ENODEV;
3012         }
3013 
3014         dprintk("%d: open called (type=%s)\n",
3015                 btv->c.nr, v4l2_type_names[type]);
3016 
3017         /* allocate per filehandle data */
3018         fh = kmalloc(sizeof(*fh), GFP_KERNEL);
3019         if (unlikely(!fh))
3020                 return -ENOMEM;
3021         btv->users++;
3022         file->private_data = fh;
3023 
3024         *fh = btv->init;
3025         v4l2_fh_init(&fh->fh, vdev);
3026 
3027         fh->type = type;
3028         fh->ov.setup_ok = 0;
3029 
3030         videobuf_queue_sg_init(&fh->cap, &bttv_video_qops,
3031                             &btv->c.pci->dev, &btv->s_lock,
3032                             V4L2_BUF_TYPE_VIDEO_CAPTURE,
3033                             V4L2_FIELD_INTERLACED,
3034                             sizeof(struct bttv_buffer),
3035                             fh, &btv->lock);
3036         videobuf_queue_sg_init(&fh->vbi, &bttv_vbi_qops,
3037                             &btv->c.pci->dev, &btv->s_lock,
3038                             V4L2_BUF_TYPE_VBI_CAPTURE,
3039                             V4L2_FIELD_SEQ_TB,
3040                             sizeof(struct bttv_buffer),
3041                             fh, &btv->lock);
3042         set_tvnorm(btv,btv->tvnorm);
3043         set_input(btv, btv->input, btv->tvnorm);
3044         audio_mute(btv, btv->mute);
3045 
3046         /* The V4L2 spec requires one global set of cropping parameters
3047            which only change on request. These are stored in btv->crop[1].
3048            However for compatibility with V4L apps and cropping unaware
3049            V4L2 apps we now reset the cropping parameters as seen through
3050            this fh, which is to say VIDIOC_G_CROP and scaling limit checks
3051            will use btv->crop[0], the default cropping parameters for the
3052            current video standard, and VIDIOC_S_FMT will not implicitely
3053            change the cropping parameters until VIDIOC_S_CROP has been
3054            called. */
3055         fh->do_crop = !reset_crop; /* module parameter */
3056 
3057         /* Likewise there should be one global set of VBI capture
3058            parameters, but for compatibility with V4L apps and earlier
3059            driver versions each fh has its own parameters. */
3060         bttv_vbi_fmt_reset(&fh->vbi_fmt, btv->tvnorm);
3061 
3062         bttv_field_count(btv);
3063         v4l2_fh_add(&fh->fh);
3064         return 0;
3065 }
3066 
3067 static int bttv_release(struct file *file)
3068 {
3069         struct bttv_fh *fh = file->private_data;
3070         struct bttv *btv = fh->btv;
3071 
3072         /* turn off overlay */
3073         if (check_btres(fh, RESOURCE_OVERLAY))
3074                 bttv_switch_overlay(btv,fh,NULL);
3075 
3076         /* stop video capture */
3077         if (check_btres(fh, RESOURCE_VIDEO_STREAM)) {
3078                 videobuf_streamoff(&fh->cap);
3079                 free_btres_lock(btv,fh,RESOURCE_VIDEO_STREAM);
3080         }
3081         if (fh->cap.read_buf) {
3082                 buffer_release(&fh->cap,fh->cap.read_buf);
3083                 kfree(fh->cap.read_buf);
3084         }
3085         if (check_btres(fh, RESOURCE_VIDEO_READ)) {
3086                 free_btres_lock(btv, fh, RESOURCE_VIDEO_READ);
3087         }
3088 
3089         /* stop vbi capture */
3090         if (check_btres(fh, RESOURCE_VBI)) {
3091                 videobuf_stop(&fh->vbi);
3092                 free_btres_lock(btv,fh,RESOURCE_VBI);
3093         }
3094 
3095         /* free stuff */
3096 
3097         videobuf_mmap_free(&fh->cap);
3098         videobuf_mmap_free(&fh->vbi);
3099         file->private_data = NULL;
3100 
3101         btv->users--;
3102         bttv_field_count(btv);
3103 
3104         if (!btv->users)
3105                 audio_mute(btv, btv->mute);
3106 
3107         v4l2_fh_del(&fh->fh);
3108         v4l2_fh_exit(&fh->fh);
3109         kfree(fh);
3110         return 0;
3111 }
3112 
3113 static int
3114 bttv_mmap(struct file *file, struct vm_area_struct *vma)
3115 {
3116         struct bttv_fh *fh = file->private_data;
3117 
3118         dprintk("%d: mmap type=%s 0x%lx+%ld\n",
3119                 fh->btv->c.nr, v4l2_type_names[fh->type],
3120                 vma->vm_start, vma->vm_end - vma->vm_start);
3121         return videobuf_mmap_mapper(bttv_queue(fh),vma);
3122 }
3123 
3124 static const struct v4l2_file_operations bttv_fops =
3125 {
3126         .owner            = THIS_MODULE,
3127         .open             = bttv_open,
3128         .release          = bttv_release,
3129         .unlocked_ioctl   = video_ioctl2,
3130         .read             = bttv_read,
3131         .mmap             = bttv_mmap,
3132         .poll             = bttv_poll,
3133 };
3134 
3135 static const struct v4l2_ioctl_ops bttv_ioctl_ops = {
3136         .vidioc_querycap                = bttv_querycap,
3137         .vidioc_enum_fmt_vid_cap        = bttv_enum_fmt_vid_cap,
3138         .vidioc_g_fmt_vid_cap           = bttv_g_fmt_vid_cap,
3139         .vidioc_try_fmt_vid_cap         = bttv_try_fmt_vid_cap,
3140         .vidioc_s_fmt_vid_cap           = bttv_s_fmt_vid_cap,
3141         .vidioc_enum_fmt_vid_overlay    = bttv_enum_fmt_vid_overlay,
3142         .vidioc_g_fmt_vid_overlay       = bttv_g_fmt_vid_overlay,
3143         .vidioc_try_fmt_vid_overlay     = bttv_try_fmt_vid_overlay,
3144         .vidioc_s_fmt_vid_overlay       = bttv_s_fmt_vid_overlay,
3145         .vidioc_g_fmt_vbi_cap           = bttv_g_fmt_vbi_cap,
3146         .vidioc_try_fmt_vbi_cap         = bttv_try_fmt_vbi_cap,
3147         .vidioc_s_fmt_vbi_cap           = bttv_s_fmt_vbi_cap,
3148         .vidioc_cropcap                 = bttv_cropcap,
3149         .vidioc_reqbufs                 = bttv_reqbufs,
3150         .vidioc_querybuf                = bttv_querybuf,
3151         .vidioc_qbuf                    = bttv_qbuf,
3152         .vidioc_dqbuf                   = bttv_dqbuf,
3153         .vidioc_s_std                   = bttv_s_std,
3154         .vidioc_g_std                   = bttv_g_std,
3155         .vidioc_enum_input              = bttv_enum_input,
3156         .vidioc_g_input                 = bttv_g_input,
3157         .vidioc_s_input                 = bttv_s_input,
3158         .vidioc_streamon                = bttv_streamon,
3159         .vidioc_streamoff               = bttv_streamoff,
3160         .vidioc_g_tuner                 = bttv_g_tuner,
3161         .vidioc_s_tuner                 = bttv_s_tuner,
3162         .vidioc_g_crop                  = bttv_g_crop,
3163         .vidioc_s_crop                  = bttv_s_crop,
3164         .vidioc_g_fbuf                  = bttv_g_fbuf,
3165         .vidioc_s_fbuf                  = bttv_s_fbuf,
3166         .vidioc_overlay                 = bttv_overlay,
3167         .vidioc_g_parm                  = bttv_g_parm,
3168         .vidioc_g_frequency             = bttv_g_frequency,
3169         .vidioc_s_frequency             = bttv_s_frequency,
3170         .vidioc_log_status              = bttv_log_status,
3171         .vidioc_querystd                = bttv_querystd,
3172         .vidioc_subscribe_event         = v4l2_ctrl_subscribe_event,
3173         .vidioc_unsubscribe_event       = v4l2_event_unsubscribe,
3174 #ifdef CONFIG_VIDEO_ADV_DEBUG
3175         .vidioc_g_register              = bttv_g_register,
3176         .vidioc_s_register              = bttv_s_register,
3177 #endif
3178 };
3179 
3180 static struct video_device bttv_video_template = {
3181         .fops         = &bttv_fops,
3182         .ioctl_ops    = &bttv_ioctl_ops,
3183         .tvnorms      = BTTV_NORMS,
3184 };
3185 
3186 /* ----------------------------------------------------------------------- */
3187 /* radio interface                                                         */
3188 
3189 static int radio_open(struct file *file)
3190 {
3191         struct video_device *vdev = video_devdata(file);
3192         struct bttv *btv = video_drvdata(file);
3193         struct bttv_fh *fh;
3194 
3195         dprintk("open dev=%s\n", video_device_node_name(vdev));
3196 
3197         dprintk("%d: open called (radio)\n", btv->c.nr);
3198 
3199         /* allocate per filehandle data */
3200         fh = kmalloc(sizeof(*fh), GFP_KERNEL);
3201         if (unlikely(!fh))
3202                 return -ENOMEM;
3203         file->private_data = fh;
3204         *fh = btv->init;
3205         v4l2_fh_init(&fh->fh, vdev);
3206 
3207         btv->radio_user++;
3208         audio_mute(btv, btv->mute);
3209 
3210         v4l2_fh_add(&fh->fh);
3211 
3212         return 0;
3213 }
3214 
3215 static int radio_release(struct file *file)
3216 {
3217         struct bttv_fh *fh = file->private_data;
3218         struct bttv *btv = fh->btv;
3219         struct saa6588_command cmd;
3220 
3221         file->private_data = NULL;
3222         v4l2_fh_del(&fh->fh);
3223         v4l2_fh_exit(&fh->fh);
3224         kfree(fh);
3225 
3226         btv->radio_user--;
3227 
3228         bttv_call_all(btv, core, ioctl, SAA6588_CMD_CLOSE, &cmd);
3229 
3230         if (btv->radio_user == 0)
3231                 btv->has_radio_tuner = 0;
3232         return 0;
3233 }
3234 
3235 static int radio_g_tuner(struct file *file, void *priv, struct v4l2_tuner *t)
3236 {
3237         struct bttv_fh *fh = priv;
3238         struct bttv *btv = fh->btv;
3239 
3240         if (0 != t->index)
3241                 return -EINVAL;
3242         strcpy(t->name, "Radio");
3243         t->type = V4L2_TUNER_RADIO;
3244         radio_enable(btv);
3245 
3246         bttv_call_all(btv, tuner, g_tuner, t);
3247 
3248         if (btv->audio_mode_gpio)
3249                 btv->audio_mode_gpio(btv, t, 0);
3250 
3251         if (btv->has_tea575x)
3252                 return snd_tea575x_g_tuner(&btv->tea, t);
3253 
3254         return 0;
3255 }
3256 
3257 static int radio_s_tuner(struct file *file, void *priv,
3258                                         const struct v4l2_tuner *t)
3259 {
3260         struct bttv_fh *fh = priv;
3261         struct bttv *btv = fh->btv;
3262 
3263         if (0 != t->index)
3264                 return -EINVAL;
3265 
3266         radio_enable(btv);
3267         bttv_call_all(btv, tuner, s_tuner, t);
3268         return 0;
3269 }
3270 
3271 static int radio_s_hw_freq_seek(struct file *file, void *priv,
3272                                         const struct v4l2_hw_freq_seek *a)
3273 {
3274         struct bttv_fh *fh = priv;
3275         struct bttv *btv = fh->btv;
3276 
3277         if (btv->has_tea575x)
3278                 return snd_tea575x_s_hw_freq_seek(file, &btv->tea, a);
3279 
3280         return -ENOTTY;
3281 }
3282 
3283 static int radio_enum_freq_bands(struct file *file, void *priv,
3284                                          struct v4l2_frequency_band *band)
3285 {
3286         struct bttv_fh *fh = priv;
3287         struct bttv *btv = fh->btv;
3288 
3289         if (btv->has_tea575x)
3290                 return snd_tea575x_enum_freq_bands(&btv->tea, band);
3291 
3292         return -ENOTTY;
3293 }
3294 
3295 static ssize_t radio_read(struct file *file, char __user *data,
3296                          size_t count, loff_t *ppos)
3297 {
3298         struct bttv_fh *fh = file->private_data;
3299         struct bttv *btv = fh->btv;
3300         struct saa6588_command cmd;
3301 
3302         cmd.block_count = count / 3;
3303         cmd.nonblocking = file->f_flags & O_NONBLOCK;
3304         cmd.buffer = data;
3305         cmd.instance = file;
3306         cmd.result = -ENODEV;
3307         radio_enable(btv);
3308 
3309         bttv_call_all(btv, core, ioctl, SAA6588_CMD_READ, &cmd);
3310 
3311         return cmd.result;
3312 }
3313 
3314 static unsigned int radio_poll(struct file *file, poll_table *wait)
3315 {
3316         struct bttv_fh *fh = file->private_data;
3317         struct bttv *btv = fh->btv;
3318         unsigned long req_events = poll_requested_events(wait);
3319         struct saa6588_command cmd;
3320         unsigned int res = 0;
3321 
3322         if (v4l2_event_pending(&fh->fh))
3323                 res = POLLPRI;
3324         else if (req_events & POLLPRI)
3325                 poll_wait(file, &fh->fh.wait, wait);
3326         radio_enable(btv);
3327         cmd.instance = file;
3328         cmd.event_list = wait;
3329         cmd.result = res;
3330         bttv_call_all(btv, core, ioctl, SAA6588_CMD_POLL, &cmd);
3331 
3332         return cmd.result;
3333 }
3334 
3335 static const struct v4l2_file_operations radio_fops =
3336 {
3337         .owner    = THIS_MODULE,
3338         .open     = radio_open,
3339         .read     = radio_read,
3340         .release  = radio_release,
3341         .unlocked_ioctl = video_ioctl2,
3342         .poll     = radio_poll,
3343 };
3344 
3345 static const struct v4l2_ioctl_ops radio_ioctl_ops = {
3346         .vidioc_querycap        = bttv_querycap,
3347         .vidioc_log_status      = bttv_log_status,
3348         .vidioc_g_tuner         = radio_g_tuner,
3349         .vidioc_s_tuner         = radio_s_tuner,
3350         .vidioc_g_frequency     = bttv_g_frequency,
3351         .vidioc_s_frequency     = bttv_s_frequency,
3352         .vidioc_s_hw_freq_seek  = radio_s_hw_freq_seek,
3353         .vidioc_enum_freq_bands = radio_enum_freq_bands,
3354         .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
3355         .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
3356 };
3357 
3358 static struct video_device radio_template = {
3359         .fops      = &radio_fops,
3360         .ioctl_ops = &radio_ioctl_ops,
3361 };
3362 
3363 /* ----------------------------------------------------------------------- */
3364 /* some debug code                                                         */
3365 
3366 static int bttv_risc_decode(u32 risc)
3367 {
3368         static char *instr[16] = {
3369                 [ BT848_RISC_WRITE     >> 28 ] = "write",
3370                 [ BT848_RISC_SKIP      >> 28 ] = "skip",
3371                 [ BT848_RISC_WRITEC    >> 28 ] = "writec",
3372                 [ BT848_RISC_JUMP      >> 28 ] = "jump",
3373                 [ BT848_RISC_SYNC      >> 28 ] = "sync",
3374                 [ BT848_RISC_WRITE123  >> 28 ] = "write123",
3375                 [ BT848_RISC_SKIP123   >> 28 ] = "skip123",
3376                 [ BT848_RISC_WRITE1S23 >> 28 ] = "write1s23",
3377         };
3378         static int incr[16] = {
3379                 [ BT848_RISC_WRITE     >> 28 ] = 2,
3380                 [ BT848_RISC_JUMP      >> 28 ] = 2,
3381                 [ BT848_RISC_SYNC      >> 28 ] = 2,
3382                 [ BT848_RISC_WRITE123  >> 28 ] = 5,
3383                 [ BT848_RISC_SKIP123   >> 28 ] = 2,
3384                 [ BT848_RISC_WRITE1S23 >> 28 ] = 3,
3385         };
3386         static char *bits[] = {
3387                 "be0",  "be1",  "be2",  "be3/resync",
3388                 "set0", "set1", "set2", "set3",
3389                 "clr0", "clr1", "clr2", "clr3",
3390                 "irq",  "res",  "eol",  "sol",
3391         };
3392         int i;
3393 
3394         pr_cont("0x%08x [ %s", risc,
3395                instr[risc >> 28] ? instr[risc >> 28] : "INVALID");
3396         for (i = ARRAY_SIZE(bits)-1; i >= 0; i--)
3397                 if (risc & (1 << (i + 12)))
3398                         pr_cont(" %s", bits[i]);
3399         pr_cont(" count=%d ]\n", risc & 0xfff);
3400         return incr[risc >> 28] ? incr[risc >> 28] : 1;
3401 }
3402 
3403 static void bttv_risc_disasm(struct bttv *btv,
3404                              struct btcx_riscmem *risc)
3405 {
3406         unsigned int i,j,n;
3407 
3408         pr_info("%s: risc disasm: %p [dma=0x%08lx]\n",
3409                 btv->c.v4l2_dev.name, risc->cpu, (unsigned long)risc->dma);
3410         for (i = 0; i < (risc->size >> 2); i += n) {
3411                 pr_info("%s:   0x%lx: ",
3412                         btv->c.v4l2_dev.name,
3413                         (unsigned long)(risc->dma + (i<<2)));
3414                 n = bttv_risc_decode(le32_to_cpu(risc->cpu[i]));
3415                 for (j = 1; j < n; j++)
3416                         pr_info("%s:   0x%lx: 0x%08x [ arg #%d ]\n",
3417                                 btv->c.v4l2_dev.name,
3418                                 (unsigned long)(risc->dma + ((i+j)<<2)),
3419                                 risc->cpu[i+j], j);
3420                 if (0 == risc->cpu[i])
3421                         break;
3422         }
3423 }
3424 
3425 static void bttv_print_riscaddr(struct bttv *btv)
3426 {
3427         pr_info("  main: %08llx\n", (unsigned long long)btv->main.dma);
3428         pr_info("  vbi : o=%08llx e=%08llx\n",
3429                 btv->cvbi ? (unsigned long long)btv->cvbi->top.dma : 0,
3430                 btv->cvbi ? (unsigned long long)btv->cvbi->bottom.dma : 0);
3431         pr_info("  cap : o=%08llx e=%08llx\n",
3432                 btv->curr.top
3433                 ? (unsigned long long)btv->curr.top->top.dma : 0,
3434                 btv->curr.bottom
3435                 ? (unsigned long long)btv->curr.bottom->bottom.dma : 0);
3436         pr_info("  scr : o=%08llx e=%08llx\n",
3437                 btv->screen ? (unsigned long long)btv->screen->top.dma : 0,
3438                 btv->screen ? (unsigned long long)btv->screen->bottom.dma : 0);
3439         bttv_risc_disasm(btv, &btv->main);
3440 }
3441 
3442 /* ----------------------------------------------------------------------- */
3443 /* irq handler                                                             */
3444 
3445 static char *irq_name[] = {
3446         "FMTCHG",  // format change detected (525 vs. 625)
3447         "VSYNC",   // vertical sync (new field)
3448         "HSYNC",   // horizontal sync
3449         "OFLOW",   // chroma/luma AGC overflow
3450         "HLOCK",   // horizontal lock changed
3451         "VPRES",   // video presence changed
3452         "6", "7",
3453         "I2CDONE", // hw irc operation finished
3454         "GPINT",   // gpio port triggered irq
3455         "10",
3456         "RISCI",   // risc instruction triggered irq
3457         "FBUS",    // pixel data fifo dropped data (high pci bus latencies)
3458         "FTRGT",   // pixel data fifo overrun
3459         "FDSR",    // fifo data stream resyncronisation
3460         "PPERR",   // parity error (data transfer)
3461         "RIPERR",  // parity error (read risc instructions)
3462         "PABORT",  // pci abort
3463         "OCERR",   // risc instruction error
3464         "SCERR",   // syncronisation error
3465 };
3466 
3467 static void bttv_print_irqbits(u32 print, u32 mark)
3468 {
3469         unsigned int i;
3470 
3471         pr_cont("bits:");
3472         for (i = 0; i < ARRAY_SIZE(irq_name); i++) {
3473                 if (print & (1 << i))
3474                         pr_cont(" %s", irq_name[i]);
3475                 if (mark & (1 << i))
3476                         pr_cont("*");
3477         }
3478 }
3479 
3480 static void bttv_irq_debug_low_latency(struct bttv *btv, u32 rc)
3481 {
3482         pr_warn("%d: irq: skipped frame [main=%lx,o_vbi=%lx,o_field=%lx,rc=%lx]\n",
3483                 btv->c.nr,
3484                 (unsigned long)btv->main.dma,
3485                 (unsigned long)le32_to_cpu(btv->main.cpu[RISC_SLOT_O_VBI+1]),
3486                 (unsigned long)le32_to_cpu(btv->main.cpu[RISC_SLOT_O_FIELD+1]),
3487                 (unsigned long)rc);
3488 
3489         if (0 == (btread(BT848_DSTATUS) & BT848_DSTATUS_HLOC)) {
3490                 pr_notice("%d: Oh, there (temporarily?) is no input signal. "
3491                           "Ok, then this is harmless, don't worry ;)\n",
3492                           btv->c.nr);
3493                 return;
3494         }
3495         pr_notice("%d: Uhm. Looks like we have unusual high IRQ latencies\n",
3496                   btv->c.nr);
3497         pr_notice("%d: Lets try to catch the culpit red-handed ...\n",
3498                   btv->c.nr);
3499         dump_stack();
3500 }
3501 
3502 static int
3503 bttv_irq_next_video(struct bttv *btv, struct bttv_buffer_set *set)
3504 {
3505         struct bttv_buffer *item;
3506 
3507         memset(set,0,sizeof(*set));
3508 
3509         /* capture request ? */
3510         if (!list_empty(&btv->capture)) {
3511                 set->frame_irq = 1;
3512                 item = list_entry(btv->capture.next, struct bttv_buffer, vb.queue);
3513                 if (V4L2_FIELD_HAS_TOP(item->vb.field))
3514                         set->top    = item;
3515                 if (V4L2_FIELD_HAS_BOTTOM(item->vb.field))
3516                         set->bottom = item;
3517 
3518                 /* capture request for other field ? */
3519                 if (!V4L2_FIELD_HAS_BOTH(item->vb.field) &&
3520                     (item->vb.queue.next != &btv->capture)) {
3521                         item = list_entry(item->vb.queue.next, struct bttv_buffer, vb.queue);
3522                         /* Mike Isely <isely@pobox.com> - Only check
3523                          * and set up the bottom field in the logic
3524                          * below.  Don't ever do the top field.  This
3525                          * of course means that if we set up the
3526                          * bottom field in the above code that we'll
3527                          * actually skip a field.  But that's OK.
3528                          * Having processed only a single buffer this
3529                          * time, then the next time around the first
3530                          * available buffer should be for a top field.
3531                          * That will then cause us here to set up a
3532                          * top then a bottom field in the normal way.
3533                          * The alternative to this understanding is
3534                          * that we set up the second available buffer
3535                          * as a top field, but that's out of order
3536                          * since this driver always processes the top
3537                          * field first - the effect will be the two
3538                          * buffers being returned in the wrong order,
3539                          * with the second buffer also being delayed
3540                          * by one field time (owing to the fifo nature
3541                          * of videobuf).  Worse still, we'll be stuck
3542                          * doing fields out of order now every time
3543                          * until something else causes a field to be
3544                          * dropped.  By effectively forcing a field to
3545                          * drop this way then we always get back into
3546                          * sync within a single frame time.  (Out of
3547                          * order fields can screw up deinterlacing
3548                          * algorithms.) */
3549                         if (!V4L2_FIELD_HAS_BOTH(item->vb.field)) {
3550                                 if (NULL == set->bottom &&
3551                                     V4L2_FIELD_BOTTOM == item->vb.field) {
3552                                         set->bottom = item;
3553                                 }
3554                                 if (NULL != set->top  &&  NULL != set->bottom)
3555                                         set->top_irq = 2;
3556                         }
3557                 }
3558         }
3559 
3560         /* screen overlay ? */
3561         if (NULL != btv->screen) {
3562                 if (V4L2_FIELD_HAS_BOTH(btv->screen->vb.field)) {
3563                         if (NULL == set->top && NULL == set->bottom) {
3564                                 set->top    = btv->screen;
3565                                 set->bottom = btv->screen;
3566                         }
3567                 } else {
3568                         if (V4L2_FIELD_TOP == btv->screen->vb.field &&
3569                             NULL == set->top) {
3570                                 set->top = btv->screen;
3571                         }
3572                         if (V4L2_FIELD_BOTTOM == btv->screen->vb.field &&
3573                             NULL == set->bottom) {
3574                                 set->bottom = btv->screen;
3575                         }
3576                 }
3577         }
3578 
3579         dprintk("%d: next set: top=%p bottom=%p [screen=%p,irq=%d,%d]\n",
3580                 btv->c.nr, set->top, set->bottom,
3581                 btv->screen, set->frame_irq, set->top_irq);
3582         return 0;
3583 }
3584 
3585 static void
3586 bttv_irq_wakeup_video(struct bttv *btv, struct bttv_buffer_set *wakeup,
3587                       struct bttv_buffer_set *curr, unsigned int state)
3588 {
3589         struct timeval ts;
3590 
3591         v4l2_get_timestamp(&ts);
3592 
3593         if (wakeup->top == wakeup->bottom) {
3594                 if (NULL != wakeup->top && curr->top != wakeup->top) {
3595                         if (irq_debug > 1)
3596                                 pr_debug("%d: wakeup: both=%p\n",
3597                                          btv->c.nr, wakeup->top);
3598                         wakeup->top->vb.ts = ts;
3599                         wakeup->top->vb.field_count = btv->field_count;
3600                         wakeup->top->vb.state = state;
3601                         wake_up(&wakeup->top->vb.done);
3602                 }
3603         } else {
3604                 if (NULL != wakeup->top && curr->top != wakeup->top) {
3605                         if (irq_debug > 1)
3606                                 pr_debug("%d: wakeup: top=%p\n",
3607                                          btv->c.nr, wakeup->top);
3608                         wakeup->top->vb.ts = ts;
3609                         wakeup->top->vb.field_count = btv->field_count;
3610                         wakeup->top->vb.state = state;
3611                         wake_up(&wakeup->top->vb.done);
3612                 }
3613                 if (NULL != wakeup->bottom && curr->bottom != wakeup->bottom) {
3614                         if (irq_debug > 1)
3615                                 pr_debug("%d: wakeup: bottom=%p\n",
3616                                          btv->c.nr, wakeup->bottom);
3617                         wakeup->bottom->vb.ts = ts;
3618                         wakeup->bottom->vb.field_count = btv->field_count;
3619                         wakeup->bottom->vb.state = state;
3620                         wake_up(&wakeup->bottom->vb.done);
3621                 }
3622         }
3623 }
3624 
3625 static void
3626 bttv_irq_wakeup_vbi(struct bttv *btv, struct bttv_buffer *wakeup,
3627                     unsigned int state)
3628 {
3629         if (NULL == wakeup)
3630                 return;
3631 
3632         v4l2_get_timestamp(&wakeup->vb.ts);
3633         wakeup->vb.field_count = btv->field_count;
3634         wakeup->vb.state = state;
3635         wake_up(&wakeup->vb.done);
3636 }
3637 
3638 static void bttv_irq_timeout(unsigned long data)
3639 {
3640         struct bttv *btv = (struct bttv *)data;
3641         struct bttv_buffer_set old,new;
3642         struct bttv_buffer *ovbi;
3643         struct bttv_buffer *item;
3644         unsigned long flags;
3645 
3646         if (bttv_verbose) {
3647                 pr_info("%d: timeout: drop=%d irq=%d/%d, risc=%08x, ",
3648                         btv->c.nr, btv->framedrop, btv->irq_me, btv->irq_total,
3649                         btread(BT848_RISC_COUNT));
3650                 bttv_print_irqbits(btread(BT848_INT_STAT),0);
3651                 pr_cont("\n");
3652         }
3653 
3654         spin_lock_irqsave(&btv->s_lock,flags);
3655 
3656         /* deactivate stuff */
3657         memset(&new,0,sizeof(new));
3658         old  = btv->curr;
3659         ovbi = btv->cvbi;
3660         btv->curr = new;
3661         btv->cvbi = NULL;
3662         btv->loop_irq = 0;
3663         bttv_buffer_activate_video(btv, &new);
3664         bttv_buffer_activate_vbi(btv,   NULL);
3665         bttv_set_dma(btv, 0);
3666 
3667         /* wake up */
3668         bttv_irq_wakeup_video(btv, &old, &new, VIDEOBUF_ERROR);
3669         bttv_irq_wakeup_vbi(btv, ovbi, VIDEOBUF_ERROR);
3670 
3671         /* cancel all outstanding capture / vbi requests */
3672         while (!list_empty(&btv->capture)) {
3673                 item = list_entry(btv->capture.next, struct bttv_buffer, vb.queue);
3674                 list_del(&item->vb.queue);
3675                 item->vb.state = VIDEOBUF_ERROR;
3676                 wake_up(&item->vb.done);
3677         }
3678         while (!list_empty(&btv->vcapture)) {
3679                 item = list_entry(btv->vcapture.next, struct bttv_buffer, vb.queue);
3680                 list_del(&item->vb.queue);
3681                 item->vb.state = VIDEOBUF_ERROR;
3682                 wake_up(&item->vb.done);
3683         }
3684 
3685         btv->errors++;
3686         spin_unlock_irqrestore(&btv->s_lock,flags);
3687 }
3688 
3689 static void
3690 bttv_irq_wakeup_top(struct bttv *btv)
3691 {
3692         struct bttv_buffer *wakeup = btv->curr.top;
3693 
3694         if (NULL == wakeup)
3695                 return;
3696 
3697         spin_lock(&btv->s_lock);
3698         btv->curr.top_irq = 0;
3699         btv->curr.top = NULL;
3700         bttv_risc_hook(btv, RISC_SLOT_O_FIELD, NULL, 0);
3701 
3702         v4l2_get_timestamp(&wakeup->vb.ts);
3703         wakeup->vb.field_count = btv->field_count;
3704         wakeup->vb.state = VIDEOBUF_DONE;
3705         wake_up(&wakeup->vb.done);
3706         spin_unlock(&btv->s_lock);
3707 }
3708 
3709 static inline int is_active(struct btcx_riscmem *risc, u32 rc)
3710 {
3711         if (rc < risc->dma)
3712                 return 0;
3713         if (rc > risc->dma + risc->size)
3714                 return 0;
3715         return 1;
3716 }
3717 
3718 static void
3719 bttv_irq_switch_video(struct bttv *btv)
3720 {
3721         struct bttv_buffer_set new;
3722         struct bttv_buffer_set old;
3723         dma_addr_t rc;
3724 
3725         spin_lock(&btv->s_lock);
3726 
3727         /* new buffer set */
3728         bttv_irq_next_video(btv, &new);
3729         rc = btread(BT848_RISC_COUNT);
3730         if ((btv->curr.top    && is_active(&btv->curr.top->top,       rc)) ||
3731             (btv->curr.bottom && is_active(&btv->curr.bottom->bottom, rc))) {
3732                 btv->framedrop++;
3733                 if (debug_latency)
3734                         bttv_irq_debug_low_latency(btv, rc);
3735                 spin_unlock(&btv->s_lock);
3736                 return;
3737         }
3738 
3739         /* switch over */
3740         old = btv->curr;
3741         btv->curr = new;
3742         btv->loop_irq &= ~1;
3743         bttv_buffer_activate_video(btv, &new);
3744         bttv_set_dma(btv, 0);
3745 
3746         /* switch input */
3747         if (UNSET != btv->new_input) {
3748                 video_mux(btv,btv->new_input);
3749                 btv->new_input = UNSET;
3750         }
3751 
3752         /* wake up finished buffers */
3753         bttv_irq_wakeup_video(btv, &old, &new, VIDEOBUF_DONE);
3754         spin_unlock(&btv->s_lock);
3755 }
3756 
3757 static void
3758 bttv_irq_switch_vbi(struct bttv *btv)
3759 {
3760         struct bttv_buffer *new = NULL;
3761         struct bttv_buffer *old;
3762         u32 rc;
3763 
3764         spin_lock(&btv->s_lock);
3765 
3766         if (!list_empty(&btv->vcapture))
3767                 new = list_entry(btv->vcapture.next, struct bttv_buffer, vb.queue);
3768         old = btv->cvbi;
3769 
3770         rc = btread(BT848_RISC_COUNT);
3771         if (NULL != old && (is_active(&old->top,    rc) ||
3772                             is_active(&old->bottom, rc))) {
3773                 btv->framedrop++;
3774                 if (debug_latency)
3775                         bttv_irq_debug_low_latency(btv, rc);
3776                 spin_unlock(&btv->s_lock);
3777                 return;
3778         }
3779 
3780         /* switch */
3781         btv->cvbi = new;
3782         btv->loop_irq &= ~4;
3783         bttv_buffer_activate_vbi(btv, new);
3784         bttv_set_dma(btv, 0);
3785 
3786         bttv_irq_wakeup_vbi(btv, old, VIDEOBUF_DONE);
3787         spin_unlock(&btv->s_lock);
3788 }
3789 
3790 static irqreturn_t bttv_irq(int irq, void *dev_id)
3791 {
3792         u32 stat,astat;
3793         u32 dstat;
3794         int count;
3795         struct bttv *btv;
3796         int handled = 0;
3797 
3798         btv=(struct bttv *)dev_id;
3799 
3800         count=0;
3801         while (1) {
3802                 /* get/clear interrupt status bits */
3803                 stat=btread(BT848_INT_STAT);
3804                 astat=stat&btread(BT848_INT_MASK);
3805                 if (!astat)
3806                         break;
3807                 handled = 1;
3808                 btwrite(stat,BT848_INT_STAT);
3809 
3810                 /* get device status bits */
3811                 dstat=btread(BT848_DSTATUS);
3812 
3813                 if (irq_debug) {
3814                         pr_debug("%d: irq loop=%d fc=%d riscs=%x, riscc=%08x, ",
3815                                  btv->c.nr, count, btv->field_count,
3816                                  stat>>28, btread(BT848_RISC_COUNT));
3817                         bttv_print_irqbits(stat,astat);
3818                         if (stat & BT848_INT_HLOCK)
3819                                 pr_cont("   HLOC => %s",
3820                                         dstat & BT848_DSTATUS_HLOC
3821                                         ? "yes" : "no");
3822                         if (stat & BT848_INT_VPRES)
3823                                 pr_cont("   PRES => %s",
3824                                         dstat & BT848_DSTATUS_PRES
3825                                         ? "yes" : "no");
3826                         if (stat & BT848_INT_FMTCHG)
3827                                 pr_cont("   NUML => %s",
3828                                         dstat & BT848_DSTATUS_NUML
3829                                         ? "625" : "525");
3830                         pr_cont("\n");
3831                 }
3832 
3833                 if (astat&BT848_INT_VSYNC)
3834                         btv->field_count++;
3835 
3836                 if ((astat & BT848_INT_GPINT) && btv->remote) {
3837                         bttv_input_irq(btv);
3838                 }
3839 
3840                 if (astat & BT848_INT_I2CDONE) {
3841                         btv->i2c_done = stat;
3842                         wake_up(&btv->i2c_queue);
3843                 }
3844 
3845                 if ((astat & BT848_INT_RISCI)  &&  (stat & (4<<28)))
3846                         bttv_irq_switch_vbi(btv);
3847 
3848                 if ((astat & BT848_INT_RISCI)  &&  (stat & (2<<28)))
3849                         bttv_irq_wakeup_top(btv);
3850 
3851                 if ((astat & BT848_INT_RISCI)  &&  (stat & (1<<28)))
3852                         bttv_irq_switch_video(btv);
3853 
3854                 if ((astat & BT848_INT_HLOCK)  &&  btv->opt_automute)
3855                         /* trigger automute */
3856                         audio_mux_gpio(btv, btv->audio_input, btv->mute);
3857 
3858                 if (astat & (BT848_INT_SCERR|BT848_INT_OCERR)) {
3859                         pr_info("%d: %s%s @ %08x,",
3860                                 btv->c.nr,
3861                                 (astat & BT848_INT_SCERR) ? "SCERR" : "",
3862                                 (astat & BT848_INT_OCERR) ? "OCERR" : "",
3863                                 btread(BT848_RISC_COUNT));
3864                         bttv_print_irqbits(stat,astat);
3865                         pr_cont("\n");
3866                         if (bttv_debug)
3867                                 bttv_print_riscaddr(btv);
3868                 }
3869                 if (fdsr && astat & BT848_INT_FDSR) {
3870                         pr_info("%d: FDSR @ %08x\n",
3871                                 btv->c.nr, btread(BT848_RISC_COUNT));
3872                         if (bttv_debug)
3873                                 bttv_print_riscaddr(btv);
3874                 }
3875 
3876                 count++;
3877                 if (count > 4) {
3878 
3879                         if (count > 8 || !(astat & BT848_INT_GPINT)) {
3880                                 btwrite(0, BT848_INT_MASK);
3881 
3882                                 pr_err("%d: IRQ lockup, cleared int mask [",
3883                                        btv->c.nr);
3884                         } else {
3885                                 pr_err("%d: IRQ lockup, clearing GPINT from int mask [",
3886                                        btv->c.nr);
3887 
3888                                 btwrite(btread(BT848_INT_MASK) & (-1 ^ BT848_INT_GPINT),
3889                                                 BT848_INT_MASK);
3890                         }
3891 
3892                         bttv_print_irqbits(stat,astat);
3893 
3894                         pr_cont("]\n");
3895                 }
3896         }
3897         btv->irq_total++;
3898         if (handled)
3899                 btv->irq_me++;
3900         return IRQ_RETVAL(handled);
3901 }
3902 
3903 
3904 /* ----------------------------------------------------------------------- */
3905 /* initialization                                                          */
3906 
3907 static void vdev_init(struct bttv *btv,
3908                       struct video_device *vfd,
3909                       const struct video_device *template,
3910                       const char *type_name)
3911 {
3912         *vfd = *template;
3913         vfd->v4l2_dev = &btv->c.v4l2_dev;
3914         vfd->release = video_device_release_empty;
3915         video_set_drvdata(vfd, btv);
3916         snprintf(vfd->name, sizeof(vfd->name), "BT%d%s %s (%s)",
3917                  btv->id, (btv->id==848 && btv->revision==0x12) ? "A" : "",
3918                  type_name, bttv_tvcards[btv->c.type].name);
3919         if (btv->tuner_type == TUNER_ABSENT) {
3920                 v4l2_disable_ioctl(vfd, VIDIOC_G_FREQUENCY);
3921                 v4l2_disable_ioctl(vfd, VIDIOC_S_FREQUENCY);
3922                 v4l2_disable_ioctl(vfd, VIDIOC_G_TUNER);
3923                 v4l2_disable_ioctl(vfd, VIDIOC_S_TUNER);
3924         }
3925 }
3926 
3927 static void bttv_unregister_video(struct bttv *btv)
3928 {
3929         video_unregister_device(&btv->video_dev);
3930         video_unregister_device(&btv->vbi_dev);
3931         video_unregister_device(&btv->radio_dev);
3932 }
3933 
3934 /* register video4linux devices */
3935 static int bttv_register_video(struct bttv *btv)
3936 {
3937         if (no_overlay > 0)
3938                 pr_notice("Overlay support disabled\n");
3939 
3940         /* video */
3941         vdev_init(btv, &btv->video_dev, &bttv_video_template, "video");
3942 
3943         if (video_register_device(&btv->video_dev, VFL_TYPE_GRABBER,
3944                                   video_nr[btv->c.nr]) < 0)
3945                 goto err;
3946         pr_info("%d: registered device %s\n",
3947                 btv->c.nr, video_device_node_name(&btv->video_dev));
3948         if (device_create_file(&btv->video_dev.dev,
3949                                      &dev_attr_card)<0) {
3950                 pr_err("%d: device_create_file 'card' failed\n", btv->c.nr);
3951                 goto err;
3952         }
3953 
3954         /* vbi */
3955         vdev_init(btv, &btv->vbi_dev, &bttv_video_template, "vbi");
3956 
3957         if (video_register_device(&btv->vbi_dev, VFL_TYPE_VBI,
3958                                   vbi_nr[btv->c.nr]) < 0)
3959                 goto err;
3960         pr_info("%d: registered device %s\n",
3961                 btv->c.nr, video_device_node_name(&btv->vbi_dev));
3962 
3963         if (!btv->has_radio)
3964                 return 0;
3965         /* radio */
3966         vdev_init(btv, &btv->radio_dev, &radio_template, "radio");
3967         btv->radio_dev.ctrl_handler = &btv->radio_ctrl_handler;
3968         if (video_register_device(&btv->radio_dev, VFL_TYPE_RADIO,
3969                                   radio_nr[btv->c.nr]) < 0)
3970                 goto err;
3971         pr_info("%d: registered device %s\n",
3972                 btv->c.nr, video_device_node_name(&btv->radio_dev));
3973 
3974         /* all done */
3975         return 0;
3976 
3977  err:
3978         bttv_unregister_video(btv);
3979         return -1;
3980 }
3981 
3982 
3983 /* on OpenFirmware machines (PowerMac at least), PCI memory cycle */
3984 /* response on cards with no firmware is not enabled by OF */
3985 static void pci_set_command(struct pci_dev *dev)
3986 {
3987 #if defined(__powerpc__)
3988         unsigned int cmd;
3989 
3990         pci_read_config_dword(dev, PCI_COMMAND, &cmd);
3991         cmd = (cmd | PCI_COMMAND_MEMORY );
3992         pci_write_config_dword(dev, PCI_COMMAND, cmd);
3993 #endif
3994 }
3995 
3996 static int bttv_probe(struct pci_dev *dev, const struct pci_device_id *pci_id)
3997 {
3998         struct v4l2_frequency init_freq = {
3999                 .tuner = 0,
4000                 .type = V4L2_TUNER_ANALOG_TV,
4001                 .frequency = 980,
4002         };
4003         int result;
4004         unsigned char lat;
4005         struct bttv *btv;
4006         struct v4l2_ctrl_handler *hdl;
4007 
4008         if (bttv_num == BTTV_MAX)
4009                 return -ENOMEM;
4010         pr_info("Bt8xx card found (%d)\n", bttv_num);
4011         bttvs[bttv_num] = btv = kzalloc(sizeof(*btv), GFP_KERNEL);
4012         if (btv == NULL) {
4013                 pr_err("out of memory\n");
4014                 return -ENOMEM;
4015         }
4016         btv->c.nr  = bttv_num;
4017         snprintf(btv->c.v4l2_dev.name, sizeof(btv->c.v4l2_dev.name),
4018                         "bttv%d", btv->c.nr);
4019 
4020         /* initialize structs / fill in defaults */
4021         mutex_init(&btv->lock);
4022         spin_lock_init(&btv->s_lock);
4023         spin_lock_init(&btv->gpio_lock);
4024         init_waitqueue_head(&btv->i2c_queue);
4025         INIT_LIST_HEAD(&btv->c.subs);
4026         INIT_LIST_HEAD(&btv->capture);
4027         INIT_LIST_HEAD(&btv->vcapture);
4028 
4029         init_timer(&btv->timeout);
4030         btv->timeout.function = bttv_irq_timeout;
4031         btv->timeout.data     = (unsigned long)btv;
4032 
4033         btv->i2c_rc = -1;
4034         btv->tuner_type  = UNSET;
4035         btv->new_input   = UNSET;
4036         btv->has_radio=radio[btv->c.nr];
4037 
4038         /* pci stuff (init, get irq/mmio, ... */
4039         btv->c.pci = dev;
4040         btv->id  = dev->device;
4041         if (pci_enable_device(dev)) {
4042                 pr_warn("%d: Can't enable device\n", btv->c.nr);
4043                 return -EIO;
4044         }
4045         if (pci_set_dma_mask(dev, DMA_BIT_MASK(32))) {
4046                 pr_warn("%d: No suitable DMA available\n", btv->c.nr);
4047                 return -EIO;
4048         }
4049         if (!request_mem_region(pci_resource_start(dev,0),
4050                                 pci_resource_len(dev,0),
4051                                 btv->c.v4l2_dev.name)) {
4052                 pr_warn("%d: can't request iomem (0x%llx)\n",
4053                         btv->c.nr,
4054                         (unsigned long long)pci_resource_start(dev, 0));
4055                 return -EBUSY;
4056         }
4057         pci_set_master(dev);
4058         pci_set_command(dev);
4059 
4060         result = v4l2_device_register(&dev->dev, &btv->c.v4l2_dev);
4061         if (result < 0) {
4062                 pr_warn("%d: v4l2_device_register() failed\n", btv->c.nr);
4063                 goto fail0;
4064         }
4065         hdl = &btv->ctrl_handler;
4066         v4l2_ctrl_handler_init(hdl, 20);
4067         btv->c.v4l2_dev.ctrl_handler = hdl;
4068         v4l2_ctrl_handler_init(&btv->radio_ctrl_handler, 6);
4069 
4070         btv->revision = dev->revision;
4071         pci_read_config_byte(dev, PCI_LATENCY_TIMER, &lat);
4072         pr_info("%d: Bt%d (rev %d) at %s, irq: %d, latency: %d, mmio: 0x%llx\n",
4073                 bttv_num, btv->id, btv->revision, pci_name(dev),
4074                 btv->c.pci->irq, lat,
4075                 (unsigned long long)pci_resource_start(dev, 0));
4076         schedule();
4077 
4078         btv->bt848_mmio = ioremap(pci_resource_start(dev, 0), 0x1000);
4079         if (NULL == btv->bt848_mmio) {
4080                 pr_err("%d: ioremap() failed\n", btv->c.nr);
4081                 result = -EIO;
4082                 goto fail1;
4083         }
4084 
4085         /* identify card */
4086         bttv_idcard(btv);
4087 
4088         /* disable irqs, register irq handler */
4089         btwrite(0, BT848_INT_MASK);
4090         result = request_irq(btv->c.pci->irq, bttv_irq,
4091             IRQF_SHARED, btv->c.v4l2_dev.name, (void *)btv);
4092         if (result < 0) {
4093                 pr_err("%d: can't get IRQ %d\n",
4094                        bttv_num, btv->c.pci->irq);
4095                 goto fail1;
4096         }
4097 
4098         if (0 != bttv_handle_chipset(btv)) {
4099                 result = -EIO;
4100                 goto fail2;
4101         }
4102 
4103         /* init options from insmod args */
4104         btv->opt_combfilter = combfilter;
4105         bttv_ctrl_combfilter.def = combfilter;
4106         bttv_ctrl_lumafilter.def = lumafilter;
4107         btv->opt_automute   = automute;
4108         bttv_ctrl_automute.def = automute;
4109         bttv_ctrl_agc_crush.def = agc_crush;
4110         btv->opt_vcr_hack   = vcr_hack;
4111         bttv_ctrl_vcr_hack.def = vcr_hack;
4112         bttv_ctrl_whitecrush_upper.def = whitecrush_upper;
4113         bttv_ctrl_whitecrush_lower.def = whitecrush_lower;
4114         btv->opt_uv_ratio   = uv_ratio;
4115         bttv_ctrl_uv_ratio.def = uv_ratio;
4116         bttv_ctrl_full_luma.def = full_luma_range;
4117         bttv_ctrl_coring.def = coring;
4118 
4119         /* fill struct bttv with some useful defaults */
4120         btv->init.btv         = btv;
4121         btv->init.ov.w.width  = 320;
4122         btv->init.ov.w.height = 240;
4123         btv->init.fmt         = format_by_fourcc(V4L2_PIX_FMT_BGR24);
4124         btv->init.width       = 320;
4125         btv->init.height      = 240;
4126         btv->init.ov.w.width  = 320;
4127         btv->init.ov.w.height = 240;
4128         btv->init.ov.field    = V4L2_FIELD_INTERLACED;
4129         btv->input = 0;
4130 
4131         v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4132                         V4L2_CID_BRIGHTNESS, 0, 0xff00, 0x100, 32768);
4133         v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4134                         V4L2_CID_CONTRAST, 0, 0xff80, 0x80, 0x6c00);
4135         v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4136                         V4L2_CID_SATURATION, 0, 0xff80, 0x80, 32768);
4137         v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4138                         V4L2_CID_COLOR_KILLER, 0, 1, 1, 0);
4139         v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4140                         V4L2_CID_HUE, 0, 0xff00, 0x100, 32768);
4141         v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4142                         V4L2_CID_CHROMA_AGC, 0, 1, 1, !!chroma_agc);
4143         v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4144                 V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0);
4145         if (btv->volume_gpio)
4146                 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4147                         V4L2_CID_AUDIO_VOLUME, 0, 0xff00, 0x100, 0xff00);
4148         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_combfilter, NULL);
4149         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_automute, NULL);
4150         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_lumafilter, NULL);
4151         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_agc_crush, NULL);
4152         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_vcr_hack, NULL);
4153         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_whitecrush_lower, NULL);
4154         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_whitecrush_upper, NULL);
4155         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_uv_ratio, NULL);
4156         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_full_luma, NULL);
4157         v4l2_ctrl_new_custom(hdl, &bttv_ctrl_coring, NULL);
4158 
4159         /* initialize hardware */
4160         if (bttv_gpio)
4161                 bttv_gpio_tracking(btv,"pre-init");
4162 
4163         bttv_risc_init_main(btv);
4164         init_bt848(btv);
4165 
4166         /* gpio */
4167         btwrite(0x00, BT848_GPIO_REG_INP);
4168         btwrite(0x00, BT848_GPIO_OUT_EN);
4169         if (bttv_verbose)
4170                 bttv_gpio_tracking(btv,"init");
4171 
4172         /* needs to be done before i2c is registered */
4173         bttv_init_card1(btv);
4174 
4175         /* register i2c + gpio */
4176         init_bttv_i2c(btv);
4177 
4178         /* some card-specific stuff (needs working i2c) */
4179         bttv_init_card2(btv);
4180         bttv_init_tuner(btv);
4181         if (btv->tuner_type != TUNER_ABSENT) {
4182                 bttv_set_frequency(btv, &init_freq);
4183                 btv->radio_freq = 90500 * 16; /* 90.5Mhz default */
4184         }
4185         btv->std = V4L2_STD_PAL;
4186         init_irqreg(btv);
4187         if (!bttv_tvcards[btv->c.type].no_video)
4188                 v4l2_ctrl_handler_setup(hdl);
4189         if (hdl->error) {
4190                 result = hdl->error;
4191                 goto fail2;
4192         }
4193         /* mute device */
4194         audio_mute(btv, 1);
4195 
4196         /* register video4linux + input */
4197         if (!bttv_tvcards[btv->c.type].no_video) {
4198                 v4l2_ctrl_add_handler(&btv->radio_ctrl_handler, hdl,
4199                                 v4l2_ctrl_radio_filter);
4200                 if (btv->radio_ctrl_handler.error) {
4201                         result = btv->radio_ctrl_handler.error;
4202                         goto fail2;
4203                 }
4204                 set_input(btv, 0, btv->tvnorm);
4205                 bttv_crop_reset(&btv->crop[0], btv->tvnorm);
4206                 btv->crop[1] = btv->crop[0]; /* current = default */
4207                 disclaim_vbi_lines(btv);
4208                 disclaim_video_lines(btv);
4209                 bttv_register_video(btv);
4210         }
4211 
4212         /* add subdevices and autoload dvb-bt8xx if needed */
4213         if (bttv_tvcards[btv->c.type].has_dvb) {
4214                 bttv_sub_add_device(&btv->c, "dvb");
4215                 request_modules(btv);
4216         }
4217 
4218         if (!disable_ir) {
4219                 init_bttv_i2c_ir(btv);
4220                 bttv_input_init(btv);
4221         }
4222 
4223         /* everything is fine */
4224         bttv_num++;
4225         return 0;
4226 
4227 fail2:
4228         free_irq(btv->c.pci->irq,btv);
4229 
4230 fail1:
4231         v4l2_ctrl_handler_free(&btv->ctrl_handler);
4232         v4l2_ctrl_handler_free(&btv->radio_ctrl_handler);
4233         v4l2_device_unregister(&btv->c.v4l2_dev);
4234 
4235 fail0:
4236         if (btv->bt848_mmio)
4237                 iounmap(btv->bt848_mmio);
4238         release_mem_region(pci_resource_start(btv->c.pci,0),
4239                            pci_resource_len(btv->c.pci,0));
4240         pci_disable_device(btv->c.pci);
4241         return result;
4242 }
4243 
4244 static void bttv_remove(struct pci_dev *pci_dev)
4245 {
4246         struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
4247         struct bttv *btv = to_bttv(v4l2_dev);
4248 
4249         if (bttv_verbose)
4250                 pr_info("%d: unloading\n", btv->c.nr);
4251 
4252         if (bttv_tvcards[btv->c.type].has_dvb)
4253                 flush_request_modules(btv);
4254 
4255         /* shutdown everything (DMA+IRQs) */
4256         btand(~15, BT848_GPIO_DMA_CTL);
4257         btwrite(0, BT848_INT_MASK);
4258         btwrite(~0x0, BT848_INT_STAT);
4259         btwrite(0x0, BT848_GPIO_OUT_EN);
4260         if (bttv_gpio)
4261                 bttv_gpio_tracking(btv,"cleanup");
4262 
4263         /* tell gpio modules we are leaving ... */
4264         btv->shutdown=1;
4265         bttv_input_fini(btv);
4266         bttv_sub_del_devices(&btv->c);
4267 
4268         /* unregister i2c_bus + input */
4269         fini_bttv_i2c(btv);
4270 
4271         /* unregister video4linux */
4272         bttv_unregister_video(btv);
4273 
4274         /* free allocated memory */
4275         v4l2_ctrl_handler_free(&btv->ctrl_handler);
4276         v4l2_ctrl_handler_free(&btv->radio_ctrl_handler);
4277         btcx_riscmem_free(btv->c.pci,&btv->main);
4278 
4279         /* free resources */
4280         free_irq(btv->c.pci->irq,btv);
4281         iounmap(btv->bt848_mmio);
4282         release_mem_region(pci_resource_start(btv->c.pci,0),
4283                            pci_resource_len(btv->c.pci,0));
4284         pci_disable_device(btv->c.pci);
4285 
4286         v4l2_device_unregister(&btv->c.v4l2_dev);
4287         bttvs[btv->c.nr] = NULL;
4288         kfree(btv);
4289 
4290         return;
4291 }
4292 
4293 #ifdef CONFIG_PM
4294 static int bttv_suspend(struct pci_dev *pci_dev, pm_message_t state)
4295 {
4296         struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
4297         struct bttv *btv = to_bttv(v4l2_dev);
4298         struct bttv_buffer_set idle;
4299         unsigned long flags;
4300 
4301         dprintk("%d: suspend %d\n", btv->c.nr, state.event);
4302 
4303         /* stop dma + irqs */
4304         spin_lock_irqsave(&btv->s_lock,flags);
4305         memset(&idle, 0, sizeof(idle));
4306         btv->state.video = btv->curr;
4307         btv->state.vbi   = btv->cvbi;
4308         btv->state.loop_irq = btv->loop_irq;
4309         btv->curr = idle;
4310         btv->loop_irq = 0;
4311         bttv_buffer_activate_video(btv, &idle);
4312         bttv_buffer_activate_vbi(btv, NULL);
4313         bttv_set_dma(btv, 0);
4314         btwrite(0, BT848_INT_MASK);
4315         spin_unlock_irqrestore(&btv->s_lock,flags);
4316 
4317         /* save bt878 state */
4318         btv->state.gpio_enable = btread(BT848_GPIO_OUT_EN);
4319         btv->state.gpio_data   = gpio_read();
4320 
4321         /* save pci state */
4322         pci_save_state(pci_dev);
4323         if (0 != pci_set_power_state(pci_dev, pci_choose_state(pci_dev, state))) {
4324                 pci_disable_device(pci_dev);
4325                 btv->state.disabled = 1;
4326         }
4327         return 0;
4328 }
4329 
4330 static int bttv_resume(struct pci_dev *pci_dev)
4331 {
4332         struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
4333         struct bttv *btv = to_bttv(v4l2_dev);
4334         unsigned long flags;
4335         int err;
4336 
4337         dprintk("%d: resume\n", btv->c.nr);
4338 
4339         /* restore pci state */
4340         if (btv->state.disabled) {
4341                 err=pci_enable_device(pci_dev);
4342                 if (err) {
4343                         pr_warn("%d: Can't enable device\n", btv->c.nr);
4344                         return err;
4345                 }
4346                 btv->state.disabled = 0;
4347         }
4348         err=pci_set_power_state(pci_dev, PCI_D0);
4349         if (err) {
4350                 pci_disable_device(pci_dev);
4351                 pr_warn("%d: Can't enable device\n", btv->c.nr);
4352                 btv->state.disabled = 1;
4353                 return err;
4354         }
4355 
4356         pci_restore_state(pci_dev);
4357 
4358         /* restore bt878 state */
4359         bttv_reinit_bt848(btv);
4360         gpio_inout(0xffffff, btv->state.gpio_enable);
4361         gpio_write(btv->state.gpio_data);
4362 
4363         /* restart dma */
4364         spin_lock_irqsave(&btv->s_lock,flags);
4365         btv->curr = btv->state.video;
4366         btv->cvbi = btv->state.vbi;
4367         btv->loop_irq = btv->state.loop_irq;
4368         bttv_buffer_activate_video(btv, &btv->curr);
4369         bttv_buffer_activate_vbi(btv, btv->cvbi);
4370         bttv_set_dma(btv, 0);
4371         spin_unlock_irqrestore(&btv->s_lock,flags);
4372         return 0;
4373 }
4374 #endif
4375 
4376 static struct pci_device_id bttv_pci_tbl[] = {
4377         {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT848), 0},
4378         {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT849), 0},
4379         {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT878), 0},
4380         {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT879), 0},
4381         {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_FUSION879), 0},
4382         {0,}
4383 };
4384 
4385 MODULE_DEVICE_TABLE(pci, bttv_pci_tbl);
4386 
4387 static struct pci_driver bttv_pci_driver = {
4388         .name     = "bttv",
4389         .id_table = bttv_pci_tbl,
4390         .probe    = bttv_probe,
4391         .remove   = bttv_remove,
4392 #ifdef CONFIG_PM
4393         .suspend  = bttv_suspend,
4394         .resume   = bttv_resume,
4395 #endif
4396 };
4397 
4398 static int __init bttv_init_module(void)
4399 {
4400         int ret;
4401 
4402         bttv_num = 0;
4403 
4404         pr_info("driver version %s loaded\n", BTTV_VERSION);
4405         if (gbuffers < 2 || gbuffers > VIDEO_MAX_FRAME)
4406                 gbuffers = 2;
4407         if (gbufsize > BTTV_MAX_FBUF)
4408                 gbufsize = BTTV_MAX_FBUF;
4409         gbufsize = (gbufsize + PAGE_SIZE - 1) & PAGE_MASK;
4410         if (bttv_verbose)
4411                 pr_info("using %d buffers with %dk (%d pages) each for capture\n",
4412                         gbuffers, gbufsize >> 10, gbufsize >> PAGE_SHIFT);
4413 
4414         bttv_check_chipset();
4415 
4416         ret = bus_register(&bttv_sub_bus_type);
4417         if (ret < 0) {
4418                 pr_warn("bus_register error: %d\n", ret);
4419                 return ret;
4420         }
4421         ret = pci_register_driver(&bttv_pci_driver);
4422         if (ret < 0)
4423                 bus_unregister(&bttv_sub_bus_type);
4424 
4425         return ret;
4426 }
4427 
4428 static void __exit bttv_cleanup_module(void)
4429 {
4430         pci_unregister_driver(&bttv_pci_driver);
4431         bus_unregister(&bttv_sub_bus_type);
4432 }
4433 
4434 module_init(bttv_init_module);
4435 module_exit(bttv_cleanup_module);
4436 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us