drivers/media/video/cx23885/cx23885-video.c

   1 /*
   2  *  Driver for the Conexant CX23885 PCIe bridge
   3  *
   4  *  Copyright (c) 2007 Steven Toth <stoth@linuxtv.org>
   5  *
   6  *  This program is free software; you can redistribute it and/or modify
   7  *  it under the terms of the GNU General Public License as published by
   8  *  the Free Software Foundation; either version 2 of the License, or
   9  *  (at your option) any later version.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *
  15  *  GNU General Public License for more details.
  16  *
  17  *  You should have received a copy of the GNU General Public License
  18  *  along with this program; if not, write to the Free Software
  19  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20  */
  21
  22 #include <linux/init.h>
  23 #include <linux/list.h>
  24 #include <linux/module.h>
  25 #include <linux/moduleparam.h>
  26 #include <linux/kmod.h>
  27 #include <linux/kernel.h>
  28 #include <linux/slab.h>
  29 #include <linux/interrupt.h>
  30 #include <linux/delay.h>
  31 #include <linux/kthread.h>
  32 #include <asm/div64.h>
  33
  34 #include "cx23885.h"
  35 #include <media/v4l2-common.h>
  36 #include <media/v4l2-ioctl.h>
  37 #include "cx23885-ioctl.h"
  38 #include "tuner-xc2028.h"
  39
  40 #include <media/cx25840.h>
  41
  42 MODULE_DESCRIPTION("v4l2 driver module for cx23885 based TV cards");
  43 MODULE_AUTHOR("Steven Toth <stoth@linuxtv.org>");
  44 MODULE_LICENSE("GPL");
  45
  46 /* ------------------------------------------------------------------ */
  47
  48 static unsigned int video_nr[] = {[0 ... (CX23885_MAXBOARDS - 1)] = UNSET };
  49 static unsigned int vbi_nr[]   = {[0 ... (CX23885_MAXBOARDS - 1)] = UNSET };
  50 static unsigned int radio_nr[] = {[0 ... (CX23885_MAXBOARDS - 1)] = UNSET };
  51
  52 module_param_array(video_nr, int, NULL, 0444);
  53 module_param_array(vbi_nr,   int, NULL, 0444);
  54 module_param_array(radio_nr, int, NULL, 0444);
  55
  56 MODULE_PARM_DESC(video_nr, "video device numbers");
  57 MODULE_PARM_DESC(vbi_nr, "vbi device numbers");
  58 MODULE_PARM_DESC(radio_nr, "radio device numbers");
  59
  60 static unsigned int video_debug;
  61 module_param(video_debug, int, 0644);
  62 MODULE_PARM_DESC(video_debug, "enable debug messages [video]");
  63
  64 static unsigned int irq_debug;
  65 module_param(irq_debug, int, 0644);
  66 MODULE_PARM_DESC(irq_debug, "enable debug messages [IRQ handler]");
  67
  68 static unsigned int vid_limit = 16;
  69 module_param(vid_limit, int, 0644);
  70 MODULE_PARM_DESC(vid_limit, "capture memory limit in megabytes");
  71
  72 #define dprintk(level, fmt, arg...)\
  73         do { if (video_debug >= level)\
  74                 printk(KERN_DEBUG "%s: " fmt, dev->name, ## arg);\
  75         } while (0)
  76
  77 /* ------------------------------------------------------------------- */
  78 /* static data                                                         */
  79
  80 #define FORMAT_FLAGS_PACKED       0x01
  81 #if 0
  82 static struct cx23885_fmt formats[] = {
  83         {
  84                 .name     = "8 bpp, gray",
  85                 .fourcc   = V4L2_PIX_FMT_GREY,
  86                 .depth    = 8,
  87                 .flags    = FORMAT_FLAGS_PACKED,
  88         }, {
  89                 .name     = "15 bpp RGB, le",
  90                 .fourcc   = V4L2_PIX_FMT_RGB555,
  91                 .depth    = 16,
  92                 .flags    = FORMAT_FLAGS_PACKED,
  93         }, {
  94                 .name     = "15 bpp RGB, be",
  95                 .fourcc   = V4L2_PIX_FMT_RGB555X,
  96                 .depth    = 16,
  97                 .flags    = FORMAT_FLAGS_PACKED,
  98         }, {
  99                 .name     = "16 bpp RGB, le",
 100                 .fourcc   = V4L2_PIX_FMT_RGB565,
 101                 .depth    = 16,
 102                 .flags    = FORMAT_FLAGS_PACKED,
 103         }, {
 104                 .name     = "16 bpp RGB, be",
 105                 .fourcc   = V4L2_PIX_FMT_RGB565X,
 106                 .depth    = 16,
 107                 .flags    = FORMAT_FLAGS_PACKED,
 108         }, {
 109                 .name     = "24 bpp RGB, le",
 110                 .fourcc   = V4L2_PIX_FMT_BGR24,
 111                 .depth    = 24,
 112                 .flags    = FORMAT_FLAGS_PACKED,
 113         }, {
 114                 .name     = "32 bpp RGB, le",
 115                 .fourcc   = V4L2_PIX_FMT_BGR32,
 116                 .depth    = 32,
 117                 .flags    = FORMAT_FLAGS_PACKED,
 118         }, {
 119                 .name     = "32 bpp RGB, be",
 120                 .fourcc   = V4L2_PIX_FMT_RGB32,
 121                 .depth    = 32,
 122                 .flags    = FORMAT_FLAGS_PACKED,
 123         }, {
 124                 .name     = "4:2:2, packed, YUYV",
 125                 .fourcc   = V4L2_PIX_FMT_YUYV,
 126                 .depth    = 16,
 127                 .flags    = FORMAT_FLAGS_PACKED,
 128         }, {
 129                 .name     = "4:2:2, packed, UYVY",
 130                 .fourcc   = V4L2_PIX_FMT_UYVY,
 131                 .depth    = 16,
 132                 .flags    = FORMAT_FLAGS_PACKED,
 133         },
 134 };
 135 #else
 136 static struct cx23885_fmt formats[] = {
 137         {
 138 #if 0
 139                 .name     = "4:2:2, packed, UYVY",
 140                 .fourcc   = V4L2_PIX_FMT_UYVY,
 141                 .depth    = 16,
 142                 .flags    = FORMAT_FLAGS_PACKED,
 143         }, {
 144 #endif
 145                 .name     = "4:2:2, packed, YUYV",
 146                 .fourcc   = V4L2_PIX_FMT_YUYV,
 147                 .depth    = 16,
 148                 .flags    = FORMAT_FLAGS_PACKED,
 149         }
 150 };
 151 #endif
 152
 153 static struct cx23885_fmt *format_by_fourcc(unsigned int fourcc)
 154 {
 155         unsigned int i;
 156
 157         for (i = 0; i < ARRAY_SIZE(formats); i++)
 158                 if (formats[i].fourcc == fourcc)
 159                         return formats+i;
 160
 161         printk(KERN_ERR "%s(%c%c%c%c) NOT FOUND\n", __func__,
 162                 (fourcc & 0xff),
 163                 ((fourcc >> 8) & 0xff),
 164                 ((fourcc >> 16) & 0xff),
 165                 ((fourcc >> 24) & 0xff)
 166                 );
 167         return NULL;
 168 }
 169
 170 /* ------------------------------------------------------------------- */
 171
 172 static const struct v4l2_queryctrl no_ctl = {
 173         .name  = "42",
 174         .flags = V4L2_CTRL_FLAG_DISABLED,
 175 };
 176
 177 static struct cx23885_ctrl cx23885_ctls[] = {
 178         /* --- video --- */
 179         {
 180                 .v = {
 181                         .id            = V4L2_CID_BRIGHTNESS,
 182                         .name          = "Brightness",
 183                         .minimum       = 0x00,
 184                         .maximum       = 0xff,
 185                         .step          = 1,
 186                         .default_value = 0x7f,
 187                         .type          = V4L2_CTRL_TYPE_INTEGER,
 188                 },
 189                 .off                   = 128,
 190                 .reg                   = LUMA_CTRL,
 191                 .mask                  = 0x00ff,
 192                 .shift                 = 0,
 193         }, {
 194                 .v = {
 195                         .id            = V4L2_CID_CONTRAST,
 196                         .name          = "Contrast",
 197                         .minimum       = 0,
 198                         .maximum       = 0x7f,
 199                         .step          = 1,
 200                         .default_value = 0x3f,
 201                         .type          = V4L2_CTRL_TYPE_INTEGER,
 202                 },
 203                 .off                   = 0,
 204                 .reg                   = LUMA_CTRL,
 205                 .mask                  = 0xff00,
 206                 .shift                 = 8,
 207         }, {
 208                 .v = {
 209                         .id            = V4L2_CID_HUE,
 210                         .name          = "Hue",
 211                         .minimum       = -127,
 212                         .maximum       = 128,
 213                         .step          = 1,
 214                         .default_value = 0x0,
 215                         .type          = V4L2_CTRL_TYPE_INTEGER,
 216                 },
 217                 .off                   = 128,
 218                 .reg                   = CHROMA_CTRL,
 219                 .mask                  = 0xff0000,
 220                 .shift                 = 16,
 221         }, {
 222                 /* strictly, this only describes only U saturation.
 223                  * V saturation is handled specially through code.
 224                  */
 225                 .v = {
 226                         .id            = V4L2_CID_SATURATION,
 227                         .name          = "Saturation",
 228                         .minimum       = 0,
 229                         .maximum       = 0x7f,
 230                         .step          = 1,
 231                         .default_value = 0x3f,
 232                         .type          = V4L2_CTRL_TYPE_INTEGER,
 233                 },
 234                 .off                   = 0,
 235                 .reg                   = CHROMA_CTRL,
 236                 .mask                  = 0x00ff,
 237                 .shift                 = 0,
 238         }, {
 239         /* --- audio --- */
 240                 .v = {
 241                         .id            = V4L2_CID_AUDIO_MUTE,
 242                         .name          = "Mute",
 243                         .minimum       = 0,
 244                         .maximum       = 1,
 245                         .default_value = 1,
 246                         .type          = V4L2_CTRL_TYPE_BOOLEAN,
 247                 },
 248                 .reg                   = PATH1_CTL1,
 249                 .mask                  = (0x1f << 24),
 250                 .shift                 = 24,
 251         }, {
 252                 .v = {
 253                         .id            = V4L2_CID_AUDIO_VOLUME,
 254                         .name          = "Volume",
 255                         .minimum       = 0,
 256                         .maximum       = 0x3f,
 257                         .step          = 1,
 258                         .default_value = 0x3f,
 259                         .type          = V4L2_CTRL_TYPE_INTEGER,
 260                 },
 261                 .reg                   = PATH1_VOL_CTL,
 262                 .mask                  = 0xff,
 263                 .shift                 = 0,
 264         }
 265 };
 266 static const int CX23885_CTLS = ARRAY_SIZE(cx23885_ctls);
 267
 268 /* Must be sorted from low to high control ID! */
 269 static const u32 cx23885_user_ctrls[] = {
 270         V4L2_CID_USER_CLASS,
 271         V4L2_CID_BRIGHTNESS,
 272         V4L2_CID_CONTRAST,
 273         V4L2_CID_SATURATION,
 274         V4L2_CID_HUE,
 275         V4L2_CID_AUDIO_VOLUME,
 276         V4L2_CID_AUDIO_MUTE,
 277         0
 278 };
 279
 280 static const u32 *ctrl_classes[] = {
 281         cx23885_user_ctrls,
 282         NULL
 283 };
 284
 285 void cx23885_video_wakeup(struct cx23885_dev *dev,
 286         struct cx23885_dmaqueue *q, u32 count)
 287 {
 288         struct cx23885_buffer *buf;
 289         int bc;
 290
 291         for (bc = 0;; bc++) {
 292                 if (list_empty(&q->active))
 293                         break;
 294                 buf = list_entry(q->active.next,
 295                                  struct cx23885_buffer, vb.queue);
 296
 297                 /* count comes from the hw and is is 16bit wide --
 298                  * this trick handles wrap-arounds correctly for
 299                  * up to 32767 buffers in flight... */
 300                 if ((s16) (count - buf->count) < 0)
 301                         break;
 302
 303                 do_gettimeofday(&buf->vb.ts);
 304                 dprintk(2, "[%p/%d] wakeup reg=%d buf=%d\n", buf, buf->vb.i,
 305                         count, buf->count);
 306                 buf->vb.state = VIDEOBUF_DONE;
 307                 list_del(&buf->vb.queue);
 308                 wake_up(&buf->vb.done);
 309         }
 310         if (list_empty(&q->active))
 311                 del_timer(&q->timeout);
 312         else
 313                 mod_timer(&q->timeout, jiffies+BUFFER_TIMEOUT);
 314         if (bc != 1)
 315                 printk(KERN_ERR "%s: %d buffers handled (should be 1)\n",
 316                         __func__, bc);
 317 }
 318
 319 static int cx23885_set_tvnorm(struct cx23885_dev *dev, v4l2_std_id norm)
 320 {
 321         dprintk(1, "%s(norm = 0x%08x) name: [%s]\n",
 322                 __func__,
 323                 (unsigned int)norm,
 324                 v4l2_norm_to_name(norm));
 325
 326         dev->tvnorm = norm;
 327
 328         call_all(dev, core, s_std, norm);
 329
 330         return 0;
 331 }
 332
 333 static struct video_device *cx23885_vdev_init(struct cx23885_dev *dev,
 334                                     struct pci_dev *pci,
 335                                     struct video_device *template,
 336                                     char *type)
 337 {
 338         struct video_device *vfd;
 339         dprintk(1, "%s()\n", __func__);
 340
 341         vfd = video_device_alloc();
 342         if (NULL == vfd)
 343                 return NULL;
 344         *vfd = *template;
 345         vfd->v4l2_dev = &dev->v4l2_dev;
 346         vfd->release = video_device_release;
 347         snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)",
 348                  dev->name, type, cx23885_boards[dev->board].name);
 349         video_set_drvdata(vfd, dev);
 350         return vfd;
 351 }
 352
 353 static int cx23885_ctrl_query(struct v4l2_queryctrl *qctrl)
 354 {
 355         int i;
 356
 357         if (qctrl->id < V4L2_CID_BASE ||
 358             qctrl->id >= V4L2_CID_LASTP1)
 359                 return -EINVAL;
 360         for (i = 0; i < CX23885_CTLS; i++)
 361                 if (cx23885_ctls[i].v.id == qctrl->id)
 362                         break;
 363         if (i == CX23885_CTLS) {
 364                 *qctrl = no_ctl;
 365                 return 0;
 366         }
 367         *qctrl = cx23885_ctls[i].v;
 368         return 0;
 369 }
 370
 371 /* ------------------------------------------------------------------- */
 372 /* resource management                                                 */
 373
 374 static int res_get(struct cx23885_dev *dev, struct cx23885_fh *fh,
 375         unsigned int bit)
 376 {
 377         dprintk(1, "%s()\n", __func__);
 378         if (fh->resources & bit)
 379                 /* have it already allocated */
 380                 return 1;
 381
 382         /* is it free? */
 383         mutex_lock(&dev->lock);
 384         if (dev->resources & bit) {
 385                 /* no, someone else uses it */
 386                 mutex_unlock(&dev->lock);
 387                 return 0;
 388         }
 389         /* it's free, grab it */
 390         fh->resources  |= bit;
 391         dev->resources |= bit;
 392         dprintk(1, "res: get %d\n", bit);
 393         mutex_unlock(&dev->lock);
 394         return 1;
 395 }
 396
 397 static int res_check(struct cx23885_fh *fh, unsigned int bit)
 398 {
 399         return fh->resources & bit;
 400 }
 401
 402 static int res_locked(struct cx23885_dev *dev, unsigned int bit)
 403 {
 404         return dev->resources & bit;
 405 }
 406
 407 static void res_free(struct cx23885_dev *dev, struct cx23885_fh *fh,
 408         unsigned int bits)
 409 {
 410         BUG_ON((fh->resources & bits) != bits);
 411         dprintk(1, "%s()\n", __func__);
 412
 413         mutex_lock(&dev->lock);
 414         fh->resources  &= ~bits;
 415         dev->resources &= ~bits;
 416         dprintk(1, "res: put %d\n", bits);
 417         mutex_unlock(&dev->lock);
 418 }
 419
 420 static int cx23885_flatiron_write(struct cx23885_dev *dev, u8 reg, u8 data)
 421 {
 422         /* 8 bit registers, 8 bit values */
 423         u8 buf[] = { reg, data };
 424
 425         struct i2c_msg msg = { .addr = 0x98 >> 1,
 426                 .flags = 0, .buf = buf, .len = 2 };
 427
 428         return i2c_transfer(&dev->i2c_bus[2].i2c_adap, &msg, 1);
 429 }
 430
 431 static u8 cx23885_flatiron_read(struct cx23885_dev *dev, u8 reg)
 432 {
 433         /* 8 bit registers, 8 bit values */
 434         int ret;
 435         u8 b0[] = { reg };
 436         u8 b1[] = { 0 };
 437
 438         struct i2c_msg msg[] = {
 439                 { .addr = 0x98 >> 1, .flags = 0, .buf = b0, .len = 1 },
 440                 { .addr = 0x98 >> 1, .flags = I2C_M_RD, .buf = b1, .len = 1 }
 441         };
 442
 443         ret = i2c_transfer(&dev->i2c_bus[2].i2c_adap, &msg[0], 2);
 444         if (ret != 2)
 445                 printk(KERN_ERR "%s() error\n", __func__);
 446
 447         return b1[0];
 448 }
 449
 450 static void cx23885_flatiron_dump(struct cx23885_dev *dev)
 451 {
 452         int i;
 453         dprintk(1, "Flatiron dump\n");
 454         for (i = 0; i < 0x24; i++) {
 455                 dprintk(1, "FI[%02x] = %02x\n", i,
 456                         cx23885_flatiron_read(dev, i));
 457         }
 458 }
 459
 460 static int cx23885_flatiron_mux(struct cx23885_dev *dev, int input)
 461 {
 462         u8 val;
 463         dprintk(1, "%s(input = %d)\n", __func__, input);
 464
 465         if (input == 1)
 466                 val = cx23885_flatiron_read(dev, CH_PWR_CTRL1) & ~FLD_CH_SEL;
 467         else if (input == 2)
 468                 val = cx23885_flatiron_read(dev, CH_PWR_CTRL1) | FLD_CH_SEL;
 469         else
 470                 return -EINVAL;
 471
 472         val |= 0x20; /* Enable clock to delta-sigma and dec filter */
 473
 474         cx23885_flatiron_write(dev, CH_PWR_CTRL1, val);
 475
 476         /* Wake up */
 477         cx23885_flatiron_write(dev, CH_PWR_CTRL2, 0);
 478
 479         if (video_debug)
 480                 cx23885_flatiron_dump(dev);
 481
 482         return 0;
 483 }
 484
 485 static int cx23885_video_mux(struct cx23885_dev *dev, unsigned int input)
 486 {
 487         dprintk(1, "%s() video_mux: %d [vmux=%d, gpio=0x%x,0x%x,0x%x,0x%x]\n",
 488                 __func__,
 489                 input, INPUT(input)->vmux,
 490                 INPUT(input)->gpio0, INPUT(input)->gpio1,
 491                 INPUT(input)->gpio2, INPUT(input)->gpio3);
 492         dev->input = input;
 493
 494         if (dev->board == CX23885_BOARD_MYGICA_X8506 ||
 495                 dev->board == CX23885_BOARD_MAGICPRO_PROHDTVE2) {
 496                 /* Select Analog TV */
 497                 if (INPUT(input)->type == CX23885_VMUX_TELEVISION)
 498                         cx23885_gpio_clear(dev, GPIO_0);
 499         }
 500
 501         /* Tell the internal A/V decoder */
 502         v4l2_subdev_call(dev->sd_cx25840, video, s_routing,
 503                         INPUT(input)->vmux, 0, 0);
 504
 505         if ((dev->board == CX23885_BOARD_HAUPPAUGE_HVR1800) ||
 506                 (dev->board == CX23885_BOARD_MPX885)) {
 507                 /* Configure audio routing */
 508                 v4l2_subdev_call(dev->sd_cx25840, audio, s_routing,
 509                         INPUT(input)->amux, 0, 0);
 510
 511                 if (INPUT(input)->amux == CX25840_AUDIO7)
 512                         cx23885_flatiron_mux(dev, 1);
 513                 else if (INPUT(input)->amux == CX25840_AUDIO6)
 514                         cx23885_flatiron_mux(dev, 2);
 515         }
 516
 517         return 0;
 518 }
 519
 520 static int cx23885_audio_mux(struct cx23885_dev *dev, unsigned int input)
 521 {
 522         dprintk(1, "%s(input=%d)\n", __func__, input);
 523
 524         /* The baseband video core of the cx23885 has two audio inputs.
 525          * LR1 and LR2. In almost every single case so far only HVR1xxx
 526          * cards we've only ever supported LR1. Time to support LR2,
 527          * which is available via the optional white breakout header on
 528          * the board.
 529          * We'll use a could of existing enums in the card struct to allow
 530          * devs to specify which baseband input they need, or just default
 531          * to what we've always used.
 532          */
 533         if (INPUT(input)->amux == CX25840_AUDIO7)
 534                 cx23885_flatiron_mux(dev, 1);
 535         else if (INPUT(input)->amux == CX25840_AUDIO6)
 536                 cx23885_flatiron_mux(dev, 2);
 537         else {
 538                 /* Not specifically defined, assume the default. */
 539                 cx23885_flatiron_mux(dev, 1);
 540         }
 541
 542         return 0;
 543 }
 544
 545 /* ------------------------------------------------------------------ */
 546 static int cx23885_start_video_dma(struct cx23885_dev *dev,
 547                            struct cx23885_dmaqueue *q,
 548                            struct cx23885_buffer *buf)
 549 {
 550         dprintk(1, "%s()\n", __func__);
 551
 552         /* Stop the dma/fifo before we tamper with it's risc programs */
 553         cx_clear(VID_A_DMA_CTL, 0x11);
 554
 555         /* setup fifo + format */
 556         cx23885_sram_channel_setup(dev, &dev->sram_channels[SRAM_CH01],
 557                                 buf->bpl, buf->risc.dma);
 558
 559         /* reset counter */
 560         cx_write(VID_A_GPCNT_CTL, 3);
 561         q->count = 1;
 562
 563         /* enable irq */
 564         cx23885_irq_add_enable(dev, 0x01);
 565         cx_set(VID_A_INT_MSK, 0x000011);
 566
 567         /* start dma */
 568         cx_set(DEV_CNTRL2, (1<<5));
 569         cx_set(VID_A_DMA_CTL, 0x11); /* FIFO and RISC enable */
 570
 571         return 0;
 572 }
 573
 574
 575 static int cx23885_restart_video_queue(struct cx23885_dev *dev,
 576                                struct cx23885_dmaqueue *q)
 577 {
 578         struct cx23885_buffer *buf, *prev;
 579         struct list_head *item;
 580         dprintk(1, "%s()\n", __func__);
 581
 582         if (!list_empty(&q->active)) {
 583                 buf = list_entry(q->active.next, struct cx23885_buffer,
 584                         vb.queue);
 585                 dprintk(2, "restart_queue [%p/%d]: restart dma\n",
 586                         buf, buf->vb.i);
 587                 cx23885_start_video_dma(dev, q, buf);
 588                 list_for_each(item, &q->active) {
 589                         buf = list_entry(item, struct cx23885_buffer,
 590                                 vb.queue);
 591                         buf->count    = q->count++;
 592                 }
 593                 mod_timer(&q->timeout, jiffies+BUFFER_TIMEOUT);
 594                 return 0;
 595         }
 596
 597         prev = NULL;
 598         for (;;) {
 599                 if (list_empty(&q->queued))
 600                         return 0;
 601                 buf = list_entry(q->queued.next, struct cx23885_buffer,
 602                         vb.queue);
 603                 if (NULL == prev) {
 604                         list_move_tail(&buf->vb.queue, &q->active);
 605                         cx23885_start_video_dma(dev, q, buf);
 606                         buf->vb.state = VIDEOBUF_ACTIVE;
 607                         buf->count    = q->count++;
 608                         mod_timer(&q->timeout, jiffies+BUFFER_TIMEOUT);
 609                         dprintk(2, "[%p/%d] restart_queue - first active\n",
 610                                 buf, buf->vb.i);
 611
 612                 } else if (prev->vb.width  == buf->vb.width  &&
 613                            prev->vb.height == buf->vb.height &&
 614                            prev->fmt       == buf->fmt) {
 615                         list_move_tail(&buf->vb.queue, &q->active);
 616                         buf->vb.state = VIDEOBUF_ACTIVE;
 617                         buf->count    = q->count++;
 618                         prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
 619                         prev->risc.jmp[2] = cpu_to_le32(0); /* Bits 63 - 32 */
 620                         dprintk(2, "[%p/%d] restart_queue - move to active\n",
 621                                 buf, buf->vb.i);
 622                 } else {
 623                         return 0;
 624                 }
 625                 prev = buf;
 626         }
 627 }
 628
 629 static int buffer_setup(struct videobuf_queue *q, unsigned int *count,
 630         unsigned int *size)
 631 {
 632         struct cx23885_fh *fh = q->priv_data;
 633
 634         *size = fh->fmt->depth*fh->width*fh->height >> 3;
 635         if (0 == *count)
 636                 *count = 32;
 637         if (*size * *count > vid_limit * 1024 * 1024)
 638                 *count = (vid_limit * 1024 * 1024) / *size;
 639         return 0;
 640 }
 641
 642 static int buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
 643                enum v4l2_field field)
 644 {
 645         struct cx23885_fh *fh  = q->priv_data;
 646         struct cx23885_dev *dev = fh->dev;
 647         struct cx23885_buffer *buf =
 648                 container_of(vb, struct cx23885_buffer, vb);
 649         int rc, init_buffer = 0;
 650         u32 line0_offset, line1_offset;
 651         struct videobuf_dmabuf *dma = videobuf_to_dma(&buf->vb);
 652
 653         BUG_ON(NULL == fh->fmt);
 654         if (fh->width  < 48 || fh->width  > norm_maxw(dev->tvnorm) ||
 655             fh->height < 32 || fh->height > norm_maxh(dev->tvnorm))
 656                 return -EINVAL;
 657         buf->vb.size = (fh->width * fh->height * fh->fmt->depth) >> 3;
 658         if (0 != buf->vb.baddr  &&  buf->vb.bsize < buf->vb.size)
 659                 return -EINVAL;
 660
 661         if (buf->fmt       != fh->fmt    ||
 662             buf->vb.width  != fh->width  ||
 663             buf->vb.height != fh->height ||
 664             buf->vb.field  != field) {
 665                 buf->fmt       = fh->fmt;
 666                 buf->vb.width  = fh->width;
 667                 buf->vb.height = fh->height;
 668                 buf->vb.field  = field;
 669                 init_buffer = 1;
 670         }
 671
 672         if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {
 673                 init_buffer = 1;
 674                 rc = videobuf_iolock(q, &buf->vb, NULL);
 675                 if (0 != rc)
 676                         goto fail;
 677         }
 678
 679         if (init_buffer) {
 680                 buf->bpl = buf->vb.width * buf->fmt->depth >> 3;
 681                 switch (buf->vb.field) {
 682                 case V4L2_FIELD_TOP:
 683                         cx23885_risc_buffer(dev->pci, &buf->risc,
 684                                          dma->sglist, 0, UNSET,
 685                                          buf->bpl, 0, buf->vb.height);
 686                         break;
 687                 case V4L2_FIELD_BOTTOM:
 688                         cx23885_risc_buffer(dev->pci, &buf->risc,
 689                                          dma->sglist, UNSET, 0,
 690                                          buf->bpl, 0, buf->vb.height);
 691                         break;
 692                 case V4L2_FIELD_INTERLACED:
 693                         if (dev->tvnorm & V4L2_STD_NTSC) {
 694                                 /* cx25840 transmits NTSC bottom field first */
 695                                 dprintk(1, "%s() Creating NTSC risc\n",
 696                                         __func__);
 697                                 line0_offset = buf->bpl;
 698                                 line1_offset = 0;
 699                         } else {
 700                                 /* All other formats are top field first */
 701                                 dprintk(1, "%s() Creating PAL/SECAM risc\n",
 702                                         __func__);
 703                                 line0_offset = 0;
 704                                 line1_offset = buf->bpl;
 705                         }
 706                         cx23885_risc_buffer(dev->pci, &buf->risc,
 707                                         dma->sglist, line0_offset,
 708                                         line1_offset,
 709                                         buf->bpl, buf->bpl,
 710                                         buf->vb.height >> 1);
 711                         break;
 712                 case V4L2_FIELD_SEQ_TB:
 713                         cx23885_risc_buffer(dev->pci, &buf->risc,
 714                                          dma->sglist,
 715                                          0, buf->bpl * (buf->vb.height >> 1),
 716                                          buf->bpl, 0,
 717                                          buf->vb.height >> 1);
 718                         break;
 719                 case V4L2_FIELD_SEQ_BT:
 720                         cx23885_risc_buffer(dev->pci, &buf->risc,
 721                                          dma->sglist,
 722                                          buf->bpl * (buf->vb.height >> 1), 0,
 723                                          buf->bpl, 0,
 724                                          buf->vb.height >> 1);
 725                         break;
 726                 default:
 727                         BUG();
 728                 }
 729         }
 730         dprintk(2, "[%p/%d] buffer_prep - %dx%d %dbpp \"%s\" - dma=0x%08lx\n",
 731                 buf, buf->vb.i,
 732                 fh->width, fh->height, fh->fmt->depth, fh->fmt->name,
 733                 (unsigned long)buf->risc.dma);
 734
 735         buf->vb.state = VIDEOBUF_PREPARED;
 736         return 0;
 737
 738  fail:
 739         cx23885_free_buffer(q, buf);
 740         return rc;
 741 }
 742
 743 static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb)
 744 {
 745         struct cx23885_buffer   *buf = container_of(vb,
 746                 struct cx23885_buffer, vb);
 747         struct cx23885_buffer   *prev;
 748         struct cx23885_fh       *fh   = vq->priv_data;
 749         struct cx23885_dev      *dev  = fh->dev;
 750         struct cx23885_dmaqueue *q    = &dev->vidq;
 751
 752         /* add jump to stopper */
 753         buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP | RISC_IRQ1 | RISC_CNT_INC);
 754         buf->risc.jmp[1] = cpu_to_le32(q->stopper.dma);
 755         buf->risc.jmp[2] = cpu_to_le32(0); /* bits 63-32 */
 756
 757         if (!list_empty(&q->queued)) {
 758                 list_add_tail(&buf->vb.queue, &q->queued);
 759                 buf->vb.state = VIDEOBUF_QUEUED;
 760                 dprintk(2, "[%p/%d] buffer_queue - append to queued\n",
 761                         buf, buf->vb.i);
 762
 763         } else if (list_empty(&q->active)) {
 764                 list_add_tail(&buf->vb.queue, &q->active);
 765                 cx23885_start_video_dma(dev, q, buf);
 766                 buf->vb.state = VIDEOBUF_ACTIVE;
 767                 buf->count    = q->count++;
 768                 mod_timer(&q->timeout, jiffies+BUFFER_TIMEOUT);
 769                 dprintk(2, "[%p/%d] buffer_queue - first active\n",
 770                         buf, buf->vb.i);
 771
 772         } else {
 773                 prev = list_entry(q->active.prev, struct cx23885_buffer,
 774                         vb.queue);
 775                 if (prev->vb.width  == buf->vb.width  &&
 776                     prev->vb.height == buf->vb.height &&
 777                     prev->fmt       == buf->fmt) {
 778                         list_add_tail(&buf->vb.queue, &q->active);
 779                         buf->vb.state = VIDEOBUF_ACTIVE;
 780                         buf->count    = q->count++;
 781                         prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
 782                         /* 64 bit bits 63-32 */
 783                         prev->risc.jmp[2] = cpu_to_le32(0);
 784                         dprintk(2, "[%p/%d] buffer_queue - append to active\n",
 785                                 buf, buf->vb.i);
 786
 787                 } else {
 788                         list_add_tail(&buf->vb.queue, &q->queued);
 789                         buf->vb.state = VIDEOBUF_QUEUED;
 790                         dprintk(2, "[%p/%d] buffer_queue - first queued\n",
 791                                 buf, buf->vb.i);
 792                 }
 793         }
 794 }
 795
 796 static void buffer_release(struct videobuf_queue *q,
 797         struct videobuf_buffer *vb)
 798 {
 799         struct cx23885_buffer *buf = container_of(vb,
 800                 struct cx23885_buffer, vb);
 801
 802         cx23885_free_buffer(q, buf);
 803 }
 804
 805 static struct videobuf_queue_ops cx23885_video_qops = {
 806         .buf_setup    = buffer_setup,
 807         .buf_prepare  = buffer_prepare,
 808         .buf_queue    = buffer_queue,
 809         .buf_release  = buffer_release,
 810 };
 811
 812 static struct videobuf_queue *get_queue(struct cx23885_fh *fh)
 813 {
 814         switch (fh->type) {
 815         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 816                 return &fh->vidq;
 817         case V4L2_BUF_TYPE_VBI_CAPTURE:
 818                 return &fh->vbiq;
 819         default:
 820                 BUG();
 821                 return NULL;
 822         }
 823 }
 824
 825 static int get_resource(struct cx23885_fh *fh)
 826 {
 827         switch (fh->type) {
 828         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 829                 return RESOURCE_VIDEO;
 830         case V4L2_BUF_TYPE_VBI_CAPTURE:
 831                 return RESOURCE_VBI;
 832         default:
 833                 BUG();
 834                 return 0;
 835         }
 836 }
 837
 838 static int video_open(struct file *file)
 839 {
 840         struct video_device *vdev = video_devdata(file);
 841         struct cx23885_dev *dev = video_drvdata(file);
 842         struct cx23885_fh *fh;
 843         enum v4l2_buf_type type = 0;
 844         int radio = 0;
 845
 846         switch (vdev->vfl_type) {
 847         case VFL_TYPE_GRABBER:
 848                 type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 849                 break;
 850         case VFL_TYPE_VBI:
 851                 type = V4L2_BUF_TYPE_VBI_CAPTURE;
 852                 break;
 853         case VFL_TYPE_RADIO:
 854                 radio = 1;
 855                 break;
 856         }
 857
 858         dprintk(1, "open dev=%s radio=%d type=%s\n",
 859                 video_device_node_name(vdev), radio, v4l2_type_names[type]);
 860
 861         /* allocate + initialize per filehandle data */
 862         fh = kzalloc(sizeof(*fh), GFP_KERNEL);
 863         if (NULL == fh)
 864                 return -ENOMEM;
 865
 866         file->private_data = fh;
 867         fh->dev      = dev;
 868         fh->radio    = radio;
 869         fh->type     = type;
 870         fh->width    = 320;
 871         fh->height   = 240;
 872         fh->fmt      = format_by_fourcc(V4L2_PIX_FMT_YUYV);
 873
 874         videobuf_queue_sg_init(&fh->vidq, &cx23885_video_qops,
 875                             &dev->pci->dev, &dev->slock,
 876                             V4L2_BUF_TYPE_VIDEO_CAPTURE,
 877                             V4L2_FIELD_INTERLACED,
 878                             sizeof(struct cx23885_buffer),
 879                             fh, NULL);
 880
 881         videobuf_queue_sg_init(&fh->vbiq, &cx23885_vbi_qops,
 882                 &dev->pci->dev, &dev->slock,
 883                 V4L2_BUF_TYPE_VBI_CAPTURE,
 884                 V4L2_FIELD_SEQ_TB,
 885                 sizeof(struct cx23885_buffer),
 886                 fh, NULL);
 887
 888
 889         dprintk(1, "post videobuf_queue_init()\n");
 890
 891         return 0;
 892 }
 893
 894 static ssize_t video_read(struct file *file, char __user *data,
 895         size_t count, loff_t *ppos)
 896 {
 897         struct cx23885_fh *fh = file->private_data;
 898
 899         switch (fh->type) {
 900         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 901                 if (res_locked(fh->dev, RESOURCE_VIDEO))
 902                         return -EBUSY;
 903                 return videobuf_read_one(&fh->vidq, data, count, ppos,
 904                                          file->f_flags & O_NONBLOCK);
 905         case V4L2_BUF_TYPE_VBI_CAPTURE:
 906                 if (!res_get(fh->dev, fh, RESOURCE_VBI))
 907                         return -EBUSY;
 908                 return videobuf_read_stream(&fh->vbiq, data, count, ppos, 1,
 909                                             file->f_flags & O_NONBLOCK);
 910         default:
 911                 BUG();
 912                 return 0;
 913         }
 914 }
 915
 916 static unsigned int video_poll(struct file *file,
 917         struct poll_table_struct *wait)
 918 {
 919         struct cx23885_fh *fh = file->private_data;
 920         struct cx23885_buffer *buf;
 921         unsigned int rc = POLLERR;
 922
 923         if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type) {
 924                 if (!res_get(fh->dev, fh, RESOURCE_VBI))
 925                         return POLLERR;
 926                 return videobuf_poll_stream(file, &fh->vbiq, wait);
 927         }
 928
 929         mutex_lock(&fh->vidq.vb_lock);
 930         if (res_check(fh, RESOURCE_VIDEO)) {
 931                 /* streaming capture */
 932                 if (list_empty(&fh->vidq.stream))
 933                         goto done;
 934                 buf = list_entry(fh->vidq.stream.next,
 935                         struct cx23885_buffer, vb.stream);
 936         } else {
 937                 /* read() capture */
 938                 buf = (struct cx23885_buffer *)fh->vidq.read_buf;
 939                 if (NULL == buf)
 940                         goto done;
 941         }
 942         poll_wait(file, &buf->vb.done, wait);
 943         if (buf->vb.state == VIDEOBUF_DONE ||
 944             buf->vb.state == VIDEOBUF_ERROR)
 945                 rc =  POLLIN|POLLRDNORM;
 946         else
 947                 rc = 0;
 948 done:
 949         mutex_unlock(&fh->vidq.vb_lock);
 950         return rc;
 951 }
 952
 953 static int video_release(struct file *file)
 954 {
 955         struct cx23885_fh *fh = file->private_data;
 956         struct cx23885_dev *dev = fh->dev;
 957
 958         /* turn off overlay */
 959         if (res_check(fh, RESOURCE_OVERLAY)) {
 960                 /* FIXME */
 961                 res_free(dev, fh, RESOURCE_OVERLAY);
 962         }
 963
 964         /* stop video capture */
 965         if (res_check(fh, RESOURCE_VIDEO)) {
 966                 videobuf_queue_cancel(&fh->vidq);
 967                 res_free(dev, fh, RESOURCE_VIDEO);
 968         }
 969         if (fh->vidq.read_buf) {
 970                 buffer_release(&fh->vidq, fh->vidq.read_buf);
 971                 kfree(fh->vidq.read_buf);
 972         }
 973
 974         /* stop vbi capture */
 975         if (res_check(fh, RESOURCE_VBI)) {
 976                 if (fh->vbiq.streaming)
 977                         videobuf_streamoff(&fh->vbiq);
 978                 if (fh->vbiq.reading)
 979                         videobuf_read_stop(&fh->vbiq);
 980                 res_free(dev, fh, RESOURCE_VBI);
 981         }
 982
 983         videobuf_mmap_free(&fh->vidq);
 984         file->private_data = NULL;
 985         kfree(fh);
 986
 987         /* We are not putting the tuner to sleep here on exit, because
 988          * we want to use the mpeg encoder in another session to capture
 989          * tuner video. Closing this will result in no video to the encoder.
 990          */
 991
 992         return 0;
 993 }
 994
 995 static int video_mmap(struct file *file, struct vm_area_struct *vma)
 996 {
 997         struct cx23885_fh *fh = file->private_data;
 998
 999         return videobuf_mmap_mapper(get_queue(fh), vma);
1000 }
1001
1002 /* ------------------------------------------------------------------ */
1003 /* VIDEO CTRL IOCTLS                                                  */
1004
1005 static int cx23885_get_control(struct cx23885_dev *dev,
1006         struct v4l2_control *ctl)
1007 {
1008         dprintk(1, "%s() calling cx25840(VIDIOC_G_CTRL)\n", __func__);
1009         call_all(dev, core, g_ctrl, ctl);
1010         return 0;
1011 }
1012
1013 static int cx23885_set_control(struct cx23885_dev *dev,
1014         struct v4l2_control *ctl)
1015 {
1016         dprintk(1, "%s() calling cx25840(VIDIOC_S_CTRL)\n", __func__);
1017         call_all(dev, core, s_ctrl, ctl);
1018
1019         return 0;
1020 }
1021
1022 static void init_controls(struct cx23885_dev *dev)
1023 {
1024         struct v4l2_control ctrl;
1025         int i;
1026
1027         for (i = 0; i < CX23885_CTLS; i++) {
1028                 ctrl.id = cx23885_ctls[i].v.id;
1029                 ctrl.value = cx23885_ctls[i].v.default_value;
1030
1031                 cx23885_set_control(dev, &ctrl);
1032         }
1033 }
1034
1035 /* ------------------------------------------------------------------ */
1036 /* VIDEO IOCTLS                                                       */
1037
1038 static int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
1039         struct v4l2_format *f)
1040 {
1041         struct cx23885_fh *fh   = priv;
1042
1043         f->fmt.pix.width        = fh->width;
1044         f->fmt.pix.height       = fh->height;
1045         f->fmt.pix.field        = fh->vidq.field;
1046         f->fmt.pix.pixelformat  = fh->fmt->fourcc;
1047         f->fmt.pix.bytesperline =
1048                 (f->fmt.pix.width * fh->fmt->depth) >> 3;
1049         f->fmt.pix.sizeimage =
1050                 f->fmt.pix.height * f->fmt.pix.bytesperline;
1051
1052         return 0;
1053 }
1054
1055 static int vidioc_try_fmt_vid_cap(struct file *file, void *priv,
1056         struct v4l2_format *f)
1057 {
1058         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1059         struct cx23885_fmt *fmt;
1060         enum v4l2_field   field;
1061         unsigned int      maxw, maxh;
1062
1063         fmt = format_by_fourcc(f->fmt.pix.pixelformat);
1064         if (NULL == fmt)
1065                 return -EINVAL;
1066
1067         field = f->fmt.pix.field;
1068         maxw  = norm_maxw(dev->tvnorm);
1069         maxh  = norm_maxh(dev->tvnorm);
1070
1071         if (V4L2_FIELD_ANY == field) {
1072                 field = (f->fmt.pix.height > maxh/2)
1073                         ? V4L2_FIELD_INTERLACED
1074                         : V4L2_FIELD_BOTTOM;
1075         }
1076
1077         switch (field) {
1078         case V4L2_FIELD_TOP:
1079         case V4L2_FIELD_BOTTOM:
1080                 maxh = maxh / 2;
1081                 break;
1082         case V4L2_FIELD_INTERLACED:
1083                 break;
1084         default:
1085                 return -EINVAL;
1086         }
1087
1088         f->fmt.pix.field = field;
1089         v4l_bound_align_image(&f->fmt.pix.width, 48, maxw, 2,
1090                               &f->fmt.pix.height, 32, maxh, 0, 0);
1091         f->fmt.pix.bytesperline =
1092                 (f->fmt.pix.width * fmt->depth) >> 3;
1093         f->fmt.pix.sizeimage =
1094                 f->fmt.pix.height * f->fmt.pix.bytesperline;
1095
1096         return 0;
1097 }
1098
1099 static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
1100         struct v4l2_format *f)
1101 {
1102         struct cx23885_fh *fh = priv;
1103         struct cx23885_dev *dev  = ((struct cx23885_fh *)priv)->dev;
1104         struct v4l2_mbus_framefmt mbus_fmt;
1105         int err;
1106
1107         dprintk(2, "%s()\n", __func__);
1108         err = vidioc_try_fmt_vid_cap(file, priv, f);
1109
1110         if (0 != err)
1111                 return err;
1112         fh->fmt        = format_by_fourcc(f->fmt.pix.pixelformat);
1113         fh->width      = f->fmt.pix.width;
1114         fh->height     = f->fmt.pix.height;
1115         fh->vidq.field = f->fmt.pix.field;
1116         dprintk(2, "%s() width=%d height=%d field=%d\n", __func__,
1117                 fh->width, fh->height, fh->vidq.field);
1118         v4l2_fill_mbus_format(&mbus_fmt, &f->fmt.pix, V4L2_MBUS_FMT_FIXED);
1119         call_all(dev, video, s_mbus_fmt, &mbus_fmt);
1120         v4l2_fill_pix_format(&f->fmt.pix, &mbus_fmt);
1121         return 0;
1122 }
1123
1124 static int vidioc_querycap(struct file *file, void  *priv,
1125         struct v4l2_capability *cap)
1126 {
1127         struct cx23885_dev *dev  = ((struct cx23885_fh *)priv)->dev;
1128
1129         strcpy(cap->driver, "cx23885");
1130         strlcpy(cap->card, cx23885_boards[dev->board].name,
1131                 sizeof(cap->card));
1132         sprintf(cap->bus_info, "PCIe:%s", pci_name(dev->pci));
1133         cap->capabilities =
1134                 V4L2_CAP_VIDEO_CAPTURE |
1135                 V4L2_CAP_READWRITE     |
1136                 V4L2_CAP_STREAMING     |
1137                 V4L2_CAP_VBI_CAPTURE;
1138         if (UNSET != dev->tuner_type)
1139                 cap->capabilities |= V4L2_CAP_TUNER;
1140         return 0;
1141 }
1142
1143 static int vidioc_enum_fmt_vid_cap(struct file *file, void  *priv,
1144         struct v4l2_fmtdesc *f)
1145 {
1146         if (unlikely(f->index >= ARRAY_SIZE(formats)))
1147                 return -EINVAL;
1148
1149         strlcpy(f->description, formats[f->index].name,
1150                 sizeof(f->description));
1151         f->pixelformat = formats[f->index].fourcc;
1152
1153         return 0;
1154 }
1155
1156 static int vidioc_reqbufs(struct file *file, void *priv,
1157         struct v4l2_requestbuffers *p)
1158 {
1159         struct cx23885_fh *fh = priv;
1160         return videobuf_reqbufs(get_queue(fh), p);
1161 }
1162
1163 static int vidioc_querybuf(struct file *file, void *priv,
1164         struct v4l2_buffer *p)
1165 {
1166         struct cx23885_fh *fh = priv;
1167         return videobuf_querybuf(get_queue(fh), p);
1168 }
1169
1170 static int vidioc_qbuf(struct file *file, void *priv,
1171         struct v4l2_buffer *p)
1172 {
1173         struct cx23885_fh *fh = priv;
1174         return videobuf_qbuf(get_queue(fh), p);
1175 }
1176
1177 static int vidioc_dqbuf(struct file *file, void *priv,
1178         struct v4l2_buffer *p)
1179 {
1180         struct cx23885_fh *fh = priv;
1181         return videobuf_dqbuf(get_queue(fh), p,
1182                                 file->f_flags & O_NONBLOCK);
1183 }
1184
1185 static int vidioc_streamon(struct file *file, void *priv,
1186         enum v4l2_buf_type i)
1187 {
1188         struct cx23885_fh *fh = priv;
1189         struct cx23885_dev *dev = fh->dev;
1190         dprintk(1, "%s()\n", __func__);
1191
1192         if ((fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) &&
1193                 (fh->type != V4L2_BUF_TYPE_VBI_CAPTURE))
1194                 return -EINVAL;
1195         if (unlikely(i != fh->type))
1196                 return -EINVAL;
1197
1198         if (unlikely(!res_get(dev, fh, get_resource(fh))))
1199                 return -EBUSY;
1200
1201         /* Don't start VBI streaming unless vida streaming
1202          * has already started.
1203          */
1204         if ((fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) &&
1205                 ((cx_read(VID_A_DMA_CTL) & 0x11) == 0))
1206                 return -EINVAL;
1207
1208         return videobuf_streamon(get_queue(fh));
1209 }
1210
1211 static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
1212 {
1213         struct cx23885_fh *fh = priv;
1214         struct cx23885_dev *dev = fh->dev;
1215         int err, res;
1216         dprintk(1, "%s()\n", __func__);
1217
1218         if ((fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) &&
1219                 (fh->type != V4L2_BUF_TYPE_VBI_CAPTURE))
1220                 return -EINVAL;
1221         if (i != fh->type)
1222                 return -EINVAL;
1223
1224         res = get_resource(fh);
1225         err = videobuf_streamoff(get_queue(fh));
1226         if (err < 0)
1227                 return err;
1228         res_free(dev, fh, res);
1229         return 0;
1230 }
1231
1232 static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *tvnorms)
1233 {
1234         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1235         dprintk(1, "%s()\n", __func__);
1236
1237         mutex_lock(&dev->lock);
1238         cx23885_set_tvnorm(dev, *tvnorms);
1239         mutex_unlock(&dev->lock);
1240
1241         return 0;
1242 }
1243
1244 static int cx23885_enum_input(struct cx23885_dev *dev, struct v4l2_input *i)
1245 {
1246         static const char *iname[] = {
1247                 [CX23885_VMUX_COMPOSITE1] = "Composite1",
1248                 [CX23885_VMUX_COMPOSITE2] = "Composite2",
1249                 [CX23885_VMUX_COMPOSITE3] = "Composite3",
1250                 [CX23885_VMUX_COMPOSITE4] = "Composite4",
1251                 [CX23885_VMUX_SVIDEO]     = "S-Video",
1252                 [CX23885_VMUX_COMPONENT]  = "Component",
1253                 [CX23885_VMUX_TELEVISION] = "Television",
1254                 [CX23885_VMUX_CABLE]      = "Cable TV",
1255                 [CX23885_VMUX_DVB]        = "DVB",
1256                 [CX23885_VMUX_DEBUG]      = "for debug only",
1257         };
1258         unsigned int n;
1259         dprintk(1, "%s()\n", __func__);
1260
1261         n = i->index;
1262         if (n >= MAX_CX23885_INPUT)
1263                 return -EINVAL;
1264
1265         if (0 == INPUT(n)->type)
1266                 return -EINVAL;
1267
1268         i->index = n;
1269         i->type  = V4L2_INPUT_TYPE_CAMERA;
1270         strcpy(i->name, iname[INPUT(n)->type]);
1271         if ((CX23885_VMUX_TELEVISION == INPUT(n)->type) ||
1272                 (CX23885_VMUX_CABLE == INPUT(n)->type)) {
1273                 i->type = V4L2_INPUT_TYPE_TUNER;
1274                 i->std = CX23885_NORMS;
1275         }
1276
1277         /* Two selectable audio inputs for non-tv inputs */
1278         if (INPUT(n)->type != CX23885_VMUX_TELEVISION)
1279                 i->audioset = 0x3;
1280
1281         return 0;
1282 }
1283
1284 static int vidioc_enum_input(struct file *file, void *priv,
1285                                 struct v4l2_input *i)
1286 {
1287         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1288         dprintk(1, "%s()\n", __func__);
1289         return cx23885_enum_input(dev, i);
1290 }
1291
1292 static int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
1293 {
1294         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1295
1296         *i = dev->input;
1297         dprintk(1, "%s() returns %d\n", __func__, *i);
1298         return 0;
1299 }
1300
1301 static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
1302 {
1303         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1304
1305         dprintk(1, "%s(%d)\n", __func__, i);
1306
1307         if (i >= MAX_CX23885_INPUT) {
1308                 dprintk(1, "%s() -EINVAL\n", __func__);
1309                 return -EINVAL;
1310         }
1311
1312         if (INPUT(i)->type == 0)
1313                 return -EINVAL;
1314
1315         mutex_lock(&dev->lock);
1316         cx23885_video_mux(dev, i);
1317
1318         /* By default establish the default audio input for the card also */
1319         /* Caller is free to use VIDIOC_S_AUDIO to override afterwards */
1320         cx23885_audio_mux(dev, i);
1321         mutex_unlock(&dev->lock);
1322         return 0;
1323 }
1324
1325 static int vidioc_log_status(struct file *file, void *priv)
1326 {
1327         struct cx23885_fh  *fh  = priv;
1328         struct cx23885_dev *dev = fh->dev;
1329
1330         printk(KERN_INFO
1331                 "%s/0: ============  START LOG STATUS  ============\n",
1332                dev->name);
1333         call_all(dev, core, log_status);
1334         printk(KERN_INFO
1335                 "%s/0: =============  END LOG STATUS  =============\n",
1336                dev->name);
1337         return 0;
1338 }
1339
1340 static int cx23885_query_audinput(struct file *file, void *priv,
1341         struct v4l2_audio *i)
1342 {
1343         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1344         static const char *iname[] = {
1345                 [0] = "Baseband L/R 1",
1346                 [1] = "Baseband L/R 2",
1347         };
1348         unsigned int n;
1349         dprintk(1, "%s()\n", __func__);
1350
1351         n = i->index;
1352         if (n >= 2)
1353                 return -EINVAL;
1354
1355         memset(i, 0, sizeof(*i));
1356         i->index = n;
1357         strcpy(i->name, iname[n]);
1358         i->capability  = V4L2_AUDCAP_STEREO;
1359         i->mode  = V4L2_AUDMODE_AVL;
1360         return 0;
1361
1362 }
1363
1364 static int vidioc_enum_audinput(struct file *file, void *priv,
1365                                 struct v4l2_audio *i)
1366 {
1367         return cx23885_query_audinput(file, priv, i);
1368 }
1369
1370 static int vidioc_g_audinput(struct file *file, void *priv,
1371         struct v4l2_audio *i)
1372 {
1373         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1374
1375         i->index = dev->audinput;
1376         dprintk(1, "%s(input=%d)\n", __func__, i->index);
1377
1378         return cx23885_query_audinput(file, priv, i);
1379 }
1380
1381 static int vidioc_s_audinput(struct file *file, void *priv,
1382         struct v4l2_audio *i)
1383 {
1384         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1385         if (i->index >= 2)
1386                 return -EINVAL;
1387
1388         dprintk(1, "%s(%d)\n", __func__, i->index);
1389
1390         dev->audinput = i->index;
1391
1392         /* Skip the audio defaults from the cards struct, caller wants
1393          * directly touch the audio mux hardware. */
1394         cx23885_flatiron_mux(dev, dev->audinput + 1);
1395         return 0;
1396 }
1397
1398 static int vidioc_queryctrl(struct file *file, void *priv,
1399                                 struct v4l2_queryctrl *qctrl)
1400 {
1401         qctrl->id = v4l2_ctrl_next(ctrl_classes, qctrl->id);
1402         if (unlikely(qctrl->id == 0))
1403                 return -EINVAL;
1404         return cx23885_ctrl_query(qctrl);
1405 }
1406
1407 static int vidioc_g_ctrl(struct file *file, void *priv,
1408                                 struct v4l2_control *ctl)
1409 {
1410         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1411
1412         return cx23885_get_control(dev, ctl);
1413 }
1414
1415 static int vidioc_s_ctrl(struct file *file, void *priv,
1416                                 struct v4l2_control *ctl)
1417 {
1418         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1419
1420         return cx23885_set_control(dev, ctl);
1421 }
1422
1423 static int vidioc_g_tuner(struct file *file, void *priv,
1424                                 struct v4l2_tuner *t)
1425 {
1426         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1427
1428         if (unlikely(UNSET == dev->tuner_type))
1429                 return -EINVAL;
1430         if (0 != t->index)
1431                 return -EINVAL;
1432
1433         strcpy(t->name, "Television");
1434
1435         call_all(dev, tuner, g_tuner, t);
1436         return 0;
1437 }
1438
1439 static int vidioc_s_tuner(struct file *file, void *priv,
1440                                 struct v4l2_tuner *t)
1441 {
1442         struct cx23885_dev *dev = ((struct cx23885_fh *)priv)->dev;
1443
1444         if (UNSET == dev->tuner_type)
1445                 return -EINVAL;
1446         if (0 != t->index)
1447                 return -EINVAL;
1448         /* Update the A/V core */
1449         call_all(dev, tuner, s_tuner, t);
1450
1451         return 0;
1452 }
1453
1454 static int vidioc_g_frequency(struct file *file, void *priv,
1455                                 struct v4l2_frequency *f)
1456 {
1457         struct cx23885_fh *fh = priv;
1458         struct cx23885_dev *dev = fh->dev;
1459
1460         if (unlikely(UNSET == dev->tuner_type))
1461                 return -EINVAL;
1462
1463         /* f->type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV; */
1464         f->type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV;
1465         f->frequency = dev->freq;
1466
1467         call_all(dev, tuner, g_frequency, f);
1468
1469         return 0;
1470 }
1471
1472 static int cx23885_set_freq(struct cx23885_dev *dev, struct v4l2_frequency *f)
1473 {
1474         if (unlikely(UNSET == dev->tuner_type))
1475                 return -EINVAL;
1476         if (unlikely(f->tuner != 0))
1477                 return -EINVAL;
1478
1479         mutex_lock(&dev->lock);
1480         dev->freq = f->frequency;
1481
1482         call_all(dev, tuner, s_frequency, f);
1483
1484         /* When changing channels it is required to reset TVAUDIO */
1485         msleep(10);
1486
1487         mutex_unlock(&dev->lock);
1488
1489         return 0;
1490 }
1491
1492 static int vidioc_s_frequency(struct file *file, void *priv,
1493                                 struct v4l2_frequency *f)
1494 {
1495         struct cx23885_fh *fh = priv;
1496         struct cx23885_dev *dev = fh->dev;
1497
1498         if (unlikely(0 == fh->radio && f->type != V4L2_TUNER_ANALOG_TV))
1499                 return -EINVAL;
1500         if (unlikely(1 == fh->radio && f->type != V4L2_TUNER_RADIO))
1501                 return -EINVAL;
1502
1503         return
1504                 cx23885_set_freq(dev, f);
1505 }
1506
1507 /* ----------------------------------------------------------- */
1508
1509 static void cx23885_vid_timeout(unsigned long data)
1510 {
1511         struct cx23885_dev *dev = (struct cx23885_dev *)data;
1512         struct cx23885_dmaqueue *q = &dev->vidq;
1513         struct cx23885_buffer *buf;
1514         unsigned long flags;
1515
1516         spin_lock_irqsave(&dev->slock, flags);
1517         while (!list_empty(&q->active)) {
1518                 buf = list_entry(q->active.next,
1519                         struct cx23885_buffer, vb.queue);
1520                 list_del(&buf->vb.queue);
1521                 buf->vb.state = VIDEOBUF_ERROR;
1522                 wake_up(&buf->vb.done);
1523                 printk(KERN_ERR "%s: [%p/%d] timeout - dma=0x%08lx\n",
1524                         dev->name, buf, buf->vb.i,
1525                         (unsigned long)buf->risc.dma);
1526         }
1527         cx23885_restart_video_queue(dev, q);
1528         spin_unlock_irqrestore(&dev->slock, flags);
1529 }
1530
1531 int cx23885_video_irq(struct cx23885_dev *dev, u32 status)
1532 {
1533         u32 mask, count;
1534         int handled = 0;
1535
1536         mask   = cx_read(VID_A_INT_MSK);
1537         if (0 == (status & mask))
1538                 return handled;
1539
1540         cx_write(VID_A_INT_STAT, status);
1541
1542         /* risc op code error, fifo overflow or line sync detection error */
1543         if ((status & VID_BC_MSK_OPC_ERR) ||
1544                 (status & VID_BC_MSK_SYNC) ||
1545                 (status & VID_BC_MSK_OF)) {
1546
1547                 if (status & VID_BC_MSK_OPC_ERR) {
1548                         dprintk(7, " (VID_BC_MSK_OPC_ERR 0x%08x)\n",
1549                                 VID_BC_MSK_OPC_ERR);
1550                         printk(KERN_WARNING "%s: video risc op code error\n",
1551                                 dev->name);
1552                         cx23885_sram_channel_dump(dev,
1553                                 &dev->sram_channels[SRAM_CH01]);
1554                 }
1555
1556                 if (status & VID_BC_MSK_SYNC)
1557                         dprintk(7, " (VID_BC_MSK_SYNC 0x%08x) "
1558                                 "video lines miss-match\n",
1559                                 VID_BC_MSK_SYNC);
1560
1561                 if (status & VID_BC_MSK_OF)
1562                         dprintk(7, " (VID_BC_MSK_OF 0x%08x) fifo overflow\n",
1563                                 VID_BC_MSK_OF);
1564
1565         }
1566
1567         /* Video */
1568         if (status & VID_BC_MSK_RISCI1) {
1569                 spin_lock(&dev->slock);
1570                 count = cx_read(VID_A_GPCNT);
1571                 cx23885_video_wakeup(dev, &dev->vidq, count);
1572                 spin_unlock(&dev->slock);
1573                 handled++;
1574         }
1575         if (status & VID_BC_MSK_RISCI2) {
1576                 dprintk(2, "stopper video\n");
1577                 spin_lock(&dev->slock);
1578                 cx23885_restart_video_queue(dev, &dev->vidq);
1579                 spin_unlock(&dev->slock);
1580                 handled++;
1581         }
1582
1583         /* Allow the VBI framework to process it's payload */
1584         handled += cx23885_vbi_irq(dev, status);
1585
1586         return handled;
1587 }
1588
1589 /* ----------------------------------------------------------- */
1590 /* exported stuff                                              */
1591
1592 static const struct v4l2_file_operations video_fops = {
1593         .owner         = THIS_MODULE,
1594         .open          = video_open,
1595         .release       = video_release,
1596         .read          = video_read,
1597         .poll          = video_poll,
1598         .mmap          = video_mmap,
1599         .ioctl         = video_ioctl2,
1600 };
1601
1602 static const struct v4l2_ioctl_ops video_ioctl_ops = {
1603         .vidioc_querycap      = vidioc_querycap,
1604         .vidioc_enum_fmt_vid_cap  = vidioc_enum_fmt_vid_cap,
1605         .vidioc_g_fmt_vid_cap     = vidioc_g_fmt_vid_cap,
1606         .vidioc_try_fmt_vid_cap   = vidioc_try_fmt_vid_cap,
1607         .vidioc_s_fmt_vid_cap     = vidioc_s_fmt_vid_cap,
1608         .vidioc_g_fmt_vbi_cap     = cx23885_vbi_fmt,
1609         .vidioc_try_fmt_vbi_cap   = cx23885_vbi_fmt,
1610         .vidioc_s_fmt_vbi_cap     = cx23885_vbi_fmt,
1611         .vidioc_reqbufs       = vidioc_reqbufs,
1612         .vidioc_querybuf      = vidioc_querybuf,
1613         .vidioc_qbuf          = vidioc_qbuf,
1614         .vidioc_dqbuf         = vidioc_dqbuf,
1615         .vidioc_s_std         = vidioc_s_std,
1616         .vidioc_enum_input    = vidioc_enum_input,
1617         .vidioc_g_input       = vidioc_g_input,
1618         .vidioc_s_input       = vidioc_s_input,
1619         .vidioc_log_status    = vidioc_log_status,
1620         .vidioc_queryctrl     = vidioc_queryctrl,
1621         .vidioc_g_ctrl        = vidioc_g_ctrl,
1622         .vidioc_s_ctrl        = vidioc_s_ctrl,
1623         .vidioc_streamon      = vidioc_streamon,
1624         .vidioc_streamoff     = vidioc_streamoff,
1625         .vidioc_g_tuner       = vidioc_g_tuner,
1626         .vidioc_s_tuner       = vidioc_s_tuner,
1627         .vidioc_g_frequency   = vidioc_g_frequency,
1628         .vidioc_s_frequency   = vidioc_s_frequency,
1629         .vidioc_g_chip_ident  = cx23885_g_chip_ident,
1630 #ifdef CONFIG_VIDEO_ADV_DEBUG
1631         .vidioc_g_register    = cx23885_g_register,
1632         .vidioc_s_register    = cx23885_s_register,
1633 #endif
1634         .vidioc_enumaudio     = vidioc_enum_audinput,
1635         .vidioc_g_audio       = vidioc_g_audinput,
1636         .vidioc_s_audio       = vidioc_s_audinput,
1637 };
1638
1639 static struct video_device cx23885_vbi_template;
1640 static struct video_device cx23885_video_template = {
1641         .name                 = "cx23885-video",
1642         .fops                 = &video_fops,
1643         .ioctl_ops            = &video_ioctl_ops,
1644         .tvnorms              = CX23885_NORMS,
1645         .current_norm         = V4L2_STD_NTSC_M,
1646 };
1647
1648 static const struct v4l2_file_operations radio_fops = {
1649         .owner         = THIS_MODULE,
1650         .open          = video_open,
1651         .release       = video_release,
1652         .ioctl         = video_ioctl2,
1653 };
1654
1655
1656 void cx23885_video_unregister(struct cx23885_dev *dev)
1657 {
1658         dprintk(1, "%s()\n", __func__);
1659         cx23885_irq_remove(dev, 0x01);
1660
1661         if (dev->vbi_dev) {
1662                 if (video_is_registered(dev->vbi_dev))
1663                         video_unregister_device(dev->vbi_dev);
1664                 else
1665                         video_device_release(dev->vbi_dev);
1666                 dev->vbi_dev = NULL;
1667                 btcx_riscmem_free(dev->pci, &dev->vbiq.stopper);
1668         }
1669         if (dev->video_dev) {
1670                 if (video_is_registered(dev->video_dev))
1671                         video_unregister_device(dev->video_dev);
1672                 else
1673                         video_device_release(dev->video_dev);
1674                 dev->video_dev = NULL;
1675
1676                 btcx_riscmem_free(dev->pci, &dev->vidq.stopper);
1677         }
1678
1679         if (dev->audio_dev)
1680                 cx23885_audio_unregister(dev);
1681 }
1682
1683 int cx23885_video_register(struct cx23885_dev *dev)
1684 {
1685         int err;
1686
1687         dprintk(1, "%s()\n", __func__);
1688         spin_lock_init(&dev->slock);
1689
1690         /* Initialize VBI template */
1691         memcpy(&cx23885_vbi_template, &cx23885_video_template,
1692                 sizeof(cx23885_vbi_template));
1693         strcpy(cx23885_vbi_template.name, "cx23885-vbi");
1694
1695         dev->tvnorm = cx23885_video_template.current_norm;
1696
1697         /* init video dma queues */
1698         INIT_LIST_HEAD(&dev->vidq.active);
1699         INIT_LIST_HEAD(&dev->vidq.queued);
1700         dev->vidq.timeout.function = cx23885_vid_timeout;
1701         dev->vidq.timeout.data = (unsigned long)dev;
1702         init_timer(&dev->vidq.timeout);
1703         cx23885_risc_stopper(dev->pci, &dev->vidq.stopper,
1704                 VID_A_DMA_CTL, 0x11, 0x00);
1705
1706         /* init vbi dma queues */
1707         INIT_LIST_HEAD(&dev->vbiq.active);
1708         INIT_LIST_HEAD(&dev->vbiq.queued);
1709         dev->vbiq.timeout.function = cx23885_vbi_timeout;
1710         dev->vbiq.timeout.data = (unsigned long)dev;
1711         init_timer(&dev->vbiq.timeout);
1712         cx23885_risc_stopper(dev->pci, &dev->vbiq.stopper,
1713                 VID_A_DMA_CTL, 0x22, 0x00);
1714
1715         cx23885_irq_add_enable(dev, 0x01);
1716
1717         if ((TUNER_ABSENT != dev->tuner_type) &&
1718                         ((dev->tuner_bus == 0) || (dev->tuner_bus == 1))) {
1719                 struct v4l2_subdev *sd = NULL;
1720
1721                 if (dev->tuner_addr)
1722                         sd = v4l2_i2c_new_subdev(&dev->v4l2_dev,
1723                                 &dev->i2c_bus[dev->tuner_bus].i2c_adap,
1724                                 "tuner", dev->tuner_addr, NULL);
1725                 else
1726                         sd = v4l2_i2c_new_subdev(&dev->v4l2_dev,
1727                                 &dev->i2c_bus[dev->tuner_bus].i2c_adap,
1728                                 "tuner", 0, v4l2_i2c_tuner_addrs(ADDRS_TV));
1729                 if (sd) {
1730                         struct tuner_setup tun_setup;
1731
1732                         memset(&tun_setup, 0, sizeof(tun_setup));
1733                         tun_setup.mode_mask = T_ANALOG_TV;
1734                         tun_setup.type = dev->tuner_type;
1735                         tun_setup.addr = v4l2_i2c_subdev_addr(sd);
1736                         tun_setup.tuner_callback = cx23885_tuner_callback;
1737
1738                         v4l2_subdev_call(sd, tuner, s_type_addr, &tun_setup);
1739
1740                         if (dev->board == CX23885_BOARD_LEADTEK_WINFAST_PXTV1200) {
1741                                 struct xc2028_ctrl ctrl = {
1742                                         .fname = XC2028_DEFAULT_FIRMWARE,
1743                                         .max_len = 64
1744                                 };
1745                                 struct v4l2_priv_tun_config cfg = {
1746                                         .tuner = dev->tuner_type,
1747                                         .priv = &ctrl
1748                                 };
1749                                 v4l2_subdev_call(sd, tuner, s_config, &cfg);
1750                         }
1751                 }
1752         }
1753
1754         /* register Video device */
1755         dev->video_dev = cx23885_vdev_init(dev, dev->pci,
1756                 &cx23885_video_template, "video");
1757         err = video_register_device(dev->video_dev, VFL_TYPE_GRABBER,
1758                                     video_nr[dev->nr]);
1759         if (err < 0) {
1760                 printk(KERN_INFO "%s: can't register video device\n",
1761                         dev->name);
1762                 goto fail_unreg;
1763         }
1764         printk(KERN_INFO "%s: registered device %s [v4l2]\n",
1765                dev->name, video_device_node_name(dev->video_dev));
1766
1767         /* register VBI device */
1768         dev->vbi_dev = cx23885_vdev_init(dev, dev->pci,
1769                 &cx23885_vbi_template, "vbi");
1770         err = video_register_device(dev->vbi_dev, VFL_TYPE_VBI,
1771                                     vbi_nr[dev->nr]);
1772         if (err < 0) {
1773                 printk(KERN_INFO "%s: can't register vbi device\n",
1774                         dev->name);
1775                 goto fail_unreg;
1776         }
1777         printk(KERN_INFO "%s: registered device %s\n",
1778                dev->name, video_device_node_name(dev->vbi_dev));
1779
1780         /* Register ALSA audio device */
1781         dev->audio_dev = cx23885_audio_register(dev);
1782
1783         /* initial device configuration */
1784         mutex_lock(&dev->lock);
1785         cx23885_set_tvnorm(dev, dev->tvnorm);
1786         init_controls(dev);
1787         cx23885_video_mux(dev, 0);
1788         cx23885_audio_mux(dev, 0);
1789         mutex_unlock(&dev->lock);
1790
1791         return 0;
1792
1793 fail_unreg:
1794         cx23885_video_unregister(dev);
1795         return err;
1796 }
1797