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/tvaudio.h> 54 #include <media/msp3400.h> 55 56 #include <linux/dma-mapping.h> 57 58 #include <asm/io.h> 59 #include <asm/byteorder.h> 60 61 #include <media/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 = container_of(cd, struct video_device, dev); 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(48, c->rect.width >> 4) + 3) & ~3; 1130 c->min_scaled_height = 1131 max(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, core, 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 int retval = 0; 1535 1536 dprintk("switch_overlay: enter [new=%p]\n", new); 1537 if (new) 1538 new->vb.state = VIDEOBUF_DONE; 1539 spin_lock_irqsave(&btv->s_lock,flags); 1540 old = btv->screen; 1541 btv->screen = new; 1542 btv->loop_irq |= 1; 1543 bttv_set_dma(btv, 0x03); 1544 spin_unlock_irqrestore(&btv->s_lock,flags); 1545 if (NULL != old) { 1546 dprintk("switch_overlay: old=%p state is %d\n", 1547 old, old->vb.state); 1548 bttv_dma_free(&fh->cap,btv, old); 1549 kfree(old); 1550 } 1551 if (NULL == new) 1552 free_btres_lock(btv,fh,RESOURCE_OVERLAY); 1553 dprintk("switch_overlay: done\n"); 1554 return retval; 1555 } 1556 1557 /* ----------------------------------------------------------------------- */ 1558 /* video4linux (1) interface */ 1559 1560 static int bttv_prepare_buffer(struct videobuf_queue *q,struct bttv *btv, 1561 struct bttv_buffer *buf, 1562 const struct bttv_format *fmt, 1563 unsigned int width, unsigned int height, 1564 enum v4l2_field field) 1565 { 1566 struct bttv_fh *fh = q->priv_data; 1567 int redo_dma_risc = 0; 1568 struct bttv_crop c; 1569 int norm; 1570 int rc; 1571 1572 /* check settings */ 1573 if (NULL == fmt) 1574 return -EINVAL; 1575 if (fmt->btformat == BT848_COLOR_FMT_RAW) { 1576 width = RAW_BPL; 1577 height = RAW_LINES*2; 1578 if (width*height > buf->vb.bsize) 1579 return -EINVAL; 1580 buf->vb.size = buf->vb.bsize; 1581 1582 /* Make sure tvnorm and vbi_end remain consistent 1583 until we're done. */ 1584 1585 norm = btv->tvnorm; 1586 1587 /* In this mode capturing always starts at defrect.top 1588 (default VDELAY), ignoring cropping parameters. */ 1589 if (btv->vbi_end > bttv_tvnorms[norm].cropcap.defrect.top) { 1590 return -EINVAL; 1591 } 1592 1593 c.rect = bttv_tvnorms[norm].cropcap.defrect; 1594 } else { 1595 norm = btv->tvnorm; 1596 c = btv->crop[!!fh->do_crop]; 1597 1598 if (width < c.min_scaled_width || 1599 width > c.max_scaled_width || 1600 height < c.min_scaled_height) 1601 return -EINVAL; 1602 1603 switch (field) { 1604 case V4L2_FIELD_TOP: 1605 case V4L2_FIELD_BOTTOM: 1606 case V4L2_FIELD_ALTERNATE: 1607 /* btv->crop counts frame lines. Max. scale 1608 factor is 16:1 for frames, 8:1 for fields. */ 1609 if (height * 2 > c.max_scaled_height) 1610 return -EINVAL; 1611 break; 1612 1613 default: 1614 if (height > c.max_scaled_height) 1615 return -EINVAL; 1616 break; 1617 } 1618 1619 buf->vb.size = (width * height * fmt->depth) >> 3; 1620 if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size) 1621 return -EINVAL; 1622 } 1623 1624 /* alloc + fill struct bttv_buffer (if changed) */ 1625 if (buf->vb.width != width || buf->vb.height != height || 1626 buf->vb.field != field || 1627 buf->tvnorm != norm || buf->fmt != fmt || 1628 buf->crop.top != c.rect.top || 1629 buf->crop.left != c.rect.left || 1630 buf->crop.width != c.rect.width || 1631 buf->crop.height != c.rect.height) { 1632 buf->vb.width = width; 1633 buf->vb.height = height; 1634 buf->vb.field = field; 1635 buf->tvnorm = norm; 1636 buf->fmt = fmt; 1637 buf->crop = c.rect; 1638 redo_dma_risc = 1; 1639 } 1640 1641 /* alloc risc memory */ 1642 if (VIDEOBUF_NEEDS_INIT == buf->vb.state) { 1643 redo_dma_risc = 1; 1644 if (0 != (rc = videobuf_iolock(q,&buf->vb,&btv->fbuf))) 1645 goto fail; 1646 } 1647 1648 if (redo_dma_risc) 1649 if (0 != (rc = bttv_buffer_risc(btv,buf))) 1650 goto fail; 1651 1652 buf->vb.state = VIDEOBUF_PREPARED; 1653 return 0; 1654 1655 fail: 1656 bttv_dma_free(q,btv,buf); 1657 return rc; 1658 } 1659 1660 static int 1661 buffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size) 1662 { 1663 struct bttv_fh *fh = q->priv_data; 1664 1665 *size = fh->fmt->depth*fh->width*fh->height >> 3; 1666 if (0 == *count) 1667 *count = gbuffers; 1668 if (*size * *count > gbuffers * gbufsize) 1669 *count = (gbuffers * gbufsize) / *size; 1670 return 0; 1671 } 1672 1673 static int 1674 buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb, 1675 enum v4l2_field field) 1676 { 1677 struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb); 1678 struct bttv_fh *fh = q->priv_data; 1679 1680 return bttv_prepare_buffer(q,fh->btv, buf, fh->fmt, 1681 fh->width, fh->height, field); 1682 } 1683 1684 static void 1685 buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb) 1686 { 1687 struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb); 1688 struct bttv_fh *fh = q->priv_data; 1689 struct bttv *btv = fh->btv; 1690 1691 buf->vb.state = VIDEOBUF_QUEUED; 1692 list_add_tail(&buf->vb.queue,&btv->capture); 1693 if (!btv->curr.frame_irq) { 1694 btv->loop_irq |= 1; 1695 bttv_set_dma(btv, 0x03); 1696 } 1697 } 1698 1699 static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb) 1700 { 1701 struct bttv_buffer *buf = container_of(vb,struct bttv_buffer,vb); 1702 struct bttv_fh *fh = q->priv_data; 1703 1704 bttv_dma_free(q,fh->btv,buf); 1705 } 1706 1707 static struct videobuf_queue_ops bttv_video_qops = { 1708 .buf_setup = buffer_setup, 1709 .buf_prepare = buffer_prepare, 1710 .buf_queue = buffer_queue, 1711 .buf_release = buffer_release, 1712 }; 1713 1714 static void radio_enable(struct bttv *btv) 1715 { 1716 /* Switch to the radio tuner */ 1717 if (!btv->has_radio_tuner) { 1718 btv->has_radio_tuner = 1; 1719 bttv_call_all(btv, tuner, s_radio); 1720 btv->audio_input = TVAUDIO_INPUT_RADIO; 1721 audio_input(btv, btv->audio_input); 1722 } 1723 } 1724 1725 static int bttv_s_std(struct file *file, void *priv, v4l2_std_id id) 1726 { 1727 struct bttv_fh *fh = priv; 1728 struct bttv *btv = fh->btv; 1729 unsigned int i; 1730 int err = 0; 1731 1732 for (i = 0; i < BTTV_TVNORMS; i++) 1733 if (id & bttv_tvnorms[i].v4l2_id) 1734 break; 1735 if (i == BTTV_TVNORMS) { 1736 err = -EINVAL; 1737 goto err; 1738 } 1739 1740 btv->std = id; 1741 set_tvnorm(btv, i); 1742 1743 err: 1744 1745 return err; 1746 } 1747 1748 static int bttv_g_std(struct file *file, void *priv, v4l2_std_id *id) 1749 { 1750 struct bttv_fh *fh = priv; 1751 struct bttv *btv = fh->btv; 1752 1753 *id = btv->std; 1754 return 0; 1755 } 1756 1757 static int bttv_querystd(struct file *file, void *f, v4l2_std_id *id) 1758 { 1759 struct bttv_fh *fh = f; 1760 struct bttv *btv = fh->btv; 1761 1762 if (btread(BT848_DSTATUS) & BT848_DSTATUS_NUML) 1763 *id &= V4L2_STD_625_50; 1764 else 1765 *id &= V4L2_STD_525_60; 1766 return 0; 1767 } 1768 1769 static int bttv_enum_input(struct file *file, void *priv, 1770 struct v4l2_input *i) 1771 { 1772 struct bttv_fh *fh = priv; 1773 struct bttv *btv = fh->btv; 1774 int rc = 0; 1775 1776 if (i->index >= bttv_tvcards[btv->c.type].video_inputs) { 1777 rc = -EINVAL; 1778 goto err; 1779 } 1780 1781 i->type = V4L2_INPUT_TYPE_CAMERA; 1782 i->audioset = 0; 1783 1784 if (btv->tuner_type != TUNER_ABSENT && i->index == 0) { 1785 sprintf(i->name, "Television"); 1786 i->type = V4L2_INPUT_TYPE_TUNER; 1787 i->tuner = 0; 1788 } else if (i->index == btv->svhs) { 1789 sprintf(i->name, "S-Video"); 1790 } else { 1791 sprintf(i->name, "Composite%d", i->index); 1792 } 1793 1794 if (i->index == btv->input) { 1795 __u32 dstatus = btread(BT848_DSTATUS); 1796 if (0 == (dstatus & BT848_DSTATUS_PRES)) 1797 i->status |= V4L2_IN_ST_NO_SIGNAL; 1798 if (0 == (dstatus & BT848_DSTATUS_HLOC)) 1799 i->status |= V4L2_IN_ST_NO_H_LOCK; 1800 } 1801 1802 i->std = BTTV_NORMS; 1803 1804 err: 1805 1806 return rc; 1807 } 1808 1809 static int bttv_g_input(struct file *file, void *priv, unsigned int *i) 1810 { 1811 struct bttv_fh *fh = priv; 1812 struct bttv *btv = fh->btv; 1813 1814 *i = btv->input; 1815 1816 return 0; 1817 } 1818 1819 static int bttv_s_input(struct file *file, void *priv, unsigned int i) 1820 { 1821 struct bttv_fh *fh = priv; 1822 struct bttv *btv = fh->btv; 1823 1824 if (i >= bttv_tvcards[btv->c.type].video_inputs) 1825 return -EINVAL; 1826 1827 set_input(btv, i, btv->tvnorm); 1828 return 0; 1829 } 1830 1831 static int bttv_s_tuner(struct file *file, void *priv, 1832 const struct v4l2_tuner *t) 1833 { 1834 struct bttv_fh *fh = priv; 1835 struct bttv *btv = fh->btv; 1836 1837 if (t->index) 1838 return -EINVAL; 1839 1840 bttv_call_all(btv, tuner, s_tuner, t); 1841 1842 if (btv->audio_mode_gpio) { 1843 struct v4l2_tuner copy = *t; 1844 1845 btv->audio_mode_gpio(btv, ©, 1); 1846 } 1847 return 0; 1848 } 1849 1850 static int bttv_g_frequency(struct file *file, void *priv, 1851 struct v4l2_frequency *f) 1852 { 1853 struct bttv_fh *fh = priv; 1854 struct bttv *btv = fh->btv; 1855 1856 if (f->tuner) 1857 return -EINVAL; 1858 1859 if (f->type == V4L2_TUNER_RADIO) 1860 radio_enable(btv); 1861 f->frequency = f->type == V4L2_TUNER_RADIO ? 1862 btv->radio_freq : btv->tv_freq; 1863 1864 return 0; 1865 } 1866 1867 static void bttv_set_frequency(struct bttv *btv, const struct v4l2_frequency *f) 1868 { 1869 struct v4l2_frequency new_freq = *f; 1870 1871 bttv_call_all(btv, tuner, s_frequency, f); 1872 /* s_frequency may clamp the frequency, so get the actual 1873 frequency before assigning radio/tv_freq. */ 1874 bttv_call_all(btv, tuner, g_frequency, &new_freq); 1875 if (new_freq.type == V4L2_TUNER_RADIO) { 1876 radio_enable(btv); 1877 btv->radio_freq = new_freq.frequency; 1878 if (btv->has_matchbox) 1879 tea5757_set_freq(btv, btv->radio_freq); 1880 } else { 1881 btv->tv_freq = new_freq.frequency; 1882 } 1883 } 1884 1885 static int bttv_s_frequency(struct file *file, void *priv, 1886 const struct v4l2_frequency *f) 1887 { 1888 struct bttv_fh *fh = priv; 1889 struct bttv *btv = fh->btv; 1890 1891 if (f->tuner) 1892 return -EINVAL; 1893 1894 bttv_set_frequency(btv, f); 1895 return 0; 1896 } 1897 1898 static int bttv_log_status(struct file *file, void *f) 1899 { 1900 struct video_device *vdev = video_devdata(file); 1901 struct bttv_fh *fh = f; 1902 struct bttv *btv = fh->btv; 1903 1904 v4l2_ctrl_handler_log_status(vdev->ctrl_handler, btv->c.v4l2_dev.name); 1905 bttv_call_all(btv, core, log_status); 1906 return 0; 1907 } 1908 1909 #ifdef CONFIG_VIDEO_ADV_DEBUG 1910 static int bttv_g_register(struct file *file, void *f, 1911 struct v4l2_dbg_register *reg) 1912 { 1913 struct bttv_fh *fh = f; 1914 struct bttv *btv = fh->btv; 1915 1916 /* bt848 has a 12-bit register space */ 1917 reg->reg &= 0xfff; 1918 reg->val = btread(reg->reg); 1919 reg->size = 1; 1920 1921 return 0; 1922 } 1923 1924 static int bttv_s_register(struct file *file, void *f, 1925 const struct v4l2_dbg_register *reg) 1926 { 1927 struct bttv_fh *fh = f; 1928 struct bttv *btv = fh->btv; 1929 1930 /* bt848 has a 12-bit register space */ 1931 btwrite(reg->val, reg->reg & 0xfff); 1932 1933 return 0; 1934 } 1935 #endif 1936 1937 /* Given cropping boundaries b and the scaled width and height of a 1938 single field or frame, which must not exceed hardware limits, this 1939 function adjusts the cropping parameters c. */ 1940 static void 1941 bttv_crop_adjust (struct bttv_crop * c, 1942 const struct v4l2_rect * b, 1943 __s32 width, 1944 __s32 height, 1945 enum v4l2_field field) 1946 { 1947 __s32 frame_height = height << !V4L2_FIELD_HAS_BOTH(field); 1948 __s32 max_left; 1949 __s32 max_top; 1950 1951 if (width < c->min_scaled_width) { 1952 /* Max. hor. scale factor 16:1. */ 1953 c->rect.width = width * 16; 1954 } else if (width > c->max_scaled_width) { 1955 /* Min. hor. scale factor 1:1. */ 1956 c->rect.width = width; 1957 1958 max_left = b->left + b->width - width; 1959 max_left = min(max_left, (__s32) MAX_HDELAY); 1960 if (c->rect.left > max_left) 1961 c->rect.left = max_left; 1962 } 1963 1964 if (height < c->min_scaled_height) { 1965 /* Max. vert. scale factor 16:1, single fields 8:1. */ 1966 c->rect.height = height * 16; 1967 } else if (frame_height > c->max_scaled_height) { 1968 /* Min. vert. scale factor 1:1. 1969 Top and height count field lines times two. */ 1970 c->rect.height = (frame_height + 1) & ~1; 1971 1972 max_top = b->top + b->height - c->rect.height; 1973 if (c->rect.top > max_top) 1974 c->rect.top = max_top; 1975 } 1976 1977 bttv_crop_calc_limits(c); 1978 } 1979 1980 /* Returns an error if scaling to a frame or single field with the given 1981 width and height is not possible with the current cropping parameters 1982 and width aligned according to width_mask. If adjust_size is TRUE the 1983 function may adjust the width and/or height instead, rounding width 1984 to (width + width_bias) & width_mask. If adjust_crop is TRUE it may 1985 also adjust the current cropping parameters to get closer to the 1986 desired image size. */ 1987 static int 1988 limit_scaled_size_lock (struct bttv_fh * fh, 1989 __s32 * width, 1990 __s32 * height, 1991 enum v4l2_field field, 1992 unsigned int width_mask, 1993 unsigned int width_bias, 1994 int adjust_size, 1995 int adjust_crop) 1996 { 1997 struct bttv *btv = fh->btv; 1998 const struct v4l2_rect *b; 1999 struct bttv_crop *c; 2000 __s32 min_width; 2001 __s32 min_height; 2002 __s32 max_width; 2003 __s32 max_height; 2004 int rc; 2005 2006 BUG_ON((int) width_mask >= 0 || 2007 width_bias >= (unsigned int) -width_mask); 2008 2009 /* Make sure tvnorm, vbi_end and the current cropping parameters 2010 remain consistent until we're done. */ 2011 2012 b = &bttv_tvnorms[btv->tvnorm].cropcap.bounds; 2013 2014 /* Do crop - use current, don't - use default parameters. */ 2015 c = &btv->crop[!!fh->do_crop]; 2016 2017 if (fh->do_crop 2018 && adjust_size 2019 && adjust_crop 2020 && !locked_btres(btv, VIDEO_RESOURCES)) { 2021 min_width = 48; 2022 min_height = 32; 2023 2024 /* We cannot scale up. When the scaled image is larger 2025 than crop.rect we adjust the crop.rect as required 2026 by the V4L2 spec, hence cropcap.bounds are our limit. */ 2027 max_width = min(b->width, (__s32) MAX_HACTIVE); 2028 max_height = b->height; 2029 2030 /* We cannot capture the same line as video and VBI data. 2031 Note btv->vbi_end is really a minimum, see 2032 bttv_vbi_try_fmt(). */ 2033 if (btv->vbi_end > b->top) { 2034 max_height -= btv->vbi_end - b->top; 2035 rc = -EBUSY; 2036 if (min_height > max_height) 2037 goto fail; 2038 } 2039 } else { 2040 rc = -EBUSY; 2041 if (btv->vbi_end > c->rect.top) 2042 goto fail; 2043 2044 min_width = c->min_scaled_width; 2045 min_height = c->min_scaled_height; 2046 max_width = c->max_scaled_width; 2047 max_height = c->max_scaled_height; 2048 2049 adjust_crop = 0; 2050 } 2051 2052 min_width = (min_width - width_mask - 1) & width_mask; 2053 max_width = max_width & width_mask; 2054 2055 /* Max. scale factor is 16:1 for frames, 8:1 for fields. */ 2056 min_height = min_height; 2057 /* Min. scale factor is 1:1. */ 2058 max_height >>= !V4L2_FIELD_HAS_BOTH(field); 2059 2060 if (adjust_size) { 2061 *width = clamp(*width, min_width, max_width); 2062 *height = clamp(*height, min_height, max_height); 2063 2064 /* Round after clamping to avoid overflow. */ 2065 *width = (*width + width_bias) & width_mask; 2066 2067 if (adjust_crop) { 2068 bttv_crop_adjust(c, b, *width, *height, field); 2069 2070 if (btv->vbi_end > c->rect.top) { 2071 /* Move the crop window out of the way. */ 2072 c->rect.top = btv->vbi_end; 2073 } 2074 } 2075 } else { 2076 rc = -EINVAL; 2077 if (*width < min_width || 2078 *height < min_height || 2079 *width > max_width || 2080 *height > max_height || 2081 0 != (*width & ~width_mask)) 2082 goto fail; 2083 } 2084 2085 rc = 0; /* success */ 2086 2087 fail: 2088 2089 return rc; 2090 } 2091 2092 /* Returns an error if the given overlay window dimensions are not 2093 possible with the current cropping parameters. If adjust_size is 2094 TRUE the function may adjust the window width and/or height 2095 instead, however it always rounds the horizontal position and 2096 width as btcx_align() does. If adjust_crop is TRUE the function 2097 may also adjust the current cropping parameters to get closer 2098 to the desired window size. */ 2099 static int 2100 verify_window_lock(struct bttv_fh *fh, struct v4l2_window *win, 2101 int adjust_size, int adjust_crop) 2102 { 2103 enum v4l2_field field; 2104 unsigned int width_mask; 2105 int rc; 2106 2107 if (win->w.width < 48) 2108 win->w.width = 48; 2109 if (win->w.height < 32) 2110 win->w.height = 32; 2111 if (win->clipcount > 2048) 2112 win->clipcount = 2048; 2113 2114 win->chromakey = 0; 2115 win->global_alpha = 0; 2116 field = win->field; 2117 2118 switch (field) { 2119 case V4L2_FIELD_TOP: 2120 case V4L2_FIELD_BOTTOM: 2121 case V4L2_FIELD_INTERLACED: 2122 break; 2123 default: 2124 field = V4L2_FIELD_ANY; 2125 break; 2126 } 2127 if (V4L2_FIELD_ANY == field) { 2128 __s32 height2; 2129 2130 height2 = fh->btv->crop[!!fh->do_crop].rect.height >> 1; 2131 field = (win->w.height > height2) 2132 ? V4L2_FIELD_INTERLACED 2133 : V4L2_FIELD_TOP; 2134 } 2135 win->field = field; 2136 2137 if (NULL == fh->ovfmt) 2138 return -EINVAL; 2139 /* 4-byte alignment. */ 2140 width_mask = ~0; 2141 switch (fh->ovfmt->depth) { 2142 case 8: 2143 case 24: 2144 width_mask = ~3; 2145 break; 2146 case 16: 2147 width_mask = ~1; 2148 break; 2149 case 32: 2150 break; 2151 default: 2152 BUG(); 2153 } 2154 2155 win->w.width -= win->w.left & ~width_mask; 2156 win->w.left = (win->w.left - width_mask - 1) & width_mask; 2157 2158 rc = limit_scaled_size_lock(fh, &win->w.width, &win->w.height, 2159 field, width_mask, 2160 /* width_bias: round down */ 0, 2161 adjust_size, adjust_crop); 2162 if (0 != rc) 2163 return rc; 2164 return 0; 2165 } 2166 2167 static int setup_window_lock(struct bttv_fh *fh, struct bttv *btv, 2168 struct v4l2_window *win, int fixup) 2169 { 2170 struct v4l2_clip *clips = NULL; 2171 int n,size,retval = 0; 2172 2173 if (NULL == fh->ovfmt) 2174 return -EINVAL; 2175 if (!(fh->ovfmt->flags & FORMAT_FLAGS_PACKED)) 2176 return -EINVAL; 2177 retval = verify_window_lock(fh, win, 2178 /* adjust_size */ fixup, 2179 /* adjust_crop */ fixup); 2180 if (0 != retval) 2181 return retval; 2182 2183 /* copy clips -- luckily v4l1 + v4l2 are binary 2184 compatible here ...*/ 2185 n = win->clipcount; 2186 size = sizeof(*clips)*(n+4); 2187 clips = kmalloc(size,GFP_KERNEL); 2188 if (NULL == clips) 2189 return -ENOMEM; 2190 if (n > 0) { 2191 if (copy_from_user(clips,win->clips,sizeof(struct v4l2_clip)*n)) { 2192 kfree(clips); 2193 return -EFAULT; 2194 } 2195 } 2196 2197 /* clip against screen */ 2198 if (NULL != btv->fbuf.base) 2199 n = btcx_screen_clips(btv->fbuf.fmt.width, btv->fbuf.fmt.height, 2200 &win->w, clips, n); 2201 btcx_sort_clips(clips,n); 2202 2203 /* 4-byte alignments */ 2204 switch (fh->ovfmt->depth) { 2205 case 8: 2206 case 24: 2207 btcx_align(&win->w, clips, n, 3); 2208 break; 2209 case 16: 2210 btcx_align(&win->w, clips, n, 1); 2211 break; 2212 case 32: 2213 /* no alignment fixups needed */ 2214 break; 2215 default: 2216 BUG(); 2217 } 2218 2219 kfree(fh->ov.clips); 2220 fh->ov.clips = clips; 2221 fh->ov.nclips = n; 2222 2223 fh->ov.w = win->w; 2224 fh->ov.field = win->field; 2225 fh->ov.setup_ok = 1; 2226 2227 btv->init.ov.w.width = win->w.width; 2228 btv->init.ov.w.height = win->w.height; 2229 btv->init.ov.field = win->field; 2230 2231 /* update overlay if needed */ 2232 retval = 0; 2233 if (check_btres(fh, RESOURCE_OVERLAY)) { 2234 struct bttv_buffer *new; 2235 2236 new = videobuf_sg_alloc(sizeof(*new)); 2237 new->crop = btv->crop[!!fh->do_crop].rect; 2238 bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new); 2239 retval = bttv_switch_overlay(btv,fh,new); 2240 } 2241 return retval; 2242 } 2243 2244 /* ----------------------------------------------------------------------- */ 2245 2246 static struct videobuf_queue* bttv_queue(struct bttv_fh *fh) 2247 { 2248 struct videobuf_queue* q = NULL; 2249 2250 switch (fh->type) { 2251 case V4L2_BUF_TYPE_VIDEO_CAPTURE: 2252 q = &fh->cap; 2253 break; 2254 case V4L2_BUF_TYPE_VBI_CAPTURE: 2255 q = &fh->vbi; 2256 break; 2257 default: 2258 BUG(); 2259 } 2260 return q; 2261 } 2262 2263 static int bttv_resource(struct bttv_fh *fh) 2264 { 2265 int res = 0; 2266 2267 switch (fh->type) { 2268 case V4L2_BUF_TYPE_VIDEO_CAPTURE: 2269 res = RESOURCE_VIDEO_STREAM; 2270 break; 2271 case V4L2_BUF_TYPE_VBI_CAPTURE: 2272 res = RESOURCE_VBI; 2273 break; 2274 default: 2275 BUG(); 2276 } 2277 return res; 2278 } 2279 2280 static int bttv_switch_type(struct bttv_fh *fh, enum v4l2_buf_type type) 2281 { 2282 struct videobuf_queue *q = bttv_queue(fh); 2283 int res = bttv_resource(fh); 2284 2285 if (check_btres(fh,res)) 2286 return -EBUSY; 2287 if (videobuf_queue_is_busy(q)) 2288 return -EBUSY; 2289 fh->type = type; 2290 return 0; 2291 } 2292 2293 static void 2294 pix_format_set_size (struct v4l2_pix_format * f, 2295 const struct bttv_format * fmt, 2296 unsigned int width, 2297 unsigned int height) 2298 { 2299 f->width = width; 2300 f->height = height; 2301 2302 if (fmt->flags & FORMAT_FLAGS_PLANAR) { 2303 f->bytesperline = width; /* Y plane */ 2304 f->sizeimage = (width * height * fmt->depth) >> 3; 2305 } else { 2306 f->bytesperline = (width * fmt->depth) >> 3; 2307 f->sizeimage = height * f->bytesperline; 2308 } 2309 } 2310 2311 static int bttv_g_fmt_vid_cap(struct file *file, void *priv, 2312 struct v4l2_format *f) 2313 { 2314 struct bttv_fh *fh = priv; 2315 2316 pix_format_set_size(&f->fmt.pix, fh->fmt, 2317 fh->width, fh->height); 2318 f->fmt.pix.field = fh->cap.field; 2319 f->fmt.pix.pixelformat = fh->fmt->fourcc; 2320 f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 2321 2322 return 0; 2323 } 2324 2325 static int bttv_g_fmt_vid_overlay(struct file *file, void *priv, 2326 struct v4l2_format *f) 2327 { 2328 struct bttv_fh *fh = priv; 2329 2330 f->fmt.win.w = fh->ov.w; 2331 f->fmt.win.field = fh->ov.field; 2332 2333 return 0; 2334 } 2335 2336 static int bttv_try_fmt_vid_cap(struct file *file, void *priv, 2337 struct v4l2_format *f) 2338 { 2339 const struct bttv_format *fmt; 2340 struct bttv_fh *fh = priv; 2341 struct bttv *btv = fh->btv; 2342 enum v4l2_field field; 2343 __s32 width, height; 2344 __s32 height2; 2345 int rc; 2346 2347 fmt = format_by_fourcc(f->fmt.pix.pixelformat); 2348 if (NULL == fmt) 2349 return -EINVAL; 2350 2351 field = f->fmt.pix.field; 2352 2353 switch (field) { 2354 case V4L2_FIELD_TOP: 2355 case V4L2_FIELD_BOTTOM: 2356 case V4L2_FIELD_ALTERNATE: 2357 case V4L2_FIELD_INTERLACED: 2358 break; 2359 case V4L2_FIELD_SEQ_BT: 2360 case V4L2_FIELD_SEQ_TB: 2361 if (!(fmt->flags & FORMAT_FLAGS_PLANAR)) { 2362 field = V4L2_FIELD_SEQ_TB; 2363 break; 2364 } 2365 /* fall through */ 2366 default: /* FIELD_ANY case */ 2367 height2 = btv->crop[!!fh->do_crop].rect.height >> 1; 2368 field = (f->fmt.pix.height > height2) 2369 ? V4L2_FIELD_INTERLACED 2370 : V4L2_FIELD_BOTTOM; 2371 break; 2372 } 2373 2374 width = f->fmt.pix.width; 2375 height = f->fmt.pix.height; 2376 2377 rc = limit_scaled_size_lock(fh, &width, &height, field, 2378 /* width_mask: 4 pixels */ ~3, 2379 /* width_bias: nearest */ 2, 2380 /* adjust_size */ 1, 2381 /* adjust_crop */ 0); 2382 if (0 != rc) 2383 return rc; 2384 2385 /* update data for the application */ 2386 f->fmt.pix.field = field; 2387 pix_format_set_size(&f->fmt.pix, fmt, width, height); 2388 f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 2389 2390 return 0; 2391 } 2392 2393 static int bttv_try_fmt_vid_overlay(struct file *file, void *priv, 2394 struct v4l2_format *f) 2395 { 2396 struct bttv_fh *fh = priv; 2397 2398 verify_window_lock(fh, &f->fmt.win, 2399 /* adjust_size */ 1, 2400 /* adjust_crop */ 0); 2401 return 0; 2402 } 2403 2404 static int bttv_s_fmt_vid_cap(struct file *file, void *priv, 2405 struct v4l2_format *f) 2406 { 2407 int retval; 2408 const struct bttv_format *fmt; 2409 struct bttv_fh *fh = priv; 2410 struct bttv *btv = fh->btv; 2411 __s32 width, height; 2412 enum v4l2_field field; 2413 2414 retval = bttv_switch_type(fh, f->type); 2415 if (0 != retval) 2416 return retval; 2417 2418 retval = bttv_try_fmt_vid_cap(file, priv, f); 2419 if (0 != retval) 2420 return retval; 2421 2422 width = f->fmt.pix.width; 2423 height = f->fmt.pix.height; 2424 field = f->fmt.pix.field; 2425 2426 retval = limit_scaled_size_lock(fh, &width, &height, f->fmt.pix.field, 2427 /* width_mask: 4 pixels */ ~3, 2428 /* width_bias: nearest */ 2, 2429 /* adjust_size */ 1, 2430 /* adjust_crop */ 1); 2431 if (0 != retval) 2432 return retval; 2433 2434 f->fmt.pix.field = field; 2435 2436 fmt = format_by_fourcc(f->fmt.pix.pixelformat); 2437 2438 /* update our state informations */ 2439 fh->fmt = fmt; 2440 fh->cap.field = f->fmt.pix.field; 2441 fh->cap.last = V4L2_FIELD_NONE; 2442 fh->width = f->fmt.pix.width; 2443 fh->height = f->fmt.pix.height; 2444 btv->init.fmt = fmt; 2445 btv->init.width = f->fmt.pix.width; 2446 btv->init.height = f->fmt.pix.height; 2447 2448 return 0; 2449 } 2450 2451 static int bttv_s_fmt_vid_overlay(struct file *file, void *priv, 2452 struct v4l2_format *f) 2453 { 2454 struct bttv_fh *fh = priv; 2455 struct bttv *btv = fh->btv; 2456 2457 if (no_overlay > 0) { 2458 pr_err("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n"); 2459 return -EINVAL; 2460 } 2461 2462 return setup_window_lock(fh, btv, &f->fmt.win, 1); 2463 } 2464 2465 static int bttv_querycap(struct file *file, void *priv, 2466 struct v4l2_capability *cap) 2467 { 2468 struct video_device *vdev = video_devdata(file); 2469 struct bttv_fh *fh = priv; 2470 struct bttv *btv = fh->btv; 2471 2472 if (0 == v4l2) 2473 return -EINVAL; 2474 2475 strlcpy(cap->driver, "bttv", sizeof(cap->driver)); 2476 strlcpy(cap->card, btv->video_dev->name, sizeof(cap->card)); 2477 snprintf(cap->bus_info, sizeof(cap->bus_info), 2478 "PCI:%s", pci_name(btv->c.pci)); 2479 cap->capabilities = 2480 V4L2_CAP_VIDEO_CAPTURE | 2481 V4L2_CAP_READWRITE | 2482 V4L2_CAP_STREAMING | 2483 V4L2_CAP_DEVICE_CAPS; 2484 if (no_overlay <= 0) 2485 cap->capabilities |= V4L2_CAP_VIDEO_OVERLAY; 2486 if (btv->vbi_dev) 2487 cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 2488 if (btv->radio_dev) 2489 cap->capabilities |= V4L2_CAP_RADIO; 2490 2491 /* 2492 * No need to lock here: those vars are initialized during board 2493 * probe and remains untouched during the rest of the driver lifecycle 2494 */ 2495 if (btv->has_saa6588) 2496 cap->capabilities |= V4L2_CAP_RDS_CAPTURE; 2497 if (btv->tuner_type != TUNER_ABSENT) 2498 cap->capabilities |= V4L2_CAP_TUNER; 2499 if (vdev->vfl_type == VFL_TYPE_GRABBER) 2500 cap->device_caps = cap->capabilities & 2501 (V4L2_CAP_VIDEO_CAPTURE | 2502 V4L2_CAP_READWRITE | 2503 V4L2_CAP_STREAMING | 2504 V4L2_CAP_VIDEO_OVERLAY | 2505 V4L2_CAP_TUNER); 2506 else if (vdev->vfl_type == VFL_TYPE_VBI) 2507 cap->device_caps = cap->capabilities & 2508 (V4L2_CAP_VBI_CAPTURE | 2509 V4L2_CAP_READWRITE | 2510 V4L2_CAP_STREAMING | 2511 V4L2_CAP_TUNER); 2512 else { 2513 cap->device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER; 2514 if (btv->has_saa6588) 2515 cap->device_caps |= V4L2_CAP_READWRITE | 2516 V4L2_CAP_RDS_CAPTURE; 2517 } 2518 return 0; 2519 } 2520 2521 static int bttv_enum_fmt_cap_ovr(struct v4l2_fmtdesc *f) 2522 { 2523 int index = -1, i; 2524 2525 for (i = 0; i < FORMATS; i++) { 2526 if (formats[i].fourcc != -1) 2527 index++; 2528 if ((unsigned int)index == f->index) 2529 break; 2530 } 2531 if (FORMATS == i) 2532 return -EINVAL; 2533 2534 f->pixelformat = formats[i].fourcc; 2535 strlcpy(f->description, formats[i].name, sizeof(f->description)); 2536 2537 return i; 2538 } 2539 2540 static int bttv_enum_fmt_vid_cap(struct file *file, void *priv, 2541 struct v4l2_fmtdesc *f) 2542 { 2543 int rc = bttv_enum_fmt_cap_ovr(f); 2544 2545 if (rc < 0) 2546 return rc; 2547 2548 return 0; 2549 } 2550 2551 static int bttv_enum_fmt_vid_overlay(struct file *file, void *priv, 2552 struct v4l2_fmtdesc *f) 2553 { 2554 int rc; 2555 2556 if (no_overlay > 0) { 2557 pr_err("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n"); 2558 return -EINVAL; 2559 } 2560 2561 rc = bttv_enum_fmt_cap_ovr(f); 2562 2563 if (rc < 0) 2564 return rc; 2565 2566 if (!(formats[rc].flags & FORMAT_FLAGS_PACKED)) 2567 return -EINVAL; 2568 2569 return 0; 2570 } 2571 2572 static int bttv_g_fbuf(struct file *file, void *f, 2573 struct v4l2_framebuffer *fb) 2574 { 2575 struct bttv_fh *fh = f; 2576 struct bttv *btv = fh->btv; 2577 2578 *fb = btv->fbuf; 2579 fb->capability = V4L2_FBUF_CAP_LIST_CLIPPING; 2580 fb->flags = V4L2_FBUF_FLAG_PRIMARY; 2581 if (fh->ovfmt) 2582 fb->fmt.pixelformat = fh->ovfmt->fourcc; 2583 return 0; 2584 } 2585 2586 static int bttv_overlay(struct file *file, void *f, unsigned int on) 2587 { 2588 struct bttv_fh *fh = f; 2589 struct bttv *btv = fh->btv; 2590 struct bttv_buffer *new; 2591 int retval = 0; 2592 2593 if (on) { 2594 /* verify args */ 2595 if (unlikely(!btv->fbuf.base)) { 2596 return -EINVAL; 2597 } 2598 if (unlikely(!fh->ov.setup_ok)) { 2599 dprintk("%d: overlay: !setup_ok\n", btv->c.nr); 2600 retval = -EINVAL; 2601 } 2602 if (retval) 2603 return retval; 2604 } 2605 2606 if (!check_alloc_btres_lock(btv, fh, RESOURCE_OVERLAY)) 2607 return -EBUSY; 2608 2609 if (on) { 2610 fh->ov.tvnorm = btv->tvnorm; 2611 new = videobuf_sg_alloc(sizeof(*new)); 2612 new->crop = btv->crop[!!fh->do_crop].rect; 2613 bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new); 2614 } else { 2615 new = NULL; 2616 } 2617 2618 /* switch over */ 2619 retval = bttv_switch_overlay(btv, fh, new); 2620 return retval; 2621 } 2622 2623 static int bttv_s_fbuf(struct file *file, void *f, 2624 const struct v4l2_framebuffer *fb) 2625 { 2626 struct bttv_fh *fh = f; 2627 struct bttv *btv = fh->btv; 2628 const struct bttv_format *fmt; 2629 int retval; 2630 2631 if (!capable(CAP_SYS_ADMIN) && 2632 !capable(CAP_SYS_RAWIO)) 2633 return -EPERM; 2634 2635 /* check args */ 2636 fmt = format_by_fourcc(fb->fmt.pixelformat); 2637 if (NULL == fmt) 2638 return -EINVAL; 2639 if (0 == (fmt->flags & FORMAT_FLAGS_PACKED)) 2640 return -EINVAL; 2641 2642 retval = -EINVAL; 2643 if (fb->flags & V4L2_FBUF_FLAG_OVERLAY) { 2644 __s32 width = fb->fmt.width; 2645 __s32 height = fb->fmt.height; 2646 2647 retval = limit_scaled_size_lock(fh, &width, &height, 2648 V4L2_FIELD_INTERLACED, 2649 /* width_mask */ ~3, 2650 /* width_bias */ 2, 2651 /* adjust_size */ 0, 2652 /* adjust_crop */ 0); 2653 if (0 != retval) 2654 return retval; 2655 } 2656 2657 /* ok, accept it */ 2658 btv->fbuf.base = fb->base; 2659 btv->fbuf.fmt.width = fb->fmt.width; 2660 btv->fbuf.fmt.height = fb->fmt.height; 2661 if (0 != fb->fmt.bytesperline) 2662 btv->fbuf.fmt.bytesperline = fb->fmt.bytesperline; 2663 else 2664 btv->fbuf.fmt.bytesperline = btv->fbuf.fmt.width*fmt->depth/8; 2665 2666 retval = 0; 2667 fh->ovfmt = fmt; 2668 btv->init.ovfmt = fmt; 2669 if (fb->flags & V4L2_FBUF_FLAG_OVERLAY) { 2670 fh->ov.w.left = 0; 2671 fh->ov.w.top = 0; 2672 fh->ov.w.width = fb->fmt.width; 2673 fh->ov.w.height = fb->fmt.height; 2674 btv->init.ov.w.width = fb->fmt.width; 2675 btv->init.ov.w.height = fb->fmt.height; 2676 kfree(fh->ov.clips); 2677 fh->ov.clips = NULL; 2678 fh->ov.nclips = 0; 2679 2680 if (check_btres(fh, RESOURCE_OVERLAY)) { 2681 struct bttv_buffer *new; 2682 2683 new = videobuf_sg_alloc(sizeof(*new)); 2684 new->crop = btv->crop[!!fh->do_crop].rect; 2685 bttv_overlay_risc(btv, &fh->ov, fh->ovfmt, new); 2686 retval = bttv_switch_overlay(btv, fh, new); 2687 } 2688 } 2689 return retval; 2690 } 2691 2692 static int bttv_reqbufs(struct file *file, void *priv, 2693 struct v4l2_requestbuffers *p) 2694 { 2695 struct bttv_fh *fh = priv; 2696 return videobuf_reqbufs(bttv_queue(fh), p); 2697 } 2698 2699 static int bttv_querybuf(struct file *file, void *priv, 2700 struct v4l2_buffer *b) 2701 { 2702 struct bttv_fh *fh = priv; 2703 return videobuf_querybuf(bttv_queue(fh), b); 2704 } 2705 2706 static int bttv_qbuf(struct file *file, void *priv, struct v4l2_buffer *b) 2707 { 2708 struct bttv_fh *fh = priv; 2709 struct bttv *btv = fh->btv; 2710 int res = bttv_resource(fh); 2711 2712 if (!check_alloc_btres_lock(btv, fh, res)) 2713 return -EBUSY; 2714 2715 return videobuf_qbuf(bttv_queue(fh), b); 2716 } 2717 2718 static int bttv_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b) 2719 { 2720 struct bttv_fh *fh = priv; 2721 return videobuf_dqbuf(bttv_queue(fh), b, 2722 file->f_flags & O_NONBLOCK); 2723 } 2724 2725 static int bttv_streamon(struct file *file, void *priv, 2726 enum v4l2_buf_type type) 2727 { 2728 struct bttv_fh *fh = priv; 2729 struct bttv *btv = fh->btv; 2730 int res = bttv_resource(fh); 2731 2732 if (!check_alloc_btres_lock(btv, fh, res)) 2733 return -EBUSY; 2734 return videobuf_streamon(bttv_queue(fh)); 2735 } 2736 2737 2738 static int bttv_streamoff(struct file *file, void *priv, 2739 enum v4l2_buf_type type) 2740 { 2741 struct bttv_fh *fh = priv; 2742 struct bttv *btv = fh->btv; 2743 int retval; 2744 int res = bttv_resource(fh); 2745 2746 2747 retval = videobuf_streamoff(bttv_queue(fh)); 2748 if (retval < 0) 2749 return retval; 2750 free_btres_lock(btv, fh, res); 2751 return 0; 2752 } 2753 2754 static int bttv_g_parm(struct file *file, void *f, 2755 struct v4l2_streamparm *parm) 2756 { 2757 struct bttv_fh *fh = f; 2758 struct bttv *btv = fh->btv; 2759 2760 if (parm->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 2761 return -EINVAL; 2762 parm->parm.capture.readbuffers = gbuffers; 2763 v4l2_video_std_frame_period(bttv_tvnorms[btv->tvnorm].v4l2_id, 2764 &parm->parm.capture.timeperframe); 2765 2766 return 0; 2767 } 2768 2769 static int bttv_g_tuner(struct file *file, void *priv, 2770 struct v4l2_tuner *t) 2771 { 2772 struct bttv_fh *fh = priv; 2773 struct bttv *btv = fh->btv; 2774 2775 if (0 != t->index) 2776 return -EINVAL; 2777 2778 t->rxsubchans = V4L2_TUNER_SUB_MONO; 2779 t->capability = V4L2_TUNER_CAP_NORM; 2780 bttv_call_all(btv, tuner, g_tuner, t); 2781 strcpy(t->name, "Television"); 2782 t->type = V4L2_TUNER_ANALOG_TV; 2783 if (btread(BT848_DSTATUS)&BT848_DSTATUS_HLOC) 2784 t->signal = 0xffff; 2785 2786 if (btv->audio_mode_gpio) 2787 btv->audio_mode_gpio(btv, t, 0); 2788 2789 return 0; 2790 } 2791 2792 static int bttv_cropcap(struct file *file, void *priv, 2793 struct v4l2_cropcap *cap) 2794 { 2795 struct bttv_fh *fh = priv; 2796 struct bttv *btv = fh->btv; 2797 2798 if (cap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 2799 cap->type != V4L2_BUF_TYPE_VIDEO_OVERLAY) 2800 return -EINVAL; 2801 2802 *cap = bttv_tvnorms[btv->tvnorm].cropcap; 2803 2804 return 0; 2805 } 2806 2807 static int bttv_g_crop(struct file *file, void *f, struct v4l2_crop *crop) 2808 { 2809 struct bttv_fh *fh = f; 2810 struct bttv *btv = fh->btv; 2811 2812 if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 2813 crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY) 2814 return -EINVAL; 2815 2816 /* No fh->do_crop = 1; because btv->crop[1] may be 2817 inconsistent with fh->width or fh->height and apps 2818 do not expect a change here. */ 2819 2820 crop->c = btv->crop[!!fh->do_crop].rect; 2821 2822 return 0; 2823 } 2824 2825 static int bttv_s_crop(struct file *file, void *f, const struct v4l2_crop *crop) 2826 { 2827 struct bttv_fh *fh = f; 2828 struct bttv *btv = fh->btv; 2829 const struct v4l2_rect *b; 2830 int retval; 2831 struct bttv_crop c; 2832 __s32 b_left; 2833 __s32 b_top; 2834 __s32 b_right; 2835 __s32 b_bottom; 2836 2837 if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 2838 crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY) 2839 return -EINVAL; 2840 2841 /* Make sure tvnorm, vbi_end and the current cropping 2842 parameters remain consistent until we're done. Note 2843 read() may change vbi_end in check_alloc_btres_lock(). */ 2844 retval = -EBUSY; 2845 2846 if (locked_btres(fh->btv, VIDEO_RESOURCES)) { 2847 return retval; 2848 } 2849 2850 b = &bttv_tvnorms[btv->tvnorm].cropcap.bounds; 2851 2852 b_left = b->left; 2853 b_right = b_left + b->width; 2854 b_bottom = b->top + b->height; 2855 2856 b_top = max(b->top, btv->vbi_end); 2857 if (b_top + 32 >= b_bottom) { 2858 return retval; 2859 } 2860 2861 /* Min. scaled size 48 x 32. */ 2862 c.rect.left = clamp_t(s32, crop->c.left, b_left, b_right - 48); 2863 c.rect.left = min(c.rect.left, (__s32) MAX_HDELAY); 2864 2865 c.rect.width = clamp_t(s32, crop->c.width, 2866 48, b_right - c.rect.left); 2867 2868 c.rect.top = clamp_t(s32, crop->c.top, b_top, b_bottom - 32); 2869 /* Top and height must be a multiple of two. */ 2870 c.rect.top = (c.rect.top + 1) & ~1; 2871 2872 c.rect.height = clamp_t(s32, crop->c.height, 2873 32, b_bottom - c.rect.top); 2874 c.rect.height = (c.rect.height + 1) & ~1; 2875 2876 bttv_crop_calc_limits(&c); 2877 2878 btv->crop[1] = c; 2879 2880 fh->do_crop = 1; 2881 2882 if (fh->width < c.min_scaled_width) { 2883 fh->width = c.min_scaled_width; 2884 btv->init.width = c.min_scaled_width; 2885 } else if (fh->width > c.max_scaled_width) { 2886 fh->width = c.max_scaled_width; 2887 btv->init.width = c.max_scaled_width; 2888 } 2889 2890 if (fh->height < c.min_scaled_height) { 2891 fh->height = c.min_scaled_height; 2892 btv->init.height = c.min_scaled_height; 2893 } else if (fh->height > c.max_scaled_height) { 2894 fh->height = c.max_scaled_height; 2895 btv->init.height = c.max_scaled_height; 2896 } 2897 2898 return 0; 2899 } 2900 2901 static ssize_t bttv_read(struct file *file, char __user *data, 2902 size_t count, loff_t *ppos) 2903 { 2904 struct bttv_fh *fh = file->private_data; 2905 int retval = 0; 2906 2907 if (fh->btv->errors) 2908 bttv_reinit_bt848(fh->btv); 2909 dprintk("%d: read count=%d type=%s\n", 2910 fh->btv->c.nr, (int)count, v4l2_type_names[fh->type]); 2911 2912 switch (fh->type) { 2913 case V4L2_BUF_TYPE_VIDEO_CAPTURE: 2914 if (!check_alloc_btres_lock(fh->btv, fh, RESOURCE_VIDEO_READ)) { 2915 /* VIDEO_READ in use by another fh, 2916 or VIDEO_STREAM by any fh. */ 2917 return -EBUSY; 2918 } 2919 retval = videobuf_read_one(&fh->cap, data, count, ppos, 2920 file->f_flags & O_NONBLOCK); 2921 free_btres_lock(fh->btv, fh, RESOURCE_VIDEO_READ); 2922 break; 2923 case V4L2_BUF_TYPE_VBI_CAPTURE: 2924 if (!check_alloc_btres_lock(fh->btv,fh,RESOURCE_VBI)) 2925 return -EBUSY; 2926 retval = videobuf_read_stream(&fh->vbi, data, count, ppos, 1, 2927 file->f_flags & O_NONBLOCK); 2928 break; 2929 default: 2930 BUG(); 2931 } 2932 return retval; 2933 } 2934 2935 static unsigned int bttv_poll(struct file *file, poll_table *wait) 2936 { 2937 struct bttv_fh *fh = file->private_data; 2938 struct bttv_buffer *buf; 2939 enum v4l2_field field; 2940 unsigned int rc = 0; 2941 unsigned long req_events = poll_requested_events(wait); 2942 2943 if (v4l2_event_pending(&fh->fh)) 2944 rc = POLLPRI; 2945 else if (req_events & POLLPRI) 2946 poll_wait(file, &fh->fh.wait, wait); 2947 2948 if (!(req_events & (POLLIN | POLLRDNORM))) 2949 return rc; 2950 2951 if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type) { 2952 if (!check_alloc_btres_lock(fh->btv,fh,RESOURCE_VBI)) 2953 return rc | POLLERR; 2954 return rc | videobuf_poll_stream(file, &fh->vbi, wait); 2955 } 2956 2957 if (check_btres(fh,RESOURCE_VIDEO_STREAM)) { 2958 /* streaming capture */ 2959 if (list_empty(&fh->cap.stream)) 2960 return rc | POLLERR; 2961 buf = list_entry(fh->cap.stream.next,struct bttv_buffer,vb.stream); 2962 } else { 2963 /* read() capture */ 2964 if (NULL == fh->cap.read_buf) { 2965 /* need to capture a new frame */ 2966 if (locked_btres(fh->btv,RESOURCE_VIDEO_STREAM)) 2967 return rc | POLLERR; 2968 fh->cap.read_buf = videobuf_sg_alloc(fh->cap.msize); 2969 if (NULL == fh->cap.read_buf) 2970 return rc | POLLERR; 2971 fh->cap.read_buf->memory = V4L2_MEMORY_USERPTR; 2972 field = videobuf_next_field(&fh->cap); 2973 if (0 != fh->cap.ops->buf_prepare(&fh->cap,fh->cap.read_buf,field)) { 2974 kfree (fh->cap.read_buf); 2975 fh->cap.read_buf = NULL; 2976 return rc | POLLERR; 2977 } 2978 fh->cap.ops->buf_queue(&fh->cap,fh->cap.read_buf); 2979 fh->cap.read_off = 0; 2980 } 2981 buf = (struct bttv_buffer*)fh->cap.read_buf; 2982 } 2983 2984 poll_wait(file, &buf->vb.done, wait); 2985 if (buf->vb.state == VIDEOBUF_DONE || 2986 buf->vb.state == VIDEOBUF_ERROR) 2987 rc = rc | POLLIN|POLLRDNORM; 2988 return rc; 2989 } 2990 2991 static int bttv_open(struct file *file) 2992 { 2993 struct video_device *vdev = video_devdata(file); 2994 struct bttv *btv = video_drvdata(file); 2995 struct bttv_fh *fh; 2996 enum v4l2_buf_type type = 0; 2997 2998 dprintk("open dev=%s\n", video_device_node_name(vdev)); 2999 3000 if (vdev->vfl_type == VFL_TYPE_GRABBER) { 3001 type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 3002 } else if (vdev->vfl_type == VFL_TYPE_VBI) { 3003 type = V4L2_BUF_TYPE_VBI_CAPTURE; 3004 } else { 3005 WARN_ON(1); 3006 return -ENODEV; 3007 } 3008 3009 dprintk("%d: open called (type=%s)\n", 3010 btv->c.nr, v4l2_type_names[type]); 3011 3012 /* allocate per filehandle data */ 3013 fh = kmalloc(sizeof(*fh), GFP_KERNEL); 3014 if (unlikely(!fh)) 3015 return -ENOMEM; 3016 btv->users++; 3017 file->private_data = fh; 3018 3019 *fh = btv->init; 3020 v4l2_fh_init(&fh->fh, vdev); 3021 3022 fh->type = type; 3023 fh->ov.setup_ok = 0; 3024 3025 videobuf_queue_sg_init(&fh->cap, &bttv_video_qops, 3026 &btv->c.pci->dev, &btv->s_lock, 3027 V4L2_BUF_TYPE_VIDEO_CAPTURE, 3028 V4L2_FIELD_INTERLACED, 3029 sizeof(struct bttv_buffer), 3030 fh, &btv->lock); 3031 videobuf_queue_sg_init(&fh->vbi, &bttv_vbi_qops, 3032 &btv->c.pci->dev, &btv->s_lock, 3033 V4L2_BUF_TYPE_VBI_CAPTURE, 3034 V4L2_FIELD_SEQ_TB, 3035 sizeof(struct bttv_buffer), 3036 fh, &btv->lock); 3037 set_tvnorm(btv,btv->tvnorm); 3038 set_input(btv, btv->input, btv->tvnorm); 3039 audio_mute(btv, btv->mute); 3040 3041 /* The V4L2 spec requires one global set of cropping parameters 3042 which only change on request. These are stored in btv->crop[1]. 3043 However for compatibility with V4L apps and cropping unaware 3044 V4L2 apps we now reset the cropping parameters as seen through 3045 this fh, which is to say VIDIOC_G_CROP and scaling limit checks 3046 will use btv->crop[0], the default cropping parameters for the 3047 current video standard, and VIDIOC_S_FMT will not implicitely 3048 change the cropping parameters until VIDIOC_S_CROP has been 3049 called. */ 3050 fh->do_crop = !reset_crop; /* module parameter */ 3051 3052 /* Likewise there should be one global set of VBI capture 3053 parameters, but for compatibility with V4L apps and earlier 3054 driver versions each fh has its own parameters. */ 3055 bttv_vbi_fmt_reset(&fh->vbi_fmt, btv->tvnorm); 3056 3057 bttv_field_count(btv); 3058 v4l2_fh_add(&fh->fh); 3059 return 0; 3060 } 3061 3062 static int bttv_release(struct file *file) 3063 { 3064 struct bttv_fh *fh = file->private_data; 3065 struct bttv *btv = fh->btv; 3066 3067 /* turn off overlay */ 3068 if (check_btres(fh, RESOURCE_OVERLAY)) 3069 bttv_switch_overlay(btv,fh,NULL); 3070 3071 /* stop video capture */ 3072 if (check_btres(fh, RESOURCE_VIDEO_STREAM)) { 3073 videobuf_streamoff(&fh->cap); 3074 free_btres_lock(btv,fh,RESOURCE_VIDEO_STREAM); 3075 } 3076 if (fh->cap.read_buf) { 3077 buffer_release(&fh->cap,fh->cap.read_buf); 3078 kfree(fh->cap.read_buf); 3079 } 3080 if (check_btres(fh, RESOURCE_VIDEO_READ)) { 3081 free_btres_lock(btv, fh, RESOURCE_VIDEO_READ); 3082 } 3083 3084 /* stop vbi capture */ 3085 if (check_btres(fh, RESOURCE_VBI)) { 3086 videobuf_stop(&fh->vbi); 3087 free_btres_lock(btv,fh,RESOURCE_VBI); 3088 } 3089 3090 /* free stuff */ 3091 3092 videobuf_mmap_free(&fh->cap); 3093 videobuf_mmap_free(&fh->vbi); 3094 file->private_data = NULL; 3095 3096 btv->users--; 3097 bttv_field_count(btv); 3098 3099 if (!btv->users) 3100 audio_mute(btv, btv->mute); 3101 3102 v4l2_fh_del(&fh->fh); 3103 v4l2_fh_exit(&fh->fh); 3104 kfree(fh); 3105 return 0; 3106 } 3107 3108 static int 3109 bttv_mmap(struct file *file, struct vm_area_struct *vma) 3110 { 3111 struct bttv_fh *fh = file->private_data; 3112 3113 dprintk("%d: mmap type=%s 0x%lx+%ld\n", 3114 fh->btv->c.nr, v4l2_type_names[fh->type], 3115 vma->vm_start, vma->vm_end - vma->vm_start); 3116 return videobuf_mmap_mapper(bttv_queue(fh),vma); 3117 } 3118 3119 static const struct v4l2_file_operations bttv_fops = 3120 { 3121 .owner = THIS_MODULE, 3122 .open = bttv_open, 3123 .release = bttv_release, 3124 .unlocked_ioctl = video_ioctl2, 3125 .read = bttv_read, 3126 .mmap = bttv_mmap, 3127 .poll = bttv_poll, 3128 }; 3129 3130 static const struct v4l2_ioctl_ops bttv_ioctl_ops = { 3131 .vidioc_querycap = bttv_querycap, 3132 .vidioc_enum_fmt_vid_cap = bttv_enum_fmt_vid_cap, 3133 .vidioc_g_fmt_vid_cap = bttv_g_fmt_vid_cap, 3134 .vidioc_try_fmt_vid_cap = bttv_try_fmt_vid_cap, 3135 .vidioc_s_fmt_vid_cap = bttv_s_fmt_vid_cap, 3136 .vidioc_enum_fmt_vid_overlay = bttv_enum_fmt_vid_overlay, 3137 .vidioc_g_fmt_vid_overlay = bttv_g_fmt_vid_overlay, 3138 .vidioc_try_fmt_vid_overlay = bttv_try_fmt_vid_overlay, 3139 .vidioc_s_fmt_vid_overlay = bttv_s_fmt_vid_overlay, 3140 .vidioc_g_fmt_vbi_cap = bttv_g_fmt_vbi_cap, 3141 .vidioc_try_fmt_vbi_cap = bttv_try_fmt_vbi_cap, 3142 .vidioc_s_fmt_vbi_cap = bttv_s_fmt_vbi_cap, 3143 .vidioc_cropcap = bttv_cropcap, 3144 .vidioc_reqbufs = bttv_reqbufs, 3145 .vidioc_querybuf = bttv_querybuf, 3146 .vidioc_qbuf = bttv_qbuf, 3147 .vidioc_dqbuf = bttv_dqbuf, 3148 .vidioc_s_std = bttv_s_std, 3149 .vidioc_g_std = bttv_g_std, 3150 .vidioc_enum_input = bttv_enum_input, 3151 .vidioc_g_input = bttv_g_input, 3152 .vidioc_s_input = bttv_s_input, 3153 .vidioc_streamon = bttv_streamon, 3154 .vidioc_streamoff = bttv_streamoff, 3155 .vidioc_g_tuner = bttv_g_tuner, 3156 .vidioc_s_tuner = bttv_s_tuner, 3157 .vidioc_g_crop = bttv_g_crop, 3158 .vidioc_s_crop = bttv_s_crop, 3159 .vidioc_g_fbuf = bttv_g_fbuf, 3160 .vidioc_s_fbuf = bttv_s_fbuf, 3161 .vidioc_overlay = bttv_overlay, 3162 .vidioc_g_parm = bttv_g_parm, 3163 .vidioc_g_frequency = bttv_g_frequency, 3164 .vidioc_s_frequency = bttv_s_frequency, 3165 .vidioc_log_status = bttv_log_status, 3166 .vidioc_querystd = bttv_querystd, 3167 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 3168 .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 3169 #ifdef CONFIG_VIDEO_ADV_DEBUG 3170 .vidioc_g_register = bttv_g_register, 3171 .vidioc_s_register = bttv_s_register, 3172 #endif 3173 }; 3174 3175 static struct video_device bttv_video_template = { 3176 .fops = &bttv_fops, 3177 .ioctl_ops = &bttv_ioctl_ops, 3178 .tvnorms = BTTV_NORMS, 3179 }; 3180 3181 /* ----------------------------------------------------------------------- */ 3182 /* radio interface */ 3183 3184 static int radio_open(struct file *file) 3185 { 3186 struct video_device *vdev = video_devdata(file); 3187 struct bttv *btv = video_drvdata(file); 3188 struct bttv_fh *fh; 3189 3190 dprintk("open dev=%s\n", video_device_node_name(vdev)); 3191 3192 dprintk("%d: open called (radio)\n", btv->c.nr); 3193 3194 /* allocate per filehandle data */ 3195 fh = kmalloc(sizeof(*fh), GFP_KERNEL); 3196 if (unlikely(!fh)) 3197 return -ENOMEM; 3198 file->private_data = fh; 3199 *fh = btv->init; 3200 v4l2_fh_init(&fh->fh, vdev); 3201 3202 btv->radio_user++; 3203 audio_mute(btv, btv->mute); 3204 3205 v4l2_fh_add(&fh->fh); 3206 3207 return 0; 3208 } 3209 3210 static int radio_release(struct file *file) 3211 { 3212 struct bttv_fh *fh = file->private_data; 3213 struct bttv *btv = fh->btv; 3214 struct saa6588_command cmd; 3215 3216 file->private_data = NULL; 3217 v4l2_fh_del(&fh->fh); 3218 v4l2_fh_exit(&fh->fh); 3219 kfree(fh); 3220 3221 btv->radio_user--; 3222 3223 bttv_call_all(btv, core, ioctl, SAA6588_CMD_CLOSE, &cmd); 3224 3225 if (btv->radio_user == 0) 3226 btv->has_radio_tuner = 0; 3227 return 0; 3228 } 3229 3230 static int radio_g_tuner(struct file *file, void *priv, struct v4l2_tuner *t) 3231 { 3232 struct bttv_fh *fh = priv; 3233 struct bttv *btv = fh->btv; 3234 3235 if (0 != t->index) 3236 return -EINVAL; 3237 strcpy(t->name, "Radio"); 3238 t->type = V4L2_TUNER_RADIO; 3239 radio_enable(btv); 3240 3241 bttv_call_all(btv, tuner, g_tuner, t); 3242 3243 if (btv->audio_mode_gpio) 3244 btv->audio_mode_gpio(btv, t, 0); 3245 3246 return 0; 3247 } 3248 3249 static int radio_s_tuner(struct file *file, void *priv, 3250 const struct v4l2_tuner *t) 3251 { 3252 struct bttv_fh *fh = priv; 3253 struct bttv *btv = fh->btv; 3254 3255 if (0 != t->index) 3256 return -EINVAL; 3257 3258 radio_enable(btv); 3259 bttv_call_all(btv, tuner, s_tuner, t); 3260 return 0; 3261 } 3262 3263 static ssize_t radio_read(struct file *file, char __user *data, 3264 size_t count, loff_t *ppos) 3265 { 3266 struct bttv_fh *fh = file->private_data; 3267 struct bttv *btv = fh->btv; 3268 struct saa6588_command cmd; 3269 cmd.block_count = count/3; 3270 cmd.buffer = data; 3271 cmd.instance = file; 3272 cmd.result = -ENODEV; 3273 radio_enable(btv); 3274 3275 bttv_call_all(btv, core, ioctl, SAA6588_CMD_READ, &cmd); 3276 3277 return cmd.result; 3278 } 3279 3280 static unsigned int radio_poll(struct file *file, poll_table *wait) 3281 { 3282 struct bttv_fh *fh = file->private_data; 3283 struct bttv *btv = fh->btv; 3284 unsigned long req_events = poll_requested_events(wait); 3285 struct saa6588_command cmd; 3286 unsigned int res = 0; 3287 3288 if (v4l2_event_pending(&fh->fh)) 3289 res = POLLPRI; 3290 else if (req_events & POLLPRI) 3291 poll_wait(file, &fh->fh.wait, wait); 3292 radio_enable(btv); 3293 cmd.instance = file; 3294 cmd.event_list = wait; 3295 cmd.result = res; 3296 bttv_call_all(btv, core, ioctl, SAA6588_CMD_POLL, &cmd); 3297 3298 return cmd.result; 3299 } 3300 3301 static const struct v4l2_file_operations radio_fops = 3302 { 3303 .owner = THIS_MODULE, 3304 .open = radio_open, 3305 .read = radio_read, 3306 .release = radio_release, 3307 .unlocked_ioctl = video_ioctl2, 3308 .poll = radio_poll, 3309 }; 3310 3311 static const struct v4l2_ioctl_ops radio_ioctl_ops = { 3312 .vidioc_querycap = bttv_querycap, 3313 .vidioc_log_status = bttv_log_status, 3314 .vidioc_g_tuner = radio_g_tuner, 3315 .vidioc_s_tuner = radio_s_tuner, 3316 .vidioc_g_frequency = bttv_g_frequency, 3317 .vidioc_s_frequency = bttv_s_frequency, 3318 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 3319 .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 3320 }; 3321 3322 static struct video_device radio_template = { 3323 .fops = &radio_fops, 3324 .ioctl_ops = &radio_ioctl_ops, 3325 }; 3326 3327 /* ----------------------------------------------------------------------- */ 3328 /* some debug code */ 3329 3330 static int bttv_risc_decode(u32 risc) 3331 { 3332 static char *instr[16] = { 3333 [ BT848_RISC_WRITE >> 28 ] = "write", 3334 [ BT848_RISC_SKIP >> 28 ] = "skip", 3335 [ BT848_RISC_WRITEC >> 28 ] = "writec", 3336 [ BT848_RISC_JUMP >> 28 ] = "jump", 3337 [ BT848_RISC_SYNC >> 28 ] = "sync", 3338 [ BT848_RISC_WRITE123 >> 28 ] = "write123", 3339 [ BT848_RISC_SKIP123 >> 28 ] = "skip123", 3340 [ BT848_RISC_WRITE1S23 >> 28 ] = "write1s23", 3341 }; 3342 static int incr[16] = { 3343 [ BT848_RISC_WRITE >> 28 ] = 2, 3344 [ BT848_RISC_JUMP >> 28 ] = 2, 3345 [ BT848_RISC_SYNC >> 28 ] = 2, 3346 [ BT848_RISC_WRITE123 >> 28 ] = 5, 3347 [ BT848_RISC_SKIP123 >> 28 ] = 2, 3348 [ BT848_RISC_WRITE1S23 >> 28 ] = 3, 3349 }; 3350 static char *bits[] = { 3351 "be0", "be1", "be2", "be3/resync", 3352 "set0", "set1", "set2", "set3", 3353 "clr0", "clr1", "clr2", "clr3", 3354 "irq", "res", "eol", "sol", 3355 }; 3356 int i; 3357 3358 pr_cont("0x%08x [ %s", risc, 3359 instr[risc >> 28] ? instr[risc >> 28] : "INVALID"); 3360 for (i = ARRAY_SIZE(bits)-1; i >= 0; i--) 3361 if (risc & (1 << (i + 12))) 3362 pr_cont(" %s", bits[i]); 3363 pr_cont(" count=%d ]\n", risc & 0xfff); 3364 return incr[risc >> 28] ? incr[risc >> 28] : 1; 3365 } 3366 3367 static void bttv_risc_disasm(struct bttv *btv, 3368 struct btcx_riscmem *risc) 3369 { 3370 unsigned int i,j,n; 3371 3372 pr_info("%s: risc disasm: %p [dma=0x%08lx]\n", 3373 btv->c.v4l2_dev.name, risc->cpu, (unsigned long)risc->dma); 3374 for (i = 0; i < (risc->size >> 2); i += n) { 3375 pr_info("%s: 0x%lx: ", 3376 btv->c.v4l2_dev.name, 3377 (unsigned long)(risc->dma + (i<<2))); 3378 n = bttv_risc_decode(le32_to_cpu(risc->cpu[i])); 3379 for (j = 1; j < n; j++) 3380 pr_info("%s: 0x%lx: 0x%08x [ arg #%d ]\n", 3381 btv->c.v4l2_dev.name, 3382 (unsigned long)(risc->dma + ((i+j)<<2)), 3383 risc->cpu[i+j], j); 3384 if (0 == risc->cpu[i]) 3385 break; 3386 } 3387 } 3388 3389 static void bttv_print_riscaddr(struct bttv *btv) 3390 { 3391 pr_info(" main: %08llx\n", (unsigned long long)btv->main.dma); 3392 pr_info(" vbi : o=%08llx e=%08llx\n", 3393 btv->cvbi ? (unsigned long long)btv->cvbi->top.dma : 0, 3394 btv->cvbi ? (unsigned long long)btv->cvbi->bottom.dma : 0); 3395 pr_info(" cap : o=%08llx e=%08llx\n", 3396 btv->curr.top 3397 ? (unsigned long long)btv->curr.top->top.dma : 0, 3398 btv->curr.bottom 3399 ? (unsigned long long)btv->curr.bottom->bottom.dma : 0); 3400 pr_info(" scr : o=%08llx e=%08llx\n", 3401 btv->screen ? (unsigned long long)btv->screen->top.dma : 0, 3402 btv->screen ? (unsigned long long)btv->screen->bottom.dma : 0); 3403 bttv_risc_disasm(btv, &btv->main); 3404 } 3405 3406 /* ----------------------------------------------------------------------- */ 3407 /* irq handler */ 3408 3409 static char *irq_name[] = { 3410 "FMTCHG", // format change detected (525 vs. 625) 3411 "VSYNC", // vertical sync (new field) 3412 "HSYNC", // horizontal sync 3413 "OFLOW", // chroma/luma AGC overflow 3414 "HLOCK", // horizontal lock changed 3415 "VPRES", // video presence changed 3416 "6", "7", 3417 "I2CDONE", // hw irc operation finished 3418 "GPINT", // gpio port triggered irq 3419 "10", 3420 "RISCI", // risc instruction triggered irq 3421 "FBUS", // pixel data fifo dropped data (high pci bus latencies) 3422 "FTRGT", // pixel data fifo overrun 3423 "FDSR", // fifo data stream resyncronisation 3424 "PPERR", // parity error (data transfer) 3425 "RIPERR", // parity error (read risc instructions) 3426 "PABORT", // pci abort 3427 "OCERR", // risc instruction error 3428 "SCERR", // syncronisation error 3429 }; 3430 3431 static void bttv_print_irqbits(u32 print, u32 mark) 3432 { 3433 unsigned int i; 3434 3435 pr_cont("bits:"); 3436 for (i = 0; i < ARRAY_SIZE(irq_name); i++) { 3437 if (print & (1 << i)) 3438 pr_cont(" %s", irq_name[i]); 3439 if (mark & (1 << i)) 3440 pr_cont("*"); 3441 } 3442 } 3443 3444 static void bttv_irq_debug_low_latency(struct bttv *btv, u32 rc) 3445 { 3446 pr_warn("%d: irq: skipped frame [main=%lx,o_vbi=%lx,o_field=%lx,rc=%lx]\n", 3447 btv->c.nr, 3448 (unsigned long)btv->main.dma, 3449 (unsigned long)le32_to_cpu(btv->main.cpu[RISC_SLOT_O_VBI+1]), 3450 (unsigned long)le32_to_cpu(btv->main.cpu[RISC_SLOT_O_FIELD+1]), 3451 (unsigned long)rc); 3452 3453 if (0 == (btread(BT848_DSTATUS) & BT848_DSTATUS_HLOC)) { 3454 pr_notice("%d: Oh, there (temporarily?) is no input signal. " 3455 "Ok, then this is harmless, don't worry ;)\n", 3456 btv->c.nr); 3457 return; 3458 } 3459 pr_notice("%d: Uhm. Looks like we have unusual high IRQ latencies\n", 3460 btv->c.nr); 3461 pr_notice("%d: Lets try to catch the culpit red-handed ...\n", 3462 btv->c.nr); 3463 dump_stack(); 3464 } 3465 3466 static int 3467 bttv_irq_next_video(struct bttv *btv, struct bttv_buffer_set *set) 3468 { 3469 struct bttv_buffer *item; 3470 3471 memset(set,0,sizeof(*set)); 3472 3473 /* capture request ? */ 3474 if (!list_empty(&btv->capture)) { 3475 set->frame_irq = 1; 3476 item = list_entry(btv->capture.next, struct bttv_buffer, vb.queue); 3477 if (V4L2_FIELD_HAS_TOP(item->vb.field)) 3478 set->top = item; 3479 if (V4L2_FIELD_HAS_BOTTOM(item->vb.field)) 3480 set->bottom = item; 3481 3482 /* capture request for other field ? */ 3483 if (!V4L2_FIELD_HAS_BOTH(item->vb.field) && 3484 (item->vb.queue.next != &btv->capture)) { 3485 item = list_entry(item->vb.queue.next, struct bttv_buffer, vb.queue); 3486 /* Mike Isely <isely@pobox.com> - Only check 3487 * and set up the bottom field in the logic 3488 * below. Don't ever do the top field. This 3489 * of course means that if we set up the 3490 * bottom field in the above code that we'll 3491 * actually skip a field. But that's OK. 3492 * Having processed only a single buffer this 3493 * time, then the next time around the first 3494 * available buffer should be for a top field. 3495 * That will then cause us here to set up a 3496 * top then a bottom field in the normal way. 3497 * The alternative to this understanding is 3498 * that we set up the second available buffer 3499 * as a top field, but that's out of order 3500 * since this driver always processes the top 3501 * field first - the effect will be the two 3502 * buffers being returned in the wrong order, 3503 * with the second buffer also being delayed 3504 * by one field time (owing to the fifo nature 3505 * of videobuf). Worse still, we'll be stuck 3506 * doing fields out of order now every time 3507 * until something else causes a field to be 3508 * dropped. By effectively forcing a field to 3509 * drop this way then we always get back into 3510 * sync within a single frame time. (Out of 3511 * order fields can screw up deinterlacing 3512 * algorithms.) */ 3513 if (!V4L2_FIELD_HAS_BOTH(item->vb.field)) { 3514 if (NULL == set->bottom && 3515 V4L2_FIELD_BOTTOM == item->vb.field) { 3516 set->bottom = item; 3517 } 3518 if (NULL != set->top && NULL != set->bottom) 3519 set->top_irq = 2; 3520 } 3521 } 3522 } 3523 3524 /* screen overlay ? */ 3525 if (NULL != btv->screen) { 3526 if (V4L2_FIELD_HAS_BOTH(btv->screen->vb.field)) { 3527 if (NULL == set->top && NULL == set->bottom) { 3528 set->top = btv->screen; 3529 set->bottom = btv->screen; 3530 } 3531 } else { 3532 if (V4L2_FIELD_TOP == btv->screen->vb.field && 3533 NULL == set->top) { 3534 set->top = btv->screen; 3535 } 3536 if (V4L2_FIELD_BOTTOM == btv->screen->vb.field && 3537 NULL == set->bottom) { 3538 set->bottom = btv->screen; 3539 } 3540 } 3541 } 3542 3543 dprintk("%d: next set: top=%p bottom=%p [screen=%p,irq=%d,%d]\n", 3544 btv->c.nr, set->top, set->bottom, 3545 btv->screen, set->frame_irq, set->top_irq); 3546 return 0; 3547 } 3548 3549 static void 3550 bttv_irq_wakeup_video(struct bttv *btv, struct bttv_buffer_set *wakeup, 3551 struct bttv_buffer_set *curr, unsigned int state) 3552 { 3553 struct timeval ts; 3554 3555 v4l2_get_timestamp(&ts); 3556 3557 if (wakeup->top == wakeup->bottom) { 3558 if (NULL != wakeup->top && curr->top != wakeup->top) { 3559 if (irq_debug > 1) 3560 pr_debug("%d: wakeup: both=%p\n", 3561 btv->c.nr, wakeup->top); 3562 wakeup->top->vb.ts = ts; 3563 wakeup->top->vb.field_count = btv->field_count; 3564 wakeup->top->vb.state = state; 3565 wake_up(&wakeup->top->vb.done); 3566 } 3567 } else { 3568 if (NULL != wakeup->top && curr->top != wakeup->top) { 3569 if (irq_debug > 1) 3570 pr_debug("%d: wakeup: top=%p\n", 3571 btv->c.nr, wakeup->top); 3572 wakeup->top->vb.ts = ts; 3573 wakeup->top->vb.field_count = btv->field_count; 3574 wakeup->top->vb.state = state; 3575 wake_up(&wakeup->top->vb.done); 3576 } 3577 if (NULL != wakeup->bottom && curr->bottom != wakeup->bottom) { 3578 if (irq_debug > 1) 3579 pr_debug("%d: wakeup: bottom=%p\n", 3580 btv->c.nr, wakeup->bottom); 3581 wakeup->bottom->vb.ts = ts; 3582 wakeup->bottom->vb.field_count = btv->field_count; 3583 wakeup->bottom->vb.state = state; 3584 wake_up(&wakeup->bottom->vb.done); 3585 } 3586 } 3587 } 3588 3589 static void 3590 bttv_irq_wakeup_vbi(struct bttv *btv, struct bttv_buffer *wakeup, 3591 unsigned int state) 3592 { 3593 struct timeval ts; 3594 3595 if (NULL == wakeup) 3596 return; 3597 3598 v4l2_get_timestamp(&ts); 3599 wakeup->vb.ts = ts; 3600 wakeup->vb.field_count = btv->field_count; 3601 wakeup->vb.state = state; 3602 wake_up(&wakeup->vb.done); 3603 } 3604 3605 static void bttv_irq_timeout(unsigned long data) 3606 { 3607 struct bttv *btv = (struct bttv *)data; 3608 struct bttv_buffer_set old,new; 3609 struct bttv_buffer *ovbi; 3610 struct bttv_buffer *item; 3611 unsigned long flags; 3612 3613 if (bttv_verbose) { 3614 pr_info("%d: timeout: drop=%d irq=%d/%d, risc=%08x, ", 3615 btv->c.nr, btv->framedrop, btv->irq_me, btv->irq_total, 3616 btread(BT848_RISC_COUNT)); 3617 bttv_print_irqbits(btread(BT848_INT_STAT),0); 3618 pr_cont("\n"); 3619 } 3620 3621 spin_lock_irqsave(&btv->s_lock,flags); 3622 3623 /* deactivate stuff */ 3624 memset(&new,0,sizeof(new)); 3625 old = btv->curr; 3626 ovbi = btv->cvbi; 3627 btv->curr = new; 3628 btv->cvbi = NULL; 3629 btv->loop_irq = 0; 3630 bttv_buffer_activate_video(btv, &new); 3631 bttv_buffer_activate_vbi(btv, NULL); 3632 bttv_set_dma(btv, 0); 3633 3634 /* wake up */ 3635 bttv_irq_wakeup_video(btv, &old, &new, VIDEOBUF_ERROR); 3636 bttv_irq_wakeup_vbi(btv, ovbi, VIDEOBUF_ERROR); 3637 3638 /* cancel all outstanding capture / vbi requests */ 3639 while (!list_empty(&btv->capture)) { 3640 item = list_entry(btv->capture.next, struct bttv_buffer, vb.queue); 3641 list_del(&item->vb.queue); 3642 item->vb.state = VIDEOBUF_ERROR; 3643 wake_up(&item->vb.done); 3644 } 3645 while (!list_empty(&btv->vcapture)) { 3646 item = list_entry(btv->vcapture.next, struct bttv_buffer, vb.queue); 3647 list_del(&item->vb.queue); 3648 item->vb.state = VIDEOBUF_ERROR; 3649 wake_up(&item->vb.done); 3650 } 3651 3652 btv->errors++; 3653 spin_unlock_irqrestore(&btv->s_lock,flags); 3654 } 3655 3656 static void 3657 bttv_irq_wakeup_top(struct bttv *btv) 3658 { 3659 struct bttv_buffer *wakeup = btv->curr.top; 3660 3661 if (NULL == wakeup) 3662 return; 3663 3664 spin_lock(&btv->s_lock); 3665 btv->curr.top_irq = 0; 3666 btv->curr.top = NULL; 3667 bttv_risc_hook(btv, RISC_SLOT_O_FIELD, NULL, 0); 3668 3669 v4l2_get_timestamp(&wakeup->vb.ts); 3670 wakeup->vb.field_count = btv->field_count; 3671 wakeup->vb.state = VIDEOBUF_DONE; 3672 wake_up(&wakeup->vb.done); 3673 spin_unlock(&btv->s_lock); 3674 } 3675 3676 static inline int is_active(struct btcx_riscmem *risc, u32 rc) 3677 { 3678 if (rc < risc->dma) 3679 return 0; 3680 if (rc > risc->dma + risc->size) 3681 return 0; 3682 return 1; 3683 } 3684 3685 static void 3686 bttv_irq_switch_video(struct bttv *btv) 3687 { 3688 struct bttv_buffer_set new; 3689 struct bttv_buffer_set old; 3690 dma_addr_t rc; 3691 3692 spin_lock(&btv->s_lock); 3693 3694 /* new buffer set */ 3695 bttv_irq_next_video(btv, &new); 3696 rc = btread(BT848_RISC_COUNT); 3697 if ((btv->curr.top && is_active(&btv->curr.top->top, rc)) || 3698 (btv->curr.bottom && is_active(&btv->curr.bottom->bottom, rc))) { 3699 btv->framedrop++; 3700 if (debug_latency) 3701 bttv_irq_debug_low_latency(btv, rc); 3702 spin_unlock(&btv->s_lock); 3703 return; 3704 } 3705 3706 /* switch over */ 3707 old = btv->curr; 3708 btv->curr = new; 3709 btv->loop_irq &= ~1; 3710 bttv_buffer_activate_video(btv, &new); 3711 bttv_set_dma(btv, 0); 3712 3713 /* switch input */ 3714 if (UNSET != btv->new_input) { 3715 video_mux(btv,btv->new_input); 3716 btv->new_input = UNSET; 3717 } 3718 3719 /* wake up finished buffers */ 3720 bttv_irq_wakeup_video(btv, &old, &new, VIDEOBUF_DONE); 3721 spin_unlock(&btv->s_lock); 3722 } 3723 3724 static void 3725 bttv_irq_switch_vbi(struct bttv *btv) 3726 { 3727 struct bttv_buffer *new = NULL; 3728 struct bttv_buffer *old; 3729 u32 rc; 3730 3731 spin_lock(&btv->s_lock); 3732 3733 if (!list_empty(&btv->vcapture)) 3734 new = list_entry(btv->vcapture.next, struct bttv_buffer, vb.queue); 3735 old = btv->cvbi; 3736 3737 rc = btread(BT848_RISC_COUNT); 3738 if (NULL != old && (is_active(&old->top, rc) || 3739 is_active(&old->bottom, rc))) { 3740 btv->framedrop++; 3741 if (debug_latency) 3742 bttv_irq_debug_low_latency(btv, rc); 3743 spin_unlock(&btv->s_lock); 3744 return; 3745 } 3746 3747 /* switch */ 3748 btv->cvbi = new; 3749 btv->loop_irq &= ~4; 3750 bttv_buffer_activate_vbi(btv, new); 3751 bttv_set_dma(btv, 0); 3752 3753 bttv_irq_wakeup_vbi(btv, old, VIDEOBUF_DONE); 3754 spin_unlock(&btv->s_lock); 3755 } 3756 3757 static irqreturn_t bttv_irq(int irq, void *dev_id) 3758 { 3759 u32 stat,astat; 3760 u32 dstat; 3761 int count; 3762 struct bttv *btv; 3763 int handled = 0; 3764 3765 btv=(struct bttv *)dev_id; 3766 3767 count=0; 3768 while (1) { 3769 /* get/clear interrupt status bits */ 3770 stat=btread(BT848_INT_STAT); 3771 astat=stat&btread(BT848_INT_MASK); 3772 if (!astat) 3773 break; 3774 handled = 1; 3775 btwrite(stat,BT848_INT_STAT); 3776 3777 /* get device status bits */ 3778 dstat=btread(BT848_DSTATUS); 3779 3780 if (irq_debug) { 3781 pr_debug("%d: irq loop=%d fc=%d riscs=%x, riscc=%08x, ", 3782 btv->c.nr, count, btv->field_count, 3783 stat>>28, btread(BT848_RISC_COUNT)); 3784 bttv_print_irqbits(stat,astat); 3785 if (stat & BT848_INT_HLOCK) 3786 pr_cont(" HLOC => %s", 3787 dstat & BT848_DSTATUS_HLOC 3788 ? "yes" : "no"); 3789 if (stat & BT848_INT_VPRES) 3790 pr_cont(" PRES => %s", 3791 dstat & BT848_DSTATUS_PRES 3792 ? "yes" : "no"); 3793 if (stat & BT848_INT_FMTCHG) 3794 pr_cont(" NUML => %s", 3795 dstat & BT848_DSTATUS_NUML 3796 ? "625" : "525"); 3797 pr_cont("\n"); 3798 } 3799 3800 if (astat&BT848_INT_VSYNC) 3801 btv->field_count++; 3802 3803 if ((astat & BT848_INT_GPINT) && btv->remote) { 3804 bttv_input_irq(btv); 3805 } 3806 3807 if (astat & BT848_INT_I2CDONE) { 3808 btv->i2c_done = stat; 3809 wake_up(&btv->i2c_queue); 3810 } 3811 3812 if ((astat & BT848_INT_RISCI) && (stat & (4<<28))) 3813 bttv_irq_switch_vbi(btv); 3814 3815 if ((astat & BT848_INT_RISCI) && (stat & (2<<28))) 3816 bttv_irq_wakeup_top(btv); 3817 3818 if ((astat & BT848_INT_RISCI) && (stat & (1<<28))) 3819 bttv_irq_switch_video(btv); 3820 3821 if ((astat & BT848_INT_HLOCK) && btv->opt_automute) 3822 /* trigger automute */ 3823 audio_mux_gpio(btv, btv->audio_input, btv->mute); 3824 3825 if (astat & (BT848_INT_SCERR|BT848_INT_OCERR)) { 3826 pr_info("%d: %s%s @ %08x,", 3827 btv->c.nr, 3828 (astat & BT848_INT_SCERR) ? "SCERR" : "", 3829 (astat & BT848_INT_OCERR) ? "OCERR" : "", 3830 btread(BT848_RISC_COUNT)); 3831 bttv_print_irqbits(stat,astat); 3832 pr_cont("\n"); 3833 if (bttv_debug) 3834 bttv_print_riscaddr(btv); 3835 } 3836 if (fdsr && astat & BT848_INT_FDSR) { 3837 pr_info("%d: FDSR @ %08x\n", 3838 btv->c.nr, btread(BT848_RISC_COUNT)); 3839 if (bttv_debug) 3840 bttv_print_riscaddr(btv); 3841 } 3842 3843 count++; 3844 if (count > 4) { 3845 3846 if (count > 8 || !(astat & BT848_INT_GPINT)) { 3847 btwrite(0, BT848_INT_MASK); 3848 3849 pr_err("%d: IRQ lockup, cleared int mask [", 3850 btv->c.nr); 3851 } else { 3852 pr_err("%d: IRQ lockup, clearing GPINT from int mask [", 3853 btv->c.nr); 3854 3855 btwrite(btread(BT848_INT_MASK) & (-1 ^ BT848_INT_GPINT), 3856 BT848_INT_MASK); 3857 }; 3858 3859 bttv_print_irqbits(stat,astat); 3860 3861 pr_cont("]\n"); 3862 } 3863 } 3864 btv->irq_total++; 3865 if (handled) 3866 btv->irq_me++; 3867 return IRQ_RETVAL(handled); 3868 } 3869 3870 3871 /* ----------------------------------------------------------------------- */ 3872 /* initialization */ 3873 3874 static struct video_device *vdev_init(struct bttv *btv, 3875 const struct video_device *template, 3876 const char *type_name) 3877 { 3878 struct video_device *vfd; 3879 3880 vfd = video_device_alloc(); 3881 if (NULL == vfd) 3882 return NULL; 3883 *vfd = *template; 3884 vfd->v4l2_dev = &btv->c.v4l2_dev; 3885 vfd->release = video_device_release; 3886 vfd->debug = bttv_debug; 3887 set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 3888 video_set_drvdata(vfd, btv); 3889 snprintf(vfd->name, sizeof(vfd->name), "BT%d%s %s (%s)", 3890 btv->id, (btv->id==848 && btv->revision==0x12) ? "A" : "", 3891 type_name, bttv_tvcards[btv->c.type].name); 3892 if (btv->tuner_type == TUNER_ABSENT) { 3893 v4l2_disable_ioctl(vfd, VIDIOC_G_FREQUENCY); 3894 v4l2_disable_ioctl(vfd, VIDIOC_S_FREQUENCY); 3895 v4l2_disable_ioctl(vfd, VIDIOC_G_TUNER); 3896 v4l2_disable_ioctl(vfd, VIDIOC_S_TUNER); 3897 } 3898 return vfd; 3899 } 3900 3901 static void bttv_unregister_video(struct bttv *btv) 3902 { 3903 if (btv->video_dev) { 3904 if (video_is_registered(btv->video_dev)) 3905 video_unregister_device(btv->video_dev); 3906 else 3907 video_device_release(btv->video_dev); 3908 btv->video_dev = NULL; 3909 } 3910 if (btv->vbi_dev) { 3911 if (video_is_registered(btv->vbi_dev)) 3912 video_unregister_device(btv->vbi_dev); 3913 else 3914 video_device_release(btv->vbi_dev); 3915 btv->vbi_dev = NULL; 3916 } 3917 if (btv->radio_dev) { 3918 if (video_is_registered(btv->radio_dev)) 3919 video_unregister_device(btv->radio_dev); 3920 else 3921 video_device_release(btv->radio_dev); 3922 btv->radio_dev = NULL; 3923 } 3924 } 3925 3926 /* register video4linux devices */ 3927 static int bttv_register_video(struct bttv *btv) 3928 { 3929 if (no_overlay > 0) 3930 pr_notice("Overlay support disabled\n"); 3931 3932 /* video */ 3933 btv->video_dev = vdev_init(btv, &bttv_video_template, "video"); 3934 3935 if (NULL == btv->video_dev) 3936 goto err; 3937 if (video_register_device(btv->video_dev, VFL_TYPE_GRABBER, 3938 video_nr[btv->c.nr]) < 0) 3939 goto err; 3940 pr_info("%d: registered device %s\n", 3941 btv->c.nr, video_device_node_name(btv->video_dev)); 3942 if (device_create_file(&btv->video_dev->dev, 3943 &dev_attr_card)<0) { 3944 pr_err("%d: device_create_file 'card' failed\n", btv->c.nr); 3945 goto err; 3946 } 3947 3948 /* vbi */ 3949 btv->vbi_dev = vdev_init(btv, &bttv_video_template, "vbi"); 3950 3951 if (NULL == btv->vbi_dev) 3952 goto err; 3953 if (video_register_device(btv->vbi_dev, VFL_TYPE_VBI, 3954 vbi_nr[btv->c.nr]) < 0) 3955 goto err; 3956 pr_info("%d: registered device %s\n", 3957 btv->c.nr, video_device_node_name(btv->vbi_dev)); 3958 3959 if (!btv->has_radio) 3960 return 0; 3961 /* radio */ 3962 btv->radio_dev = vdev_init(btv, &radio_template, "radio"); 3963 if (NULL == btv->radio_dev) 3964 goto err; 3965 btv->radio_dev->ctrl_handler = &btv->radio_ctrl_handler; 3966 if (video_register_device(btv->radio_dev, VFL_TYPE_RADIO, 3967 radio_nr[btv->c.nr]) < 0) 3968 goto err; 3969 pr_info("%d: registered device %s\n", 3970 btv->c.nr, video_device_node_name(btv->radio_dev)); 3971 3972 /* all done */ 3973 return 0; 3974 3975 err: 3976 bttv_unregister_video(btv); 3977 return -1; 3978 } 3979 3980 3981 /* on OpenFirmware machines (PowerMac at least), PCI memory cycle */ 3982 /* response on cards with no firmware is not enabled by OF */ 3983 static void pci_set_command(struct pci_dev *dev) 3984 { 3985 #if defined(__powerpc__) 3986 unsigned int cmd; 3987 3988 pci_read_config_dword(dev, PCI_COMMAND, &cmd); 3989 cmd = (cmd | PCI_COMMAND_MEMORY ); 3990 pci_write_config_dword(dev, PCI_COMMAND, cmd); 3991 #endif 3992 } 3993 3994 static int bttv_probe(struct pci_dev *dev, const struct pci_device_id *pci_id) 3995 { 3996 struct v4l2_frequency init_freq = { 3997 .tuner = 0, 3998 .type = V4L2_TUNER_ANALOG_TV, 3999 .frequency = 980, 4000 }; 4001 int result; 4002 unsigned char lat; 4003 struct bttv *btv; 4004 struct v4l2_ctrl_handler *hdl; 4005 4006 if (bttv_num == BTTV_MAX) 4007 return -ENOMEM; 4008 pr_info("Bt8xx card found (%d)\n", bttv_num); 4009 bttvs[bttv_num] = btv = kzalloc(sizeof(*btv), GFP_KERNEL); 4010 if (btv == NULL) { 4011 pr_err("out of memory\n"); 4012 return -ENOMEM; 4013 } 4014 btv->c.nr = bttv_num; 4015 snprintf(btv->c.v4l2_dev.name, sizeof(btv->c.v4l2_dev.name), 4016 "bttv%d", btv->c.nr); 4017 4018 /* initialize structs / fill in defaults */ 4019 mutex_init(&btv->lock); 4020 spin_lock_init(&btv->s_lock); 4021 spin_lock_init(&btv->gpio_lock); 4022 init_waitqueue_head(&btv->i2c_queue); 4023 INIT_LIST_HEAD(&btv->c.subs); 4024 INIT_LIST_HEAD(&btv->capture); 4025 INIT_LIST_HEAD(&btv->vcapture); 4026 4027 init_timer(&btv->timeout); 4028 btv->timeout.function = bttv_irq_timeout; 4029 btv->timeout.data = (unsigned long)btv; 4030 4031 btv->i2c_rc = -1; 4032 btv->tuner_type = UNSET; 4033 btv->new_input = UNSET; 4034 btv->has_radio=radio[btv->c.nr]; 4035 4036 /* pci stuff (init, get irq/mmio, ... */ 4037 btv->c.pci = dev; 4038 btv->id = dev->device; 4039 if (pci_enable_device(dev)) { 4040 pr_warn("%d: Can't enable device\n", btv->c.nr); 4041 return -EIO; 4042 } 4043 if (pci_set_dma_mask(dev, DMA_BIT_MASK(32))) { 4044 pr_warn("%d: No suitable DMA available\n", btv->c.nr); 4045 return -EIO; 4046 } 4047 if (!request_mem_region(pci_resource_start(dev,0), 4048 pci_resource_len(dev,0), 4049 btv->c.v4l2_dev.name)) { 4050 pr_warn("%d: can't request iomem (0x%llx)\n", 4051 btv->c.nr, 4052 (unsigned long long)pci_resource_start(dev, 0)); 4053 return -EBUSY; 4054 } 4055 pci_set_master(dev); 4056 pci_set_command(dev); 4057 4058 result = v4l2_device_register(&dev->dev, &btv->c.v4l2_dev); 4059 if (result < 0) { 4060 pr_warn("%d: v4l2_device_register() failed\n", btv->c.nr); 4061 goto fail0; 4062 } 4063 hdl = &btv->ctrl_handler; 4064 v4l2_ctrl_handler_init(hdl, 20); 4065 btv->c.v4l2_dev.ctrl_handler = hdl; 4066 v4l2_ctrl_handler_init(&btv->radio_ctrl_handler, 6); 4067 4068 btv->revision = dev->revision; 4069 pci_read_config_byte(dev, PCI_LATENCY_TIMER, &lat); 4070 pr_info("%d: Bt%d (rev %d) at %s, irq: %d, latency: %d, mmio: 0x%llx\n", 4071 bttv_num, btv->id, btv->revision, pci_name(dev), 4072 btv->c.pci->irq, lat, 4073 (unsigned long long)pci_resource_start(dev, 0)); 4074 schedule(); 4075 4076 btv->bt848_mmio = ioremap(pci_resource_start(dev, 0), 0x1000); 4077 if (NULL == btv->bt848_mmio) { 4078 pr_err("%d: ioremap() failed\n", btv->c.nr); 4079 result = -EIO; 4080 goto fail1; 4081 } 4082 4083 /* identify card */ 4084 bttv_idcard(btv); 4085 4086 /* disable irqs, register irq handler */ 4087 btwrite(0, BT848_INT_MASK); 4088 result = request_irq(btv->c.pci->irq, bttv_irq, 4089 IRQF_SHARED, btv->c.v4l2_dev.name, (void *)btv); 4090 if (result < 0) { 4091 pr_err("%d: can't get IRQ %d\n", 4092 bttv_num, btv->c.pci->irq); 4093 goto fail1; 4094 } 4095 4096 if (0 != bttv_handle_chipset(btv)) { 4097 result = -EIO; 4098 goto fail2; 4099 } 4100 4101 /* init options from insmod args */ 4102 btv->opt_combfilter = combfilter; 4103 bttv_ctrl_combfilter.def = combfilter; 4104 bttv_ctrl_lumafilter.def = lumafilter; 4105 btv->opt_automute = automute; 4106 bttv_ctrl_automute.def = automute; 4107 bttv_ctrl_agc_crush.def = agc_crush; 4108 btv->opt_vcr_hack = vcr_hack; 4109 bttv_ctrl_vcr_hack.def = vcr_hack; 4110 bttv_ctrl_whitecrush_upper.def = whitecrush_upper; 4111 bttv_ctrl_whitecrush_lower.def = whitecrush_lower; 4112 btv->opt_uv_ratio = uv_ratio; 4113 bttv_ctrl_uv_ratio.def = uv_ratio; 4114 bttv_ctrl_full_luma.def = full_luma_range; 4115 bttv_ctrl_coring.def = coring; 4116 4117 /* fill struct bttv with some useful defaults */ 4118 btv->init.btv = btv; 4119 btv->init.ov.w.width = 320; 4120 btv->init.ov.w.height = 240; 4121 btv->init.fmt = format_by_fourcc(V4L2_PIX_FMT_BGR24); 4122 btv->init.width = 320; 4123 btv->init.height = 240; 4124 btv->init.ov.w.width = 320; 4125 btv->init.ov.w.height = 240; 4126 btv->init.ov.field = V4L2_FIELD_INTERLACED; 4127 btv->input = 0; 4128 4129 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops, 4130 V4L2_CID_BRIGHTNESS, 0, 0xff00, 0x100, 32768); 4131 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops, 4132 V4L2_CID_CONTRAST, 0, 0xff80, 0x80, 0x6c00); 4133 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops, 4134 V4L2_CID_SATURATION, 0, 0xff80, 0x80, 32768); 4135 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops, 4136 V4L2_CID_COLOR_KILLER, 0, 1, 1, 0); 4137 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops, 4138 V4L2_CID_HUE, 0, 0xff00, 0x100, 32768); 4139 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops, 4140 V4L2_CID_CHROMA_AGC, 0, 1, 1, !!chroma_agc); 4141 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops, 4142 V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0); 4143 if (btv->volume_gpio) 4144 v4l2_ctrl_new_std(hdl, &bttv_ctrl_ops, 4145 V4L2_CID_AUDIO_VOLUME, 0, 0xff00, 0x100, 0xff00); 4146 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_combfilter, NULL); 4147 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_automute, NULL); 4148 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_lumafilter, NULL); 4149 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_agc_crush, NULL); 4150 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_vcr_hack, NULL); 4151 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_whitecrush_lower, NULL); 4152 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_whitecrush_upper, NULL); 4153 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_uv_ratio, NULL); 4154 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_full_luma, NULL); 4155 v4l2_ctrl_new_custom(hdl, &bttv_ctrl_coring, NULL); 4156 4157 /* initialize hardware */ 4158 if (bttv_gpio) 4159 bttv_gpio_tracking(btv,"pre-init"); 4160 4161 bttv_risc_init_main(btv); 4162 init_bt848(btv); 4163 4164 /* gpio */ 4165 btwrite(0x00, BT848_GPIO_REG_INP); 4166 btwrite(0x00, BT848_GPIO_OUT_EN); 4167 if (bttv_verbose) 4168 bttv_gpio_tracking(btv,"init"); 4169 4170 /* needs to be done before i2c is registered */ 4171 bttv_init_card1(btv); 4172 4173 /* register i2c + gpio */ 4174 init_bttv_i2c(btv); 4175 4176 /* some card-specific stuff (needs working i2c) */ 4177 bttv_init_card2(btv); 4178 bttv_init_tuner(btv); 4179 if (btv->tuner_type != TUNER_ABSENT) { 4180 bttv_set_frequency(btv, &init_freq); 4181 btv->radio_freq = 90500 * 16; /* 90.5Mhz default */ 4182 } 4183 btv->std = V4L2_STD_PAL; 4184 init_irqreg(btv); 4185 if (!bttv_tvcards[btv->c.type].no_video) 4186 v4l2_ctrl_handler_setup(hdl); 4187 if (hdl->error) { 4188 result = hdl->error; 4189 goto fail2; 4190 } 4191 /* mute device */ 4192 audio_mute(btv, 1); 4193 4194 /* register video4linux + input */ 4195 if (!bttv_tvcards[btv->c.type].no_video) { 4196 v4l2_ctrl_add_handler(&btv->radio_ctrl_handler, hdl, 4197 v4l2_ctrl_radio_filter); 4198 if (btv->radio_ctrl_handler.error) { 4199 result = btv->radio_ctrl_handler.error; 4200 goto fail2; 4201 } 4202 set_input(btv, 0, btv->tvnorm); 4203 bttv_crop_reset(&btv->crop[0], btv->tvnorm); 4204 btv->crop[1] = btv->crop[0]; /* current = default */ 4205 disclaim_vbi_lines(btv); 4206 disclaim_video_lines(btv); 4207 bttv_register_video(btv); 4208 } 4209 4210 /* add subdevices and autoload dvb-bt8xx if needed */ 4211 if (bttv_tvcards[btv->c.type].has_dvb) { 4212 bttv_sub_add_device(&btv->c, "dvb"); 4213 request_modules(btv); 4214 } 4215 4216 if (!disable_ir) { 4217 init_bttv_i2c_ir(btv); 4218 bttv_input_init(btv); 4219 } 4220 4221 /* everything is fine */ 4222 bttv_num++; 4223 return 0; 4224 4225 fail2: 4226 free_irq(btv->c.pci->irq,btv); 4227 4228 fail1: 4229 v4l2_ctrl_handler_free(&btv->ctrl_handler); 4230 v4l2_ctrl_handler_free(&btv->radio_ctrl_handler); 4231 v4l2_device_unregister(&btv->c.v4l2_dev); 4232 4233 fail0: 4234 if (btv->bt848_mmio) 4235 iounmap(btv->bt848_mmio); 4236 release_mem_region(pci_resource_start(btv->c.pci,0), 4237 pci_resource_len(btv->c.pci,0)); 4238 return result; 4239 } 4240 4241 static void bttv_remove(struct pci_dev *pci_dev) 4242 { 4243 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev); 4244 struct bttv *btv = to_bttv(v4l2_dev); 4245 4246 if (bttv_verbose) 4247 pr_info("%d: unloading\n", btv->c.nr); 4248 4249 if (bttv_tvcards[btv->c.type].has_dvb) 4250 flush_request_modules(btv); 4251 4252 /* shutdown everything (DMA+IRQs) */ 4253 btand(~15, BT848_GPIO_DMA_CTL); 4254 btwrite(0, BT848_INT_MASK); 4255 btwrite(~0x0, BT848_INT_STAT); 4256 btwrite(0x0, BT848_GPIO_OUT_EN); 4257 if (bttv_gpio) 4258 bttv_gpio_tracking(btv,"cleanup"); 4259 4260 /* tell gpio modules we are leaving ... */ 4261 btv->shutdown=1; 4262 bttv_input_fini(btv); 4263 bttv_sub_del_devices(&btv->c); 4264 4265 /* unregister i2c_bus + input */ 4266 fini_bttv_i2c(btv); 4267 4268 /* unregister video4linux */ 4269 bttv_unregister_video(btv); 4270 4271 /* free allocated memory */ 4272 v4l2_ctrl_handler_free(&btv->ctrl_handler); 4273 v4l2_ctrl_handler_free(&btv->radio_ctrl_handler); 4274 btcx_riscmem_free(btv->c.pci,&btv->main); 4275 4276 /* free resources */ 4277 free_irq(btv->c.pci->irq,btv); 4278 iounmap(btv->bt848_mmio); 4279 release_mem_region(pci_resource_start(btv->c.pci,0), 4280 pci_resource_len(btv->c.pci,0)); 4281 4282 v4l2_device_unregister(&btv->c.v4l2_dev); 4283 bttvs[btv->c.nr] = NULL; 4284 kfree(btv); 4285 4286 return; 4287 } 4288 4289 #ifdef CONFIG_PM 4290 static int bttv_suspend(struct pci_dev *pci_dev, pm_message_t state) 4291 { 4292 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev); 4293 struct bttv *btv = to_bttv(v4l2_dev); 4294 struct bttv_buffer_set idle; 4295 unsigned long flags; 4296 4297 dprintk("%d: suspend %d\n", btv->c.nr, state.event); 4298 4299 /* stop dma + irqs */ 4300 spin_lock_irqsave(&btv->s_lock,flags); 4301 memset(&idle, 0, sizeof(idle)); 4302 btv->state.video = btv->curr; 4303 btv->state.vbi = btv->cvbi; 4304 btv->state.loop_irq = btv->loop_irq; 4305 btv->curr = idle; 4306 btv->loop_irq = 0; 4307 bttv_buffer_activate_video(btv, &idle); 4308 bttv_buffer_activate_vbi(btv, NULL); 4309 bttv_set_dma(btv, 0); 4310 btwrite(0, BT848_INT_MASK); 4311 spin_unlock_irqrestore(&btv->s_lock,flags); 4312 4313 /* save bt878 state */ 4314 btv->state.gpio_enable = btread(BT848_GPIO_OUT_EN); 4315 btv->state.gpio_data = gpio_read(); 4316 4317 /* save pci state */ 4318 pci_save_state(pci_dev); 4319 if (0 != pci_set_power_state(pci_dev, pci_choose_state(pci_dev, state))) { 4320 pci_disable_device(pci_dev); 4321 btv->state.disabled = 1; 4322 } 4323 return 0; 4324 } 4325 4326 static int bttv_resume(struct pci_dev *pci_dev) 4327 { 4328 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev); 4329 struct bttv *btv = to_bttv(v4l2_dev); 4330 unsigned long flags; 4331 int err; 4332 4333 dprintk("%d: resume\n", btv->c.nr); 4334 4335 /* restore pci state */ 4336 if (btv->state.disabled) { 4337 err=pci_enable_device(pci_dev); 4338 if (err) { 4339 pr_warn("%d: Can't enable device\n", btv->c.nr); 4340 return err; 4341 } 4342 btv->state.disabled = 0; 4343 } 4344 err=pci_set_power_state(pci_dev, PCI_D0); 4345 if (err) { 4346 pci_disable_device(pci_dev); 4347 pr_warn("%d: Can't enable device\n", btv->c.nr); 4348 btv->state.disabled = 1; 4349 return err; 4350 } 4351 4352 pci_restore_state(pci_dev); 4353 4354 /* restore bt878 state */ 4355 bttv_reinit_bt848(btv); 4356 gpio_inout(0xffffff, btv->state.gpio_enable); 4357 gpio_write(btv->state.gpio_data); 4358 4359 /* restart dma */ 4360 spin_lock_irqsave(&btv->s_lock,flags); 4361 btv->curr = btv->state.video; 4362 btv->cvbi = btv->state.vbi; 4363 btv->loop_irq = btv->state.loop_irq; 4364 bttv_buffer_activate_video(btv, &btv->curr); 4365 bttv_buffer_activate_vbi(btv, btv->cvbi); 4366 bttv_set_dma(btv, 0); 4367 spin_unlock_irqrestore(&btv->s_lock,flags); 4368 return 0; 4369 } 4370 #endif 4371 4372 static struct pci_device_id bttv_pci_tbl[] = { 4373 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT848), 0}, 4374 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT849), 0}, 4375 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT878), 0}, 4376 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_BT879), 0}, 4377 {PCI_VDEVICE(BROOKTREE, PCI_DEVICE_ID_FUSION879), 0}, 4378 {0,} 4379 }; 4380 4381 MODULE_DEVICE_TABLE(pci, bttv_pci_tbl); 4382 4383 static struct pci_driver bttv_pci_driver = { 4384 .name = "bttv", 4385 .id_table = bttv_pci_tbl, 4386 .probe = bttv_probe, 4387 .remove = bttv_remove, 4388 #ifdef CONFIG_PM 4389 .suspend = bttv_suspend, 4390 .resume = bttv_resume, 4391 #endif 4392 }; 4393 4394 static int __init bttv_init_module(void) 4395 { 4396 int ret; 4397 4398 bttv_num = 0; 4399 4400 pr_info("driver version %s loaded\n", BTTV_VERSION); 4401 if (gbuffers < 2 || gbuffers > VIDEO_MAX_FRAME) 4402 gbuffers = 2; 4403 if (gbufsize > BTTV_MAX_FBUF) 4404 gbufsize = BTTV_MAX_FBUF; 4405 gbufsize = (gbufsize + PAGE_SIZE - 1) & PAGE_MASK; 4406 if (bttv_verbose) 4407 pr_info("using %d buffers with %dk (%d pages) each for capture\n", 4408 gbuffers, gbufsize >> 10, gbufsize >> PAGE_SHIFT); 4409 4410 bttv_check_chipset(); 4411 4412 ret = bus_register(&bttv_sub_bus_type); 4413 if (ret < 0) { 4414 pr_warn("bus_register error: %d\n", ret); 4415 return ret; 4416 } 4417 ret = pci_register_driver(&bttv_pci_driver); 4418 if (ret < 0) 4419 bus_unregister(&bttv_sub_bus_type); 4420 4421 return ret; 4422 } 4423 4424 static void __exit bttv_cleanup_module(void) 4425 { 4426 pci_unregister_driver(&bttv_pci_driver); 4427 bus_unregister(&bttv_sub_bus_type); 4428 } 4429 4430 module_init(bttv_init_module); 4431 module_exit(bttv_cleanup_module); 4432 4433 /* 4434 * Local variables: 4435 * c-basic-offset: 8 4436 * End: 4437 */ 4438