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

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