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

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