projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge remote-tracking branch 'md/for-next'
[deliverable/linux.git] / 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 /* defrect and bounds are set via g_selection */
2808 cap->pixelaspect = bttv_tvnorms[btv->tvnorm].cropcap.pixelaspect;
2809
2810 return 0;
2811 }
2812
2813 static int bttv_g_selection(struct file *file, void *f, struct v4l2_selection *sel)
2814 {
2815 struct bttv_fh *fh = f;
2816 struct bttv *btv = fh->btv;
2817
2818 if (sel->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
2819 sel->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
2820 return -EINVAL;
2821
2822 switch (sel->target) {
2823 case V4L2_SEL_TGT_CROP:
2824 /*
2825 * No fh->do_crop = 1; because btv->crop[1] may be
2826 * inconsistent with fh->width or fh->height and apps
2827 * do not expect a change here.
2828 */
2829 sel->r = btv->crop[!!fh->do_crop].rect;
2830 break;
2831 case V4L2_SEL_TGT_CROP_DEFAULT:
2832 sel->r = bttv_tvnorms[btv->tvnorm].cropcap.defrect;
2833 break;
2834 case V4L2_SEL_TGT_CROP_BOUNDS:
2835 sel->r = bttv_tvnorms[btv->tvnorm].cropcap.bounds;
2836 break;
2837 default:
2838 return -EINVAL;
2839 }
2840
2841 return 0;
2842 }
2843
2844 static int bttv_s_selection(struct file *file, void *f, struct v4l2_selection *sel)
2845 {
2846 struct bttv_fh *fh = f;
2847 struct bttv *btv = fh->btv;
2848 const struct v4l2_rect *b;
2849 int retval;
2850 struct bttv_crop c;
2851 __s32 b_left;
2852 __s32 b_top;
2853 __s32 b_right;
2854 __s32 b_bottom;
2855
2856 if (sel->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
2857 sel->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
2858 return -EINVAL;
2859
2860 if (sel->target != V4L2_SEL_TGT_CROP)
2861 return -EINVAL;
2862
2863 /* Make sure tvnorm, vbi_end and the current cropping
2864 parameters remain consistent until we're done. Note
2865 read() may change vbi_end in check_alloc_btres_lock(). */
2866 retval = -EBUSY;
2867
2868 if (locked_btres(fh->btv, VIDEO_RESOURCES)) {
2869 return retval;
2870 }
2871
2872 b = &bttv_tvnorms[btv->tvnorm].cropcap.bounds;
2873
2874 b_left = b->left;
2875 b_right = b_left + b->width;
2876 b_bottom = b->top + b->height;
2877
2878 b_top = max(b->top, btv->vbi_end);
2879 if (b_top + 32 >= b_bottom) {
2880 return retval;
2881 }
2882
2883 /* Min. scaled size 48 x 32. */
2884 c.rect.left = clamp_t(s32, sel->r.left, b_left, b_right - 48);
2885 c.rect.left = min(c.rect.left, (__s32) MAX_HDELAY);
2886
2887 c.rect.width = clamp_t(s32, sel->r.width,
2888 48, b_right - c.rect.left);
2889
2890 c.rect.top = clamp_t(s32, sel->r.top, b_top, b_bottom - 32);
2891 /* Top and height must be a multiple of two. */
2892 c.rect.top = (c.rect.top + 1) & ~1;
2893
2894 c.rect.height = clamp_t(s32, sel->r.height,
2895 32, b_bottom - c.rect.top);
2896 c.rect.height = (c.rect.height + 1) & ~1;
2897
2898 bttv_crop_calc_limits(&c);
2899
2900 sel->r = c.rect;
2901
2902 btv->crop[1] = c;
2903
2904 fh->do_crop = 1;
2905
2906 if (fh->width < c.min_scaled_width) {
2907 fh->width = c.min_scaled_width;
2908 btv->init.width = c.min_scaled_width;
2909 } else if (fh->width > c.max_scaled_width) {
2910 fh->width = c.max_scaled_width;
2911 btv->init.width = c.max_scaled_width;
2912 }
2913
2914 if (fh->height < c.min_scaled_height) {
2915 fh->height = c.min_scaled_height;
2916 btv->init.height = c.min_scaled_height;
2917 } else if (fh->height > c.max_scaled_height) {
2918 fh->height = c.max_scaled_height;
2919 btv->init.height = c.max_scaled_height;
2920 }
2921
2922 return 0;
2923 }
2924
2925 static ssize_t bttv_read(struct file *file, char __user *data,
2926 size_t count, loff_t *ppos)
2927 {
2928 struct bttv_fh *fh = file->private_data;
2929 int retval = 0;
2930
2931 if (fh->btv->errors)
2932 bttv_reinit_bt848(fh->btv);
2933 dprintk("%d: read count=%d type=%s\n",
2934 fh->btv->c.nr, (int)count, v4l2_type_names[fh->type]);
2935
2936 switch (fh->type) {
2937 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
2938 if (!check_alloc_btres_lock(fh->btv, fh, RESOURCE_VIDEO_READ)) {
2939 /* VIDEO_READ in use by another fh,
2940 or VIDEO_STREAM by any fh. */
2941 return -EBUSY;
2942 }
2943 retval = videobuf_read_one(&fh->cap, data, count, ppos,
2944 file->f_flags & O_NONBLOCK);
2945 free_btres_lock(fh->btv, fh, RESOURCE_VIDEO_READ);
2946 break;
2947 case V4L2_BUF_TYPE_VBI_CAPTURE:
2948 if (!check_alloc_btres_lock(fh->btv,fh,RESOURCE_VBI))
2949 return -EBUSY;
2950 retval = videobuf_read_stream(&fh->vbi, data, count, ppos, 1,
2951 file->f_flags & O_NONBLOCK);
2952 break;
2953 default:
2954 BUG();
2955 }
2956 return retval;
2957 }
2958
2959 static unsigned int bttv_poll(struct file *file, poll_table *wait)
2960 {
2961 struct bttv_fh *fh = file->private_data;
2962 struct bttv_buffer *buf;
2963 enum v4l2_field field;
2964 unsigned int rc = 0;
2965 unsigned long req_events = poll_requested_events(wait);
2966
2967 if (v4l2_event_pending(&fh->fh))
2968 rc = POLLPRI;
2969 else if (req_events & POLLPRI)
2970 poll_wait(file, &fh->fh.wait, wait);
2971
2972 if (!(req_events & (POLLIN | POLLRDNORM)))
2973 return rc;
2974
2975 if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type) {
2976 if (!check_alloc_btres_lock(fh->btv,fh,RESOURCE_VBI))
2977 return rc | POLLERR;
2978 return rc | videobuf_poll_stream(file, &fh->vbi, wait);
2979 }
2980
2981 if (check_btres(fh,RESOURCE_VIDEO_STREAM)) {
2982 /* streaming capture */
2983 if (list_empty(&fh->cap.stream))
2984 return rc | POLLERR;
2985 buf = list_entry(fh->cap.stream.next,struct bttv_buffer,vb.stream);
2986 } else {
2987 /* read() capture */
2988 if (NULL == fh->cap.read_buf) {
2989 /* need to capture a new frame */
2990 if (locked_btres(fh->btv,RESOURCE_VIDEO_STREAM))
2991 return rc | POLLERR;
2992 fh->cap.read_buf = videobuf_sg_alloc(fh->cap.msize);
2993 if (NULL == fh->cap.read_buf)
2994 return rc | POLLERR;
2995 fh->cap.read_buf->memory = V4L2_MEMORY_USERPTR;
2996 field = videobuf_next_field(&fh->cap);
2997 if (0 != fh->cap.ops->buf_prepare(&fh->cap,fh->cap.read_buf,field)) {
2998 kfree (fh->cap.read_buf);
2999 fh->cap.read_buf = NULL;
3000 return rc | POLLERR;
3001 }
3002 fh->cap.ops->buf_queue(&fh->cap,fh->cap.read_buf);
3003 fh->cap.read_off = 0;
3004 }
3005 buf = (struct bttv_buffer*)fh->cap.read_buf;
3006 }
3007
3008 poll_wait(file, &buf->vb.done, wait);
3009 if (buf->vb.state == VIDEOBUF_DONE ||
3010 buf->vb.state == VIDEOBUF_ERROR)
3011 rc = rc | POLLIN|POLLRDNORM;
3012 return rc;
3013 }
3014
3015 static int bttv_open(struct file *file)
3016 {
3017 struct video_device *vdev = video_devdata(file);
3018 struct bttv *btv = video_drvdata(file);
3019 struct bttv_fh *fh;
3020 enum v4l2_buf_type type = 0;
3021
3022 dprintk("open dev=%s\n", video_device_node_name(vdev));
3023
3024 if (vdev->vfl_type == VFL_TYPE_GRABBER) {
3025 type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
3026 } else if (vdev->vfl_type == VFL_TYPE_VBI) {
3027 type = V4L2_BUF_TYPE_VBI_CAPTURE;
3028 } else {
3029 WARN_ON(1);
3030 return -ENODEV;
3031 }
3032
3033 dprintk("%d: open called (type=%s)\n",
3034 btv->c.nr, v4l2_type_names[type]);
3035
3036 /* allocate per filehandle data */
3037 fh = kmalloc(sizeof(*fh), GFP_KERNEL);
3038 if (unlikely(!fh))
3039 return -ENOMEM;
3040 btv->users++;
3041 file->private_data = fh;
3042
3043 *fh = btv->init;
3044 v4l2_fh_init(&fh->fh, vdev);
3045
3046 fh->type = type;
3047 fh->ov.setup_ok = 0;
3048
3049 videobuf_queue_sg_init(&fh->cap, &bttv_video_qops,
3050 &btv->c.pci->dev, &btv->s_lock,
3051 V4L2_BUF_TYPE_VIDEO_CAPTURE,
3052 V4L2_FIELD_INTERLACED,
3053 sizeof(struct bttv_buffer),
3054 fh, &btv->lock);
3055 videobuf_queue_sg_init(&fh->vbi, &bttv_vbi_qops,
3056 &btv->c.pci->dev, &btv->s_lock,
3057 V4L2_BUF_TYPE_VBI_CAPTURE,
3058 V4L2_FIELD_SEQ_TB,
3059 sizeof(struct bttv_buffer),
3060 fh, &btv->lock);
3061 set_tvnorm(btv,btv->tvnorm);
3062 set_input(btv, btv->input, btv->tvnorm);
3063 audio_mute(btv, btv->mute);
3064
3065 /* The V4L2 spec requires one global set of cropping parameters
3066 which only change on request. These are stored in btv->crop[1].
3067 However for compatibility with V4L apps and cropping unaware
3068 V4L2 apps we now reset the cropping parameters as seen through
3069 this fh, which is to say VIDIOC_G_SELECTION and scaling limit checks
3070 will use btv->crop[0], the default cropping parameters for the
3071 current video standard, and VIDIOC_S_FMT will not implicitely
3072 change the cropping parameters until VIDIOC_S_SELECTION has been
3073 called. */
3074 fh->do_crop = !reset_crop; /* module parameter */
3075
3076 /* Likewise there should be one global set of VBI capture
3077 parameters, but for compatibility with V4L apps and earlier
3078 driver versions each fh has its own parameters. */
3079 bttv_vbi_fmt_reset(&fh->vbi_fmt, btv->tvnorm);
3080
3081 bttv_field_count(btv);
3082 v4l2_fh_add(&fh->fh);
3083 return 0;
3084 }
3085
3086 static int bttv_release(struct file *file)
3087 {
3088 struct bttv_fh *fh = file->private_data;
3089 struct bttv *btv = fh->btv;
3090
3091 /* turn off overlay */
3092 if (check_btres(fh, RESOURCE_OVERLAY))
3093 bttv_switch_overlay(btv,fh,NULL);
3094
3095 /* stop video capture */
3096 if (check_btres(fh, RESOURCE_VIDEO_STREAM)) {
3097 videobuf_streamoff(&fh->cap);
3098 free_btres_lock(btv,fh,RESOURCE_VIDEO_STREAM);
3099 }
3100 if (fh->cap.read_buf) {
3101 buffer_release(&fh->cap,fh->cap.read_buf);
3102 kfree(fh->cap.read_buf);
3103 }
3104 if (check_btres(fh, RESOURCE_VIDEO_READ)) {
3105 free_btres_lock(btv, fh, RESOURCE_VIDEO_READ);
3106 }
3107
3108 /* stop vbi capture */
3109 if (check_btres(fh, RESOURCE_VBI)) {
3110 videobuf_stop(&fh->vbi);
3111 free_btres_lock(btv,fh,RESOURCE_VBI);
3112 }
3113
3114 /* free stuff */
3115
3116 videobuf_mmap_free(&fh->cap);
3117 videobuf_mmap_free(&fh->vbi);
3118 file->private_data = NULL;
3119
3120 btv->users--;
3121 bttv_field_count(btv);
3122
3123 if (!btv->users)
3124 audio_mute(btv, btv->mute);
3125
3126 v4l2_fh_del(&fh->fh);
3127 v4l2_fh_exit(&fh->fh);
3128 kfree(fh);
3129 return 0;
3130 }
3131
3132 static int
3133 bttv_mmap(struct file *file, struct vm_area_struct *vma)
3134 {
3135 struct bttv_fh *fh = file->private_data;
3136
3137 dprintk("%d: mmap type=%s 0x%lx+%ld\n",
3138 fh->btv->c.nr, v4l2_type_names[fh->type],
3139 vma->vm_start, vma->vm_end - vma->vm_start);
3140 return videobuf_mmap_mapper(bttv_queue(fh),vma);
3141 }
3142
3143 static const struct v4l2_file_operations bttv_fops =
3144 {
3145 .owner = THIS_MODULE,
3146 .open = bttv_open,
3147 .release = bttv_release,
3148 .unlocked_ioctl = video_ioctl2,
3149 .read = bttv_read,
3150 .mmap = bttv_mmap,
3151 .poll = bttv_poll,
3152 };
3153
3154 static const struct v4l2_ioctl_ops bttv_ioctl_ops = {
3155 .vidioc_querycap = bttv_querycap,
3156 .vidioc_enum_fmt_vid_cap = bttv_enum_fmt_vid_cap,
3157 .vidioc_g_fmt_vid_cap = bttv_g_fmt_vid_cap,
3158 .vidioc_try_fmt_vid_cap = bttv_try_fmt_vid_cap,
3159 .vidioc_s_fmt_vid_cap = bttv_s_fmt_vid_cap,
3160 .vidioc_enum_fmt_vid_overlay = bttv_enum_fmt_vid_overlay,
3161 .vidioc_g_fmt_vid_overlay = bttv_g_fmt_vid_overlay,
3162 .vidioc_try_fmt_vid_overlay = bttv_try_fmt_vid_overlay,
3163 .vidioc_s_fmt_vid_overlay = bttv_s_fmt_vid_overlay,
3164 .vidioc_g_fmt_vbi_cap = bttv_g_fmt_vbi_cap,
3165 .vidioc_try_fmt_vbi_cap = bttv_try_fmt_vbi_cap,
3166 .vidioc_s_fmt_vbi_cap = bttv_s_fmt_vbi_cap,
3167 .vidioc_cropcap = bttv_cropcap,
3168 .vidioc_reqbufs = bttv_reqbufs,
3169 .vidioc_querybuf = bttv_querybuf,
3170 .vidioc_qbuf = bttv_qbuf,
3171 .vidioc_dqbuf = bttv_dqbuf,
3172 .vidioc_s_std = bttv_s_std,
3173 .vidioc_g_std = bttv_g_std,
3174 .vidioc_enum_input = bttv_enum_input,
3175 .vidioc_g_input = bttv_g_input,
3176 .vidioc_s_input = bttv_s_input,
3177 .vidioc_streamon = bttv_streamon,
3178 .vidioc_streamoff = bttv_streamoff,
3179 .vidioc_g_tuner = bttv_g_tuner,
3180 .vidioc_s_tuner = bttv_s_tuner,
3181 .vidioc_g_selection = bttv_g_selection,
3182 .vidioc_s_selection = bttv_s_selection,
3183 .vidioc_g_fbuf = bttv_g_fbuf,
3184 .vidioc_s_fbuf = bttv_s_fbuf,
3185 .vidioc_overlay = bttv_overlay,
3186 .vidioc_g_parm = bttv_g_parm,
3187 .vidioc_g_frequency = bttv_g_frequency,
3188 .vidioc_s_frequency = bttv_s_frequency,
3189 .vidioc_log_status = bttv_log_status,
3190 .vidioc_querystd = bttv_querystd,
3191 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
3192 .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
3193 #ifdef CONFIG_VIDEO_ADV_DEBUG
3194 .vidioc_g_register = bttv_g_register,
3195 .vidioc_s_register = bttv_s_register,
3196 #endif
3197 };
3198
3199 static struct video_device bttv_video_template = {
3200 .fops = &bttv_fops,
3201 .ioctl_ops = &bttv_ioctl_ops,
3202 .tvnorms = BTTV_NORMS,
3203 };
3204
3205 /* ----------------------------------------------------------------------- */
3206 /* radio interface */
3207
3208 static int radio_open(struct file *file)
3209 {
3210 struct video_device *vdev = video_devdata(file);
3211 struct bttv *btv = video_drvdata(file);
3212 struct bttv_fh *fh;
3213
3214 dprintk("open dev=%s\n", video_device_node_name(vdev));
3215
3216 dprintk("%d: open called (radio)\n", btv->c.nr);
3217
3218 /* allocate per filehandle data */
3219 fh = kmalloc(sizeof(*fh), GFP_KERNEL);
3220 if (unlikely(!fh))
3221 return -ENOMEM;
3222 file->private_data = fh;
3223 *fh = btv->init;
3224 v4l2_fh_init(&fh->fh, vdev);
3225
3226 btv->radio_user++;
3227 audio_mute(btv, btv->mute);
3228
3229 v4l2_fh_add(&fh->fh);
3230
3231 return 0;
3232 }
3233
3234 static int radio_release(struct file *file)
3235 {
3236 struct bttv_fh *fh = file->private_data;
3237 struct bttv *btv = fh->btv;
3238 struct saa6588_command cmd;
3239
3240 file->private_data = NULL;
3241 v4l2_fh_del(&fh->fh);
3242 v4l2_fh_exit(&fh->fh);
3243 kfree(fh);
3244
3245 btv->radio_user--;
3246
3247 bttv_call_all(btv, core, ioctl, SAA6588_CMD_CLOSE, &cmd);
3248
3249 if (btv->radio_user == 0)
3250 btv->has_radio_tuner = 0;
3251 return 0;
3252 }
3253
3254 static int radio_g_tuner(struct file *file, void *priv, struct v4l2_tuner *t)
3255 {
3256 struct bttv_fh *fh = priv;
3257 struct bttv *btv = fh->btv;
3258
3259 if (0 != t->index)
3260 return -EINVAL;
3261 strcpy(t->name, "Radio");
3262 t->type = V4L2_TUNER_RADIO;
3263 radio_enable(btv);
3264
3265 bttv_call_all(btv, tuner, g_tuner, t);
3266
3267 if (btv->audio_mode_gpio)
3268 btv->audio_mode_gpio(btv, t, 0);
3269
3270 if (btv->has_tea575x)
3271 return snd_tea575x_g_tuner(&btv->tea, t);
3272
3273 return 0;
3274 }
3275
3276 static int radio_s_tuner(struct file *file, void *priv,
3277 const struct v4l2_tuner *t)
3278 {
3279 struct bttv_fh *fh = priv;
3280 struct bttv *btv = fh->btv;
3281
3282 if (0 != t->index)
3283 return -EINVAL;
3284
3285 radio_enable(btv);
3286 bttv_call_all(btv, tuner, s_tuner, t);
3287 return 0;
3288 }
3289
3290 static int radio_s_hw_freq_seek(struct file *file, void *priv,
3291 const struct v4l2_hw_freq_seek *a)
3292 {
3293 struct bttv_fh *fh = priv;
3294 struct bttv *btv = fh->btv;
3295
3296 if (btv->has_tea575x)
3297 return snd_tea575x_s_hw_freq_seek(file, &btv->tea, a);
3298
3299 return -ENOTTY;
3300 }
3301
3302 static int radio_enum_freq_bands(struct file *file, void *priv,
3303 struct v4l2_frequency_band *band)
3304 {
3305 struct bttv_fh *fh = priv;
3306 struct bttv *btv = fh->btv;
3307
3308 if (btv->has_tea575x)
3309 return snd_tea575x_enum_freq_bands(&btv->tea, band);
3310
3311 return -ENOTTY;
3312 }
3313
3314 static ssize_t radio_read(struct file *file, char __user *data,
3315 size_t count, loff_t *ppos)
3316 {
3317 struct bttv_fh *fh = file->private_data;
3318 struct bttv *btv = fh->btv;
3319 struct saa6588_command cmd;
3320
3321 cmd.block_count = count / 3;
3322 cmd.nonblocking = file->f_flags & O_NONBLOCK;
3323 cmd.buffer = data;
3324 cmd.instance = file;
3325 cmd.result = -ENODEV;
3326 radio_enable(btv);
3327
3328 bttv_call_all(btv, core, ioctl, SAA6588_CMD_READ, &cmd);
3329
3330 return cmd.result;
3331 }
3332
3333 static unsigned int radio_poll(struct file *file, poll_table *wait)
3334 {
3335 struct bttv_fh *fh = file->private_data;
3336 struct bttv *btv = fh->btv;
3337 unsigned long req_events = poll_requested_events(wait);
3338 struct saa6588_command cmd;
3339 unsigned int res = 0;
3340
3341 if (v4l2_event_pending(&fh->fh))
3342 res = POLLPRI;
3343 else if (req_events & POLLPRI)
3344 poll_wait(file, &fh->fh.wait, wait);
3345 radio_enable(btv);
3346 cmd.instance = file;
3347 cmd.event_list = wait;
3348 cmd.result = res;
3349 bttv_call_all(btv, core, ioctl, SAA6588_CMD_POLL, &cmd);
3350
3351 return cmd.result;
3352 }
3353
3354 static const struct v4l2_file_operations radio_fops =
3355 {
3356 .owner = THIS_MODULE,
3357 .open = radio_open,
3358 .read = radio_read,
3359 .release = radio_release,
3360 .unlocked_ioctl = video_ioctl2,
3361 .poll = radio_poll,
3362 };
3363
3364 static const struct v4l2_ioctl_ops radio_ioctl_ops = {
3365 .vidioc_querycap = bttv_querycap,
3366 .vidioc_log_status = bttv_log_status,
3367 .vidioc_g_tuner = radio_g_tuner,
3368 .vidioc_s_tuner = radio_s_tuner,
3369 .vidioc_g_frequency = bttv_g_frequency,
3370 .vidioc_s_frequency = bttv_s_frequency,
3371 .vidioc_s_hw_freq_seek = radio_s_hw_freq_seek,
3372 .vidioc_enum_freq_bands = radio_enum_freq_bands,
3373 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
3374 .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
3375 };
3376
3377 static struct video_device radio_template = {
3378 .fops = &radio_fops,
3379 .ioctl_ops = &radio_ioctl_ops,
3380 };
3381
3382 /* ----------------------------------------------------------------------- */
3383 /* some debug code */
3384
3385 static int bttv_risc_decode(u32 risc)
3386 {
3387 static char *instr[16] = {
3388 [ BT848_RISC_WRITE >> 28 ] = "write",
3389 [ BT848_RISC_SKIP >> 28 ] = "skip",
3390 [ BT848_RISC_WRITEC >> 28 ] = "writec",
3391 [ BT848_RISC_JUMP >> 28 ] = "jump",
3392 [ BT848_RISC_SYNC >> 28 ] = "sync",
3393 [ BT848_RISC_WRITE123 >> 28 ] = "write123",
3394 [ BT848_RISC_SKIP123 >> 28 ] = "skip123",
3395 [ BT848_RISC_WRITE1S23 >> 28 ] = "write1s23",
3396 };
3397 static int incr[16] = {
3398 [ BT848_RISC_WRITE >> 28 ] = 2,
3399 [ BT848_RISC_JUMP >> 28 ] = 2,
3400 [ BT848_RISC_SYNC >> 28 ] = 2,
3401 [ BT848_RISC_WRITE123 >> 28 ] = 5,
3402 [ BT848_RISC_SKIP123 >> 28 ] = 2,
3403 [ BT848_RISC_WRITE1S23 >> 28 ] = 3,
3404 };
3405 static char *bits[] = {
3406 "be0", "be1", "be2", "be3/resync",
3407 "set0", "set1", "set2", "set3",
3408 "clr0", "clr1", "clr2", "clr3",
3409 "irq", "res", "eol", "sol",
3410 };
3411 int i;
3412
3413 pr_cont("0x%08x [ %s", risc,
3414 instr[risc >> 28] ? instr[risc >> 28] : "INVALID");
3415 for (i = ARRAY_SIZE(bits)-1; i >= 0; i--)
3416 if (risc & (1 << (i + 12)))
3417 pr_cont(" %s", bits[i]);
3418 pr_cont(" count=%d ]\n", risc & 0xfff);
3419 return incr[risc >> 28] ? incr[risc >> 28] : 1;
3420 }
3421
3422 static void bttv_risc_disasm(struct bttv *btv,
3423 struct btcx_riscmem *risc)
3424 {
3425 unsigned int i,j,n;
3426
3427 pr_info("%s: risc disasm: %p [dma=0x%08lx]\n",
3428 btv->c.v4l2_dev.name, risc->cpu, (unsigned long)risc->dma);
3429 for (i = 0; i < (risc->size >> 2); i += n) {
3430 pr_info("%s: 0x%lx: ",
3431 btv->c.v4l2_dev.name,
3432 (unsigned long)(risc->dma + (i<<2)));
3433 n = bttv_risc_decode(le32_to_cpu(risc->cpu[i]));
3434 for (j = 1; j < n; j++)
3435 pr_info("%s: 0x%lx: 0x%08x [ arg #%d ]\n",
3436 btv->c.v4l2_dev.name,
3437 (unsigned long)(risc->dma + ((i+j)<<2)),
3438 risc->cpu[i+j], j);
3439 if (0 == risc->cpu[i])
3440 break;
3441 }
3442 }
3443
3444 static void bttv_print_riscaddr(struct bttv *btv)
3445 {
3446 pr_info(" main: %08llx\n", (unsigned long long)btv->main.dma);
3447 pr_info(" vbi : o=%08llx e=%08llx\n",
3448 btv->cvbi ? (unsigned long long)btv->cvbi->top.dma : 0,
3449 btv->cvbi ? (unsigned long long)btv->cvbi->bottom.dma : 0);
3450 pr_info(" cap : o=%08llx e=%08llx\n",
3451 btv->curr.top
3452 ? (unsigned long long)btv->curr.top->top.dma : 0,
3453 btv->curr.bottom
3454 ? (unsigned long long)btv->curr.bottom->bottom.dma : 0);
3455 pr_info(" scr : o=%08llx e=%08llx\n",
3456 btv->screen ? (unsigned long long)btv->screen->top.dma : 0,
3457 btv->screen ? (unsigned long long)btv->screen->bottom.dma : 0);
3458 bttv_risc_disasm(btv, &btv->main);
3459 }
3460
3461 /* ----------------------------------------------------------------------- */
3462 /* irq handler */
3463
3464 static char *irq_name[] = {
3465 "FMTCHG", // format change detected (525 vs. 625)
3466 "VSYNC", // vertical sync (new field)
3467 "HSYNC", // horizontal sync
3468 "OFLOW", // chroma/luma AGC overflow
3469 "HLOCK", // horizontal lock changed
3470 "VPRES", // video presence changed
3471 "6", "7",
3472 "I2CDONE", // hw irc operation finished
3473 "GPINT", // gpio port triggered irq
3474 "10",
3475 "RISCI", // risc instruction triggered irq
3476 "FBUS", // pixel data fifo dropped data (high pci bus latencies)
3477 "FTRGT", // pixel data fifo overrun
3478 "FDSR", // fifo data stream resyncronisation
3479 "PPERR", // parity error (data transfer)
3480 "RIPERR", // parity error (read risc instructions)
3481 "PABORT", // pci abort
3482 "OCERR", // risc instruction error
3483 "SCERR", // syncronisation error
3484 };
3485
3486 static void bttv_print_irqbits(u32 print, u32 mark)
3487 {
3488 unsigned int i;
3489
3490 pr_cont("bits:");
3491 for (i = 0; i < ARRAY_SIZE(irq_name); i++) {
3492 if (print & (1 << i))
3493 pr_cont(" %s", irq_name[i]);
3494 if (mark & (1 << i))
3495 pr_cont("*");
3496 }
3497 }
3498
3499 static void bttv_irq_debug_low_latency(struct bttv *btv, u32 rc)
3500 {
3501 pr_warn("%d: irq: skipped frame [main=%lx,o_vbi=%lx,o_field=%lx,rc=%lx]\n",
3502 btv->c.nr,
3503 (unsigned long)btv->main.dma,
3504 (unsigned long)le32_to_cpu(btv->main.cpu[RISC_SLOT_O_VBI+1]),
3505 (unsigned long)le32_to_cpu(btv->main.cpu[RISC_SLOT_O_FIELD+1]),
3506 (unsigned long)rc);
3507
3508 if (0 == (btread(BT848_DSTATUS) & BT848_DSTATUS_HLOC)) {
3509 pr_notice("%d: Oh, there (temporarily?) is no input signal. "
3510 "Ok, then this is harmless, don't worry ;)\n",
3511 btv->c.nr);
3512 return;
3513 }
3514 pr_notice("%d: Uhm. Looks like we have unusual high IRQ latencies\n",
3515 btv->c.nr);
3516 pr_notice("%d: Lets try to catch the culpit red-handed ...\n",
3517 btv->c.nr);
3518 dump_stack();
3519 }
3520
3521 static int
3522 bttv_irq_next_video(struct bttv *btv, struct bttv_buffer_set *set)
3523 {
3524 struct bttv_buffer *item;
3525
3526 memset(set,0,sizeof(*set));
3527
3528 /* capture request ? */
3529 if (!list_empty(&btv->capture)) {
3530 set->frame_irq = 1;
3531 item = list_entry(btv->capture.next, struct bttv_buffer, vb.queue);
3532 if (V4L2_FIELD_HAS_TOP(item->vb.field))
3533 set->top = item;
3534 if (V4L2_FIELD_HAS_BOTTOM(item->vb.field))
3535 set->bottom = item;
3536
3537 /* capture request for other field ? */
3538 if (!V4L2_FIELD_HAS_BOTH(item->vb.field) &&
3539 (item->vb.queue.next != &btv->capture)) {
3540 item = list_entry(item->vb.queue.next, struct bttv_buffer, vb.queue);
3541 /* Mike Isely <isely@pobox.com> - Only check
3542 * and set up the bottom field in the logic
3543 * below. Don't ever do the top field. This
3544 * of course means that if we set up the
3545 * bottom field in the above code that we'll
3546 * actually skip a field. But that's OK.
3547 * Having processed only a single buffer this
3548 * time, then the next time around the first
3549 * available buffer should be for a top field.
3550 * That will then cause us here to set up a
3551 * top then a bottom field in the normal way.
3552 * The alternative to this understanding is
3553 * that we set up the second available buffer
3554 * as a top field, but that's out of order
3555 * since this driver always processes the top
3556 * field first - the effect will be the two
3557 * buffers being returned in the wrong order,
3558 * with the second buffer also being delayed
3559 * by one field time (owing to the fifo nature
3560 * of videobuf). Worse still, we'll be stuck
3561 * doing fields out of order now every time
3562 * until something else causes a field to be
3563 * dropped. By effectively forcing a field to
3564 * drop this way then we always get back into
3565 * sync within a single frame time. (Out of
3566 * order fields can screw up deinterlacing
3567 * algorithms.) */
3568 if (!V4L2_FIELD_HAS_BOTH(item->vb.field)) {
3569 if (NULL == set->bottom &&
3570 V4L2_FIELD_BOTTOM == item->vb.field) {
3571 set->bottom = item;
3572 }
3573 if (NULL != set->top && NULL != set->bottom)
3574 set->top_irq = 2;
3575 }
3576 }
3577 }
3578
3579 /* screen overlay ? */
3580 if (NULL != btv->screen) {
3581 if (V4L2_FIELD_HAS_BOTH(btv->screen->vb.field)) {
3582 if (NULL == set->top && NULL == set->bottom) {
3583 set->top = btv->screen;
3584 set->bottom = btv->screen;
3585 }
3586 } else {
3587 if (V4L2_FIELD_TOP == btv->screen->vb.field &&
3588 NULL == set->top) {
3589 set->top = btv->screen;
3590 }
3591 if (V4L2_FIELD_BOTTOM == btv->screen->vb.field &&
3592 NULL == set->bottom) {
3593 set->bottom = btv->screen;
3594 }
3595 }
3596 }
3597
3598 dprintk("%d: next set: top=%p bottom=%p [screen=%p,irq=%d,%d]\n",
3599 btv->c.nr, set->top, set->bottom,
3600 btv->screen, set->frame_irq, set->top_irq);
3601 return 0;
3602 }
3603
3604 static void
3605 bttv_irq_wakeup_video(struct bttv *btv, struct bttv_buffer_set *wakeup,
3606 struct bttv_buffer_set *curr, unsigned int state)
3607 {
3608 struct timeval ts;
3609
3610 v4l2_get_timestamp(&ts);
3611
3612 if (wakeup->top == wakeup->bottom) {
3613 if (NULL != wakeup->top && curr->top != wakeup->top) {
3614 if (irq_debug > 1)
3615 pr_debug("%d: wakeup: both=%p\n",
3616 btv->c.nr, wakeup->top);
3617 wakeup->top->vb.ts = ts;
3618 wakeup->top->vb.field_count = btv->field_count;
3619 wakeup->top->vb.state = state;
3620 wake_up(&wakeup->top->vb.done);
3621 }
3622 } else {
3623 if (NULL != wakeup->top && curr->top != wakeup->top) {
3624 if (irq_debug > 1)
3625 pr_debug("%d: wakeup: top=%p\n",
3626 btv->c.nr, wakeup->top);
3627 wakeup->top->vb.ts = ts;
3628 wakeup->top->vb.field_count = btv->field_count;
3629 wakeup->top->vb.state = state;
3630 wake_up(&wakeup->top->vb.done);
3631 }
3632 if (NULL != wakeup->bottom && curr->bottom != wakeup->bottom) {
3633 if (irq_debug > 1)
3634 pr_debug("%d: wakeup: bottom=%p\n",
3635 btv->c.nr, wakeup->bottom);
3636 wakeup->bottom->vb.ts = ts;
3637 wakeup->bottom->vb.field_count = btv->field_count;
3638 wakeup->bottom->vb.state = state;
3639 wake_up(&wakeup->bottom->vb.done);
3640 }
3641 }
3642 }
3643
3644 static void
3645 bttv_irq_wakeup_vbi(struct bttv *btv, struct bttv_buffer *wakeup,
3646 unsigned int state)
3647 {
3648 if (NULL == wakeup)
3649 return;
3650
3651 v4l2_get_timestamp(&wakeup->vb.ts);
3652 wakeup->vb.field_count = btv->field_count;
3653 wakeup->vb.state = state;
3654 wake_up(&wakeup->vb.done);
3655 }
3656
3657 static void bttv_irq_timeout(unsigned long data)
3658 {
3659 struct bttv *btv = (struct bttv *)data;
3660 struct bttv_buffer_set old,new;
3661 struct bttv_buffer *ovbi;
3662 struct bttv_buffer *item;
3663 unsigned long flags;
3664
3665 if (bttv_verbose) {
3666 pr_info("%d: timeout: drop=%d irq=%d/%d, risc=%08x, ",
3667 btv->c.nr, btv->framedrop, btv->irq_me, btv->irq_total,
3668 btread(BT848_RISC_COUNT));
3669 bttv_print_irqbits(btread(BT848_INT_STAT),0);
3670 pr_cont("\n");
3671 }
3672
3673 spin_lock_irqsave(&btv->s_lock,flags);
3674
3675 /* deactivate stuff */
3676 memset(&new,0,sizeof(new));
3677 old = btv->curr;
3678 ovbi = btv->cvbi;
3679 btv->curr = new;
3680 btv->cvbi = NULL;
3681 btv->loop_irq = 0;
3682 bttv_buffer_activate_video(btv, &new);
3683 bttv_buffer_activate_vbi(btv, NULL);
3684 bttv_set_dma(btv, 0);
3685
3686 /* wake up */
3687 bttv_irq_wakeup_video(btv, &old, &new, VIDEOBUF_ERROR);
3688 bttv_irq_wakeup_vbi(btv, ovbi, VIDEOBUF_ERROR);
3689
3690 /* cancel all outstanding capture / vbi requests */
3691 while (!list_empty(&btv->capture)) {
3692 item = list_entry(btv->capture.next, struct bttv_buffer, vb.queue);
3693 list_del(&item->vb.queue);
3694 item->vb.state = VIDEOBUF_ERROR;
3695 wake_up(&item->vb.done);
3696 }
3697 while (!list_empty(&btv->vcapture)) {
3698 item = list_entry(btv->vcapture.next, struct bttv_buffer, vb.queue);
3699 list_del(&item->vb.queue);
3700 item->vb.state = VIDEOBUF_ERROR;
3701 wake_up(&item->vb.done);
3702 }
3703
3704 btv->errors++;
3705 spin_unlock_irqrestore(&btv->s_lock,flags);
3706 }
3707
3708 static void
3709 bttv_irq_wakeup_top(struct bttv *btv)
3710 {
3711 struct bttv_buffer *wakeup = btv->curr.top;
3712
3713 if (NULL == wakeup)
3714 return;
3715
3716 spin_lock(&btv->s_lock);
3717 btv->curr.top_irq = 0;
3718 btv->curr.top = NULL;
3719 bttv_risc_hook(btv, RISC_SLOT_O_FIELD, NULL, 0);
3720
3721 v4l2_get_timestamp(&wakeup->vb.ts);
3722 wakeup->vb.field_count = btv->field_count;
3723 wakeup->vb.state = VIDEOBUF_DONE;
3724 wake_up(&wakeup->vb.done);
3725 spin_unlock(&btv->s_lock);
3726 }
3727
3728 static inline int is_active(struct btcx_riscmem *risc, u32 rc)
3729 {
3730 if (rc < risc->dma)
3731 return 0;
3732 if (rc > risc->dma + risc->size)
3733 return 0;
3734 return 1;
3735 }
3736
3737 static void
3738 bttv_irq_switch_video(struct bttv *btv)
3739 {
3740 struct bttv_buffer_set new;
3741 struct bttv_buffer_set old;
3742 dma_addr_t rc;
3743
3744 spin_lock(&btv->s_lock);
3745
3746 /* new buffer set */
3747 bttv_irq_next_video(btv, &new);
3748 rc = btread(BT848_RISC_COUNT);
3749 if ((btv->curr.top && is_active(&btv->curr.top->top, rc)) ||
3750 (btv->curr.bottom && is_active(&btv->curr.bottom->bottom, rc))) {
3751 btv->framedrop++;
3752 if (debug_latency)
3753 bttv_irq_debug_low_latency(btv, rc);
3754 spin_unlock(&btv->s_lock);
3755 return;
3756 }
3757
3758 /* switch over */
3759 old = btv->curr;
3760 btv->curr = new;
3761 btv->loop_irq &= ~1;
3762 bttv_buffer_activate_video(btv, &new);
3763 bttv_set_dma(btv, 0);
3764
3765 /* switch input */
3766 if (UNSET != btv->new_input) {
3767 video_mux(btv,btv->new_input);
3768 btv->new_input = UNSET;
3769 }
3770
3771 /* wake up finished buffers */
3772 bttv_irq_wakeup_video(btv, &old, &new, VIDEOBUF_DONE);
3773 spin_unlock(&btv->s_lock);
3774 }
3775
3776 static void
3777 bttv_irq_switch_vbi(struct bttv *btv)
3778 {
3779 struct bttv_buffer *new = NULL;
3780 struct bttv_buffer *old;
3781 u32 rc;
3782
3783 spin_lock(&btv->s_lock);
3784
3785 if (!list_empty(&btv->vcapture))
3786 new = list_entry(btv->vcapture.next, struct bttv_buffer, vb.queue);
3787 old = btv->cvbi;
3788
3789 rc = btread(BT848_RISC_COUNT);
3790 if (NULL != old && (is_active(&old->top, rc) ||
3791 is_active(&old->bottom, rc))) {
3792 btv->framedrop++;
3793 if (debug_latency)
3794 bttv_irq_debug_low_latency(btv, rc);
3795 spin_unlock(&btv->s_lock);
3796 return;
3797 }
3798
3799 /* switch */
3800 btv->cvbi = new;
3801 btv->loop_irq &= ~4;
3802 bttv_buffer_activate_vbi(btv, new);
3803 bttv_set_dma(btv, 0);
3804
3805 bttv_irq_wakeup_vbi(btv, old, VIDEOBUF_DONE);
3806 spin_unlock(&btv->s_lock);
3807 }
3808
3809 static irqreturn_t bttv_irq(int irq, void *dev_id)
3810 {
3811 u32 stat,astat;
3812 u32 dstat;
3813 int count;
3814 struct bttv *btv;
3815 int handled = 0;
3816
3817 btv=(struct bttv *)dev_id;
3818
3819 count=0;
3820 while (1) {
3821 /* get/clear interrupt status bits */
3822 stat=btread(BT848_INT_STAT);
3823 astat=stat&btread(BT848_INT_MASK);
3824 if (!astat)
3825 break;
3826 handled = 1;
3827 btwrite(stat,BT848_INT_STAT);
3828
3829 /* get device status bits */
3830 dstat=btread(BT848_DSTATUS);
3831
3832 if (irq_debug) {
3833 pr_debug("%d: irq loop=%d fc=%d riscs=%x, riscc=%08x, ",
3834 btv->c.nr, count, btv->field_count,
3835 stat>>28, btread(BT848_RISC_COUNT));
3836 bttv_print_irqbits(stat,astat);
3837 if (stat & BT848_INT_HLOCK)
3838 pr_cont(" HLOC => %s",
3839 dstat & BT848_DSTATUS_HLOC
3840 ? "yes" : "no");
3841 if (stat & BT848_INT_VPRES)
3842 pr_cont(" PRES => %s",
3843 dstat & BT848_DSTATUS_PRES
3844 ? "yes" : "no");
3845 if (stat & BT848_INT_FMTCHG)
3846 pr_cont(" NUML => %s",
3847 dstat & BT848_DSTATUS_NUML
3848 ? "625" : "525");
3849 pr_cont("\n");
3850 }
3851
3852 if (astat&BT848_INT_VSYNC)
3853 btv->field_count++;
3854
3855 if ((astat & BT848_INT_GPINT) && btv->remote) {
3856 bttv_input_irq(btv);
3857 }
3858
3859 if (astat & BT848_INT_I2CDONE) {
3860 btv->i2c_done = stat;
3861 wake_up(&btv->i2c_queue);
3862 }
3863
3864 if ((astat & BT848_INT_RISCI) && (stat & (4<<28)))
3865 bttv_irq_switch_vbi(btv);
3866
3867 if ((astat & BT848_INT_RISCI) && (stat & (2<<28)))
3868 bttv_irq_wakeup_top(btv);
3869
3870 if ((astat & BT848_INT_RISCI) && (stat & (1<<28)))
3871 bttv_irq_switch_video(btv);
3872
3873 if ((astat & BT848_INT_HLOCK) && btv->opt_automute)
3874 /* trigger automute */
3875 audio_mux_gpio(btv, btv->audio_input, btv->mute);
3876
3877 if (astat & (BT848_INT_SCERR|BT848_INT_OCERR)) {
3878 pr_info("%d: %s%s @ %08x,",
3879 btv->c.nr,
3880 (astat & BT848_INT_SCERR) ? "SCERR" : "",
3881 (astat & BT848_INT_OCERR) ? "OCERR" : "",
3882 btread(BT848_RISC_COUNT));
3883 bttv_print_irqbits(stat,astat);
3884 pr_cont("\n");
3885 if (bttv_debug)
3886 bttv_print_riscaddr(btv);
3887 }
3888 if (fdsr && astat & BT848_INT_FDSR) {
3889 pr_info("%d: FDSR @ %08x\n",
3890 btv->c.nr, btread(BT848_RISC_COUNT));
3891 if (bttv_debug)
3892 bttv_print_riscaddr(btv);
3893 }
3894
3895 count++;
3896 if (count > 4) {
3897
3898 if (count > 8 || !(astat & BT848_INT_GPINT)) {
3899 btwrite(0, BT848_INT_MASK);
3900
3901 pr_err("%d: IRQ lockup, cleared int mask [",
3902 btv->c.nr);
3903 } else {
3904 pr_err("%d: IRQ lockup, clearing GPINT from int mask [",
3905 btv->c.nr);
3906
3907 btwrite(btread(BT848_INT_MASK) & (-1 ^ BT848_INT_GPINT),
3908 BT848_INT_MASK);
3909 }
3910
3911 bttv_print_irqbits(stat,astat);
3912
3913 pr_cont("]\n");
3914 }
3915 }
3916 btv->irq_total++;
3917 if (handled)
3918 btv->irq_me++;
3919 return IRQ_RETVAL(handled);
3920 }
3921
3922
3923 /* ----------------------------------------------------------------------- */
3924 /* initialization */
3925
3926 static void vdev_init(struct bttv *btv,
3927 struct video_device *vfd,
3928 const struct video_device *template,
3929 const char *type_name)
3930 {
3931 *vfd = *template;
3932 vfd->v4l2_dev = &btv->c.v4l2_dev;
3933 vfd->release = video_device_release_empty;
3934 video_set_drvdata(vfd, btv);
3935 snprintf(vfd->name, sizeof(vfd->name), "BT%d%s %s (%s)",
3936 btv->id, (btv->id==848 && btv->revision==0x12) ? "A" : "",
3937 type_name, bttv_tvcards[btv->c.type].name);
3938 if (btv->tuner_type == TUNER_ABSENT) {
3939 v4l2_disable_ioctl(vfd, VIDIOC_G_FREQUENCY);
3940 v4l2_disable_ioctl(vfd, VIDIOC_S_FREQUENCY);
3941 v4l2_disable_ioctl(vfd, VIDIOC_G_TUNER);
3942 v4l2_disable_ioctl(vfd, VIDIOC_S_TUNER);
3943 }
3944 }
3945
3946 static void bttv_unregister_video(struct bttv *btv)
3947 {
3948 video_unregister_device(&btv->video_dev);
3949 video_unregister_device(&btv->vbi_dev);
3950 video_unregister_device(&btv->radio_dev);
3951 }
3952
3953 /* register video4linux devices */
3954 static int bttv_register_video(struct bttv *btv)
3955 {
3956 if (no_overlay > 0)
3957 pr_notice("Overlay support disabled\n");
3958
3959 /* video */
3960 vdev_init(btv, &btv->video_dev, &bttv_video_template, "video");
3961
3962 if (video_register_device(&btv->video_dev, VFL_TYPE_GRABBER,
3963 video_nr[btv->c.nr]) < 0)
3964 goto err;
3965 pr_info("%d: registered device %s\n",
3966 btv->c.nr, video_device_node_name(&btv->video_dev));
3967 if (device_create_file(&btv->video_dev.dev,
3968 &dev_attr_card)<0) {
3969 pr_err("%d: device_create_file 'card' failed\n", btv->c.nr);
3970 goto err;
3971 }
3972
3973 /* vbi */
3974 vdev_init(btv, &btv->vbi_dev, &bttv_video_template, "vbi");
3975
3976 if (video_register_device(&btv->vbi_dev, VFL_TYPE_VBI,
3977 vbi_nr[btv->c.nr]) < 0)
3978 goto err;
3979 pr_info("%d: registered device %s\n",
3980 btv->c.nr, video_device_node_name(&btv->vbi_dev));
3981
3982 if (!btv->has_radio)
3983 return 0;
3984 /* radio */
3985 vdev_init(btv, &btv->radio_dev, &radio_template, "radio");
3986 btv->radio_dev.ctrl_handler = &btv->radio_ctrl_handler;
3987 if (video_register_device(&btv->radio_dev, VFL_TYPE_RADIO,
3988 radio_nr[btv->c.nr]) < 0)
3989 goto err;
3990 pr_info("%d: registered device %s\n",
3991 btv->c.nr, video_device_node_name(&btv->radio_dev));
3992
3993 /* all done */
3994 return 0;
3995
3996 err:
3997 bttv_unregister_video(btv);
3998 return -1;
3999 }
4000
4001
4002 /* on OpenFirmware machines (PowerMac at least), PCI memory cycle */
4003 /* response on cards with no firmware is not enabled by OF */
4004 static void pci_set_command(struct pci_dev *dev)
4005 {
4006 #if defined(__powerpc__)
4007 unsigned int cmd;
4008
4009 pci_read_config_dword(dev, PCI_COMMAND, &cmd);
4010 cmd = (cmd | PCI_COMMAND_MEMORY );
4011 pci_write_config_dword(dev, PCI_COMMAND, cmd);
4012 #endif
4013 }
4014
4015 static int bttv_probe(struct pci_dev *dev, const struct pci_device_id *pci_id)
4016 {
4017 struct v4l2_frequency init_freq = {
4018 .tuner = 0,
4019 .type = V4L2_TUNER_ANALOG_TV,
4020 .frequency = 980,
4021 };
4022 int result;
4023 unsigned char lat;
4024 struct bttv *btv;
4025 struct v4l2_ctrl_handler *hdl;
4026
4027 if (bttv_num == BTTV_MAX)
4028 return -ENOMEM;
4029 pr_info("Bt8xx card found (%d)\n", bttv_num);
4030 bttvs[bttv_num] = btv = kzalloc(sizeof(*btv), GFP_KERNEL);
4031 if (btv == NULL) {
4032 pr_err("out of memory\n");
4033 return -ENOMEM;
4034 }
4035 btv->c.nr = bttv_num;
4036 snprintf(btv->c.v4l2_dev.name, sizeof(btv->c.v4l2_dev.name),
4037 "bttv%d", btv->c.nr);
4038
4039 /* initialize structs / fill in defaults */
4040 mutex_init(&btv->lock);
4041 spin_lock_init(&btv->s_lock);
4042 spin_lock_init(&btv->gpio_lock);
4043 init_waitqueue_head(&btv->i2c_queue);
4044 INIT_LIST_HEAD(&btv->c.subs);
4045 INIT_LIST_HEAD(&btv->capture);
4046 INIT_LIST_HEAD(&btv->vcapture);
4047
4048 init_timer(&btv->timeout);
4049 btv->timeout.function = bttv_irq_timeout;
4050 btv->timeout.data = (unsigned long)btv;
4051
4052 btv->i2c_rc = -1;
4053 btv->tuner_type = UNSET;
4054 btv->new_input = UNSET;
4055 btv->has_radio=radio[btv->c.nr];
4056
4057 /* pci stuff (init, get irq/mmio, ... */
4058 btv->c.pci = dev;
4059 btv->id = dev->device;
4060 if (pci_enable_device(dev)) {
4061 pr_warn("%d: Can't enable device\n", btv->c.nr);
4062 return -EIO;
4063 }
4064 if (pci_set_dma_mask(dev, DMA_BIT_MASK(32))) {
4065 pr_warn("%d: No suitable DMA available\n", btv->c.nr);
4066 return -EIO;
4067 }
4068 if (!request_mem_region(pci_resource_start(dev,0),
4069 pci_resource_len(dev,0),
4070 btv->c.v4l2_dev.name)) {
4071 pr_warn("%d: can't request iomem (0x%llx)\n",
4072 btv->c.nr,
4073 (unsigned long long)pci_resource_start(dev, 0));
4074 return -EBUSY;
4075 }
4076 pci_set_master(dev);
4077 pci_set_command(dev);
4078
4079 result = v4l2_device_register(&dev->dev, &btv->c.v4l2_dev);
4080 if (result < 0) {
4081 pr_warn("%d: v4l2_device_register() failed\n", btv->c.nr);
4082 goto fail0;
4083 }
4084 hdl = &btv->ctrl_handler;
4085 v4l2_ctrl_handler_init(hdl, 20);
4086 btv->c.v4l2_dev.ctrl_handler = hdl;
4087 v4l2_ctrl_handler_init(&btv->radio_ctrl_handler, 6);
4088
4089 btv->revision = dev->revision;
4090 pci_read_config_byte(dev, PCI_LATENCY_TIMER, &lat);
4091 pr_info("%d: Bt%d (rev %d) at %s, irq: %d, latency: %d, mmio: 0x%llx\n",
4092 bttv_num, btv->id, btv->revision, pci_name(dev),
4093 btv->c.pci->irq, lat,
4094 (unsigned long long)pci_resource_start(dev, 0));
4095 schedule();
4096
4097 btv->bt848_mmio = ioremap(pci_resource_start(dev, 0), 0x1000);
4098 if (NULL == btv->bt848_mmio) {
4099 pr_err("%d: ioremap() failed\n", btv->c.nr);
4100 result = -EIO;
4101 goto fail1;
4102 }
4103
4104 /* identify card */
4105 bttv_idcard(btv);
4106
4107 /* disable irqs, register irq handler */
4108 btwrite(0, BT848_INT_MASK);
4109 result = request_irq(btv->c.pci->irq, bttv_irq,
4110 IRQF_SHARED, btv->c.v4l2_dev.name, (void *)btv);
4111 if (result < 0) {
4112 pr_err("%d: can't get IRQ %d\n",
4113 bttv_num, btv->c.pci->irq);
4114 goto fail1;
4115 }
4116
4117 if (0 != bttv_handle_chipset(btv)) {
4118 result = -EIO;
4119 goto fail2;
4120 }
4121
4122 /* init options from insmod args */
4123 btv->opt_combfilter = combfilter;
4124 bttv_ctrl_combfilter.def = combfilter;
4125 bttv_ctrl_lumafilter.def = lumafilter;
4126 btv->opt_automute = automute;
4127 bttv_ctrl_automute.def = automute;
4128 bttv_ctrl_agc_crush.def = agc_crush;
4129 btv->opt_vcr_hack = vcr_hack;
4130 bttv_ctrl_vcr_hack.def = vcr_hack;
4131 bttv_ctrl_whitecrush_upper.def = whitecrush_upper;
4132 bttv_ctrl_whitecrush_lower.def = whitecrush_lower;
4133 btv->opt_uv_ratio = uv_ratio;
4134 bttv_ctrl_uv_ratio.def = uv_ratio;
4135 bttv_ctrl_full_luma.def = full_luma_range;
4136 bttv_ctrl_coring.def = coring;
4137
4138 /* fill struct bttv with some useful defaults */
4139 btv->init.btv = btv;
4140 btv->init.ov.w.width = 320;
4141 btv->init.ov.w.height = 240;
4142 btv->init.fmt = format_by_fourcc(V4L2_PIX_FMT_BGR24);
4143 btv->init.width = 320;
4144 btv->init.height = 240;
4145 btv->init.ov.w.width = 320;
4146 btv->init.ov.w.height = 240;
4147 btv->init.ov.field = V4L2_FIELD_INTERLACED;
4148 btv->input = 0;
4149
4150 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4151 V4L2_CID_BRIGHTNESS, 0, 0xff00, 0x100, 32768);
4152 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4153 V4L2_CID_CONTRAST, 0, 0xff80, 0x80, 0x6c00);
4154 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4155 V4L2_CID_SATURATION, 0, 0xff80, 0x80, 32768);
4156 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4157 V4L2_CID_COLOR_KILLER, 0, 1, 1, 0);
4158 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4159 V4L2_CID_HUE, 0, 0xff00, 0x100, 32768);
4160 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4161 V4L2_CID_CHROMA_AGC, 0, 1, 1, !!chroma_agc);
4162 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4163 V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0);
4164 if (btv->volume_gpio)
4165 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops,
4166 V4L2_CID_AUDIO_VOLUME, 0, 0xff00, 0x100, 0xff00);
4167 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_combfilter, NULL);
4168 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_automute, NULL);
4169 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_lumafilter, NULL);
4170 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_agc_crush, NULL);
4171 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_vcr_hack, NULL);
4172 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_whitecrush_lower, NULL);
4173 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_whitecrush_upper, NULL);
4174 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_uv_ratio, NULL);
4175 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_full_luma, NULL);
4176 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_coring, NULL);
4177
4178 /* initialize hardware */
4179 if (bttv_gpio)
4180 bttv_gpio_tracking(btv,"pre-init");
4181
4182 bttv_risc_init_main(btv);
4183 init_bt848(btv);
4184
4185 /* gpio */
4186 btwrite(0x00, BT848_GPIO_REG_INP);
4187 btwrite(0x00, BT848_GPIO_OUT_EN);
4188 if (bttv_verbose)
4189 bttv_gpio_tracking(btv,"init");
4190
4191 /* needs to be done before i2c is registered */
4192 bttv_init_card1(btv);
4193
4194 /* register i2c + gpio */
4195 init_bttv_i2c(btv);
4196
4197 /* some card-specific stuff (needs working i2c) */
4198 bttv_init_card2(btv);
4199 bttv_init_tuner(btv);
4200 if (btv->tuner_type != TUNER_ABSENT) {
4201 bttv_set_frequency(btv, &init_freq);
4202 btv->radio_freq = 90500 * 16; /* 90.5Mhz default */
4203 }
4204 btv->std = V4L2_STD_PAL;
4205 init_irqreg(btv);
4206 if (!bttv_tvcards[btv->c.type].no_video)
4207 v4l2_ctrl_handler_setup(hdl);
4208 if (hdl->error) {
4209 result = hdl->error;
4210 goto fail2;
4211 }
4212 /* mute device */
4213 audio_mute(btv, 1);
4214
4215 /* register video4linux + input */
4216 if (!bttv_tvcards[btv->c.type].no_video) {
4217 v4l2_ctrl_add_handler(&btv->radio_ctrl_handler, hdl,
4218 v4l2_ctrl_radio_filter);
4219 if (btv->radio_ctrl_handler.error) {
4220 result = btv->radio_ctrl_handler.error;
4221 goto fail2;
4222 }
4223 set_input(btv, 0, btv->tvnorm);
4224 bttv_crop_reset(&btv->crop[0], btv->tvnorm);
4225 btv->crop[1] = btv->crop[0]; /* current = default */
4226 disclaim_vbi_lines(btv);
4227 disclaim_video_lines(btv);
4228 bttv_register_video(btv);
4229 }
4230
4231 /* add subdevices and autoload dvb-bt8xx if needed */
4232 if (bttv_tvcards[btv->c.type].has_dvb) {
4233 bttv_sub_add_device(&btv->c, "dvb");
4234 request_modules(btv);
4235 }
4236
4237 if (!disable_ir) {
4238 init_bttv_i2c_ir(btv);
4239 bttv_input_init(btv);
4240 }
4241
4242 /* everything is fine */
4243 bttv_num++;
4244 return 0;
4245
4246 fail2:
4247 free_irq(btv->c.pci->irq,btv);
4248
4249 fail1:
4250 v4l2_ctrl_handler_free(&btv->ctrl_handler);
4251 v4l2_ctrl_handler_free(&btv->radio_ctrl_handler);
4252 v4l2_device_unregister(&btv->c.v4l2_dev);
4253
4254 fail0:
4255 if (btv->bt848_mmio)
4256 iounmap(btv->bt848_mmio);
4257 release_mem_region(pci_resource_start(btv->c.pci,0),
4258 pci_resource_len(btv->c.pci,0));
4259 pci_disable_device(btv->c.pci);
4260 return result;
4261 }
4262
4263 static void bttv_remove(struct pci_dev *pci_dev)
4264 {
4265 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
4266 struct bttv *btv = to_bttv(v4l2_dev);
4267
4268 if (bttv_verbose)
4269 pr_info("%d: unloading\n", btv->c.nr);
4270
4271 if (bttv_tvcards[btv->c.type].has_dvb)
4272 flush_request_modules(btv);
4273
4274 /* shutdown everything (DMA+IRQs) */
4275 btand(~15, BT848_GPIO_DMA_CTL);
4276 btwrite(0, BT848_INT_MASK);
4277 btwrite(~0x0, BT848_INT_STAT);
4278 btwrite(0x0, BT848_GPIO_OUT_EN);
4279 if (bttv_gpio)
4280 bttv_gpio_tracking(btv,"cleanup");
4281
4282 /* tell gpio modules we are leaving ... */
4283 btv->shutdown=1;
4284 bttv_input_fini(btv);
4285 bttv_sub_del_devices(&btv->c);
4286
4287 /* unregister i2c_bus + input */
4288 fini_bttv_i2c(btv);
4289
4290 /* unregister video4linux */
4291 bttv_unregister_video(btv);
4292
4293 /* free allocated memory */
4294 v4l2_ctrl_handler_free(&btv->ctrl_handler);
4295 v4l2_ctrl_handler_free(&btv->radio_ctrl_handler);
4296 btcx_riscmem_free(btv->c.pci,&btv->main);
4297
4298 /* free resources */
4299 free_irq(btv->c.pci->irq,btv);
4300 iounmap(btv->bt848_mmio);
4301 release_mem_region(pci_resource_start(btv->c.pci,0),
4302 pci_resource_len(btv->c.pci,0));
4303 pci_disable_device(btv->c.pci);
4304
4305 v4l2_device_unregister(&btv->c.v4l2_dev);
4306 bttvs[btv->c.nr] = NULL;
4307 kfree(btv);
4308
4309 return;
4310 }
4311
4312 #ifdef CONFIG_PM
4313 static int bttv_suspend(struct pci_dev *pci_dev, pm_message_t state)
4314 {
4315 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
4316 struct bttv *btv = to_bttv(v4l2_dev);
4317 struct bttv_buffer_set idle;
4318 unsigned long flags;
4319
4320 dprintk("%d: suspend %d\n", btv->c.nr, state.event);
4321
4322 /* stop dma + irqs */
4323 spin_lock_irqsave(&btv->s_lock,flags);
4324 memset(&idle, 0, sizeof(idle));
4325 btv->state.video = btv->curr;
4326 btv->state.vbi = btv->cvbi;
4327 btv->state.loop_irq = btv->loop_irq;
4328 btv->curr = idle;
4329 btv->loop_irq = 0;
4330 bttv_buffer_activate_video(btv, &idle);
4331 bttv_buffer_activate_vbi(btv, NULL);
4332 bttv_set_dma(btv, 0);
4333 btwrite(0, BT848_INT_MASK);
4334 spin_unlock_irqrestore(&btv->s_lock,flags);
4335
4336 /* save bt878 state */
4337 btv->state.gpio_enable = btread(BT848_GPIO_OUT_EN);
4338 btv->state.gpio_data = gpio_read();
4339
4340 /* save pci state */
4341 pci_save_state(pci_dev);
4342 if (0 != pci_set_power_state(pci_dev, pci_choose_state(pci_dev, state))) {
4343 pci_disable_device(pci_dev);
4344 btv->state.disabled = 1;
4345 }
4346 return 0;
4347 }
4348
4349 static int bttv_resume(struct pci_dev *pci_dev)
4350 {
4351 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev);
4352 struct bttv *btv = to_bttv(v4l2_dev);
4353 unsigned long flags;
4354 int err;
4355
4356 dprintk("%d: resume\n", btv->c.nr);
4357
4358 /* restore pci state */
4359 if (btv->state.disabled) {
4360 err=pci_enable_device(pci_dev);
4361 if (err) {
4362 pr_warn("%d: Can't enable device\n", btv->c.nr);
4363 return err;
4364 }
4365 btv->state.disabled = 0;
4366 }
4367 err=pci_set_power_state(pci_dev, PCI_D0);
4368 if (err) {
4369 pci_disable_device(pci_dev);
4370 pr_warn("%d: Can't enable device\n", btv->c.nr);
4371 btv->state.disabled = 1;
4372 return err;
4373 }
4374
4375 pci_restore_state(pci_dev);
4376
4377 /* restore bt878 state */
4378 bttv_reinit_bt848(btv);
4379 gpio_inout(0xffffff, btv->state.gpio_enable);
4380 gpio_write(btv->state.gpio_data);
4381
4382 /* restart dma */
4383 spin_lock_irqsave(&btv->s_lock,flags);
4384 btv->curr = btv->state.video;
4385 btv->cvbi = btv->state.vbi;
4386 btv->loop_irq = btv->state.loop_irq;
4387 bttv_buffer_activate_video(btv, &btv->curr);
4388 bttv_buffer_activate_vbi(btv, btv->cvbi);
4389 bttv_set_dma(btv, 0);
4390 spin_unlock_irqrestore(&btv->s_lock,flags);
4391 return 0;
4392 }
4393 #endif
4394
4395 static struct pci_device_id bttv_pci_tbl[] = {
4396 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT848), 0},
4397 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT849), 0},
4398 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT878), 0},
4399 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT879), 0},
4400 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_FUSION879), 0},
4401 {0,}
4402 };
4403
4404 MODULE_DEVICE_TABLE(pci, bttv_pci_tbl);
4405
4406 static struct pci_driver bttv_pci_driver = {
4407 .name = "bttv",
4408 .id_table = bttv_pci_tbl,
4409 .probe = bttv_probe,
4410 .remove = bttv_remove,
4411 #ifdef CONFIG_PM
4412 .suspend = bttv_suspend,
4413 .resume = bttv_resume,
4414 #endif
4415 };
4416
4417 static int __init bttv_init_module(void)
4418 {
4419 int ret;
4420
4421 bttv_num = 0;
4422
4423 pr_info("driver version %s loaded\n", BTTV_VERSION);
4424 if (gbuffers < 2 || gbuffers > VIDEO_MAX_FRAME)
4425 gbuffers = 2;
4426 if (gbufsize > BTTV_MAX_FBUF)
4427 gbufsize = BTTV_MAX_FBUF;
4428 gbufsize = (gbufsize + PAGE_SIZE - 1) & PAGE_MASK;
4429 if (bttv_verbose)
4430 pr_info("using %d buffers with %dk (%d pages) each for capture\n",
4431 gbuffers, gbufsize >> 10, gbufsize >> PAGE_SHIFT);
4432
4433 bttv_check_chipset();
4434
4435 ret = bus_register(&bttv_sub_bus_type);
4436 if (ret < 0) {
4437 pr_warn("bus_register error: %d\n", ret);
4438 return ret;
4439 }
4440 ret = pci_register_driver(&bttv_pci_driver);
4441 if (ret < 0)
4442 bus_unregister(&bttv_sub_bus_type);
4443
4444 return ret;
4445 }
4446
4447 static void __exit bttv_cleanup_module(void)
4448 {
4449 pci_unregister_driver(&bttv_pci_driver);
4450 bus_unregister(&bttv_sub_bus_type);
4451 }
4452
4453 module_init(bttv_init_module);
4454 module_exit(bttv_cleanup_module);
Linux kernel - Deliverables
This page took 0.1523 seconds and 5 git commands to generate.