drivers/staging/cx25821/cx25821-video.c

   1 /*
   2  *  Driver for the Conexant CX25821 PCIe bridge
   3  *
   4  *  Copyright (C) 2009 Conexant Systems Inc.
   5  *  Authors  <shu.lin@conexant.com>, <hiep.huynh@conexant.com>
   6  *  Based on Steven Toth <stoth@linuxtv.org> cx23885 driver
   7  *  Parts adapted/taken from Eduardo Moscoso Rubino
   8  *  Copyright (C) 2009 Eduardo Moscoso Rubino <moscoso@TopoLogica.com>
   9  *
  10  *
  11  *  This program is free software; you can redistribute it and/or modify
  12  *  it under the terms of the GNU General Public License as published by
  13  *  the Free Software Foundation; either version 2 of the License, or
  14  *  (at your option) any later version.
  15  *
  16  *  This program is distributed in the hope that it will be useful,
  17  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  *
  20  *  GNU General Public License for more details.
  21  *
  22  *  You should have received a copy of the GNU General Public License
  23  *  along with this program; if not, write to the Free Software
  24  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  25  */
  26
  27 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  28
  29 #include "cx25821-video.h"
  30
  31 MODULE_DESCRIPTION("v4l2 driver module for cx25821 based TV cards");
  32 MODULE_AUTHOR("Hiep Huynh <hiep.huynh@conexant.com>");
  33 MODULE_LICENSE("GPL");
  34
  35 static unsigned int video_nr[] = {[0 ... (CX25821_MAXBOARDS - 1)] = UNSET };
  36 static unsigned int radio_nr[] = {[0 ... (CX25821_MAXBOARDS - 1)] = UNSET };
  37
  38 module_param_array(video_nr, int, NULL, 0444);
  39 module_param_array(radio_nr, int, NULL, 0444);
  40
  41 MODULE_PARM_DESC(video_nr, "video device numbers");
  42 MODULE_PARM_DESC(radio_nr, "radio device numbers");
  43
  44 static unsigned int video_debug = VIDEO_DEBUG;
  45 module_param(video_debug, int, 0644);
  46 MODULE_PARM_DESC(video_debug, "enable debug messages [video]");
  47
  48 static unsigned int irq_debug;
  49 module_param(irq_debug, int, 0644);
  50 MODULE_PARM_DESC(irq_debug, "enable debug messages [IRQ handler]");
  51
  52 unsigned int vid_limit = 16;
  53 module_param(vid_limit, int, 0644);
  54 MODULE_PARM_DESC(vid_limit, "capture memory limit in megabytes");
  55
  56 static void cx25821_init_controls(struct cx25821_dev *dev, int chan_num);
  57
  58 static const struct v4l2_file_operations video_fops;
  59 static const struct v4l2_ioctl_ops video_ioctl_ops;
  60
  61 #define FORMAT_FLAGS_PACKED       0x01
  62
  63 struct cx25821_fmt formats[] = {
  64         {
  65                 .name = "8 bpp, gray",
  66                 .fourcc = V4L2_PIX_FMT_GREY,
  67                 .depth = 8,
  68                 .flags = FORMAT_FLAGS_PACKED,
  69          }, {
  70                 .name = "4:1:1, packed, Y41P",
  71                 .fourcc = V4L2_PIX_FMT_Y41P,
  72                 .depth = 12,
  73                 .flags = FORMAT_FLAGS_PACKED,
  74         }, {
  75                 .name = "4:2:2, packed, YUYV",
  76                 .fourcc = V4L2_PIX_FMT_YUYV,
  77                 .depth = 16,
  78                 .flags = FORMAT_FLAGS_PACKED,
  79         }, {
  80                 .name = "4:2:2, packed, UYVY",
  81                 .fourcc = V4L2_PIX_FMT_UYVY,
  82                 .depth = 16,
  83                 .flags = FORMAT_FLAGS_PACKED,
  84         }, {
  85                 .name = "4:2:0, YUV",
  86                 .fourcc = V4L2_PIX_FMT_YUV420,
  87                 .depth = 12,
  88                 .flags = FORMAT_FLAGS_PACKED,
  89         },
  90 };
  91
  92 int cx25821_get_format_size(void)
  93 {
  94         return ARRAY_SIZE(formats);
  95 }
  96
  97 struct cx25821_fmt *cx25821_format_by_fourcc(unsigned int fourcc)
  98 {
  99         unsigned int i;
 100
 101         if (fourcc == V4L2_PIX_FMT_Y41P || fourcc == V4L2_PIX_FMT_YUV411P) {
 102                 return formats + 1;
 103         }
 104
 105         for (i = 0; i < ARRAY_SIZE(formats); i++)
 106                 if (formats[i].fourcc == fourcc)
 107                         return formats + i;
 108
 109         pr_err("%s(0x%08x) NOT FOUND\n", __func__, fourcc);
 110         return NULL;
 111 }
 112
 113 void cx25821_dump_video_queue(struct cx25821_dev *dev,
 114                               struct cx25821_dmaqueue *q)
 115 {
 116         struct cx25821_buffer *buf;
 117         struct list_head *item;
 118         dprintk(1, "%s()\n", __func__);
 119
 120         if (!list_empty(&q->active)) {
 121                 list_for_each(item, &q->active)
 122                     buf = list_entry(item, struct cx25821_buffer, vb.queue);
 123         }
 124
 125         if (!list_empty(&q->queued)) {
 126                 list_for_each(item, &q->queued)
 127                     buf = list_entry(item, struct cx25821_buffer, vb.queue);
 128         }
 129
 130 }
 131
 132 void cx25821_video_wakeup(struct cx25821_dev *dev, struct cx25821_dmaqueue *q,
 133                           u32 count)
 134 {
 135         struct cx25821_buffer *buf;
 136         int bc;
 137
 138         for (bc = 0;; bc++) {
 139                 if (list_empty(&q->active)) {
 140                         dprintk(1, "bc=%d (=0: active empty)\n", bc);
 141                         break;
 142                 }
 143
 144                 buf =
 145                     list_entry(q->active.next, struct cx25821_buffer, vb.queue);
 146
 147                 /* count comes from the hw and it is 16bit wide --
 148                  * this trick handles wrap-arounds correctly for
 149                  * up to 32767 buffers in flight... */
 150                 if ((s16) (count - buf->count) < 0) {
 151                         break;
 152                 }
 153
 154                 do_gettimeofday(&buf->vb.ts);
 155                 buf->vb.state = VIDEOBUF_DONE;
 156                 list_del(&buf->vb.queue);
 157                 wake_up(&buf->vb.done);
 158         }
 159
 160         if (list_empty(&q->active))
 161                 del_timer(&q->timeout);
 162         else
 163                 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
 164         if (bc != 1)
 165                 pr_err("%s: %d buffers handled (should be 1)\n", __func__, bc);
 166 }
 167
 168 #ifdef TUNER_FLAG
 169 int cx25821_set_tvnorm(struct cx25821_dev *dev, v4l2_std_id norm)
 170 {
 171         dprintk(1, "%s(norm = 0x%08x) name: [%s]\n",
 172                 __func__, (unsigned int)norm, v4l2_norm_to_name(norm));
 173
 174         dev->tvnorm = norm;
 175
 176         /* Tell the internal A/V decoder */
 177         cx25821_call_all(dev, core, s_std, norm);
 178
 179         return 0;
 180 }
 181 #endif
 182
 183 struct video_device *cx25821_vdev_init(struct cx25821_dev *dev,
 184                                        struct pci_dev *pci,
 185                                        struct video_device *template,
 186                                        char *type)
 187 {
 188         struct video_device *vfd;
 189         dprintk(1, "%s()\n", __func__);
 190
 191         vfd = video_device_alloc();
 192         if (NULL == vfd)
 193                 return NULL;
 194         *vfd = *template;
 195         vfd->v4l2_dev = &dev->v4l2_dev;
 196         vfd->release = video_device_release;
 197         snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)", dev->name, type,
 198                  cx25821_boards[dev->board].name);
 199         video_set_drvdata(vfd, dev);
 200         return vfd;
 201 }
 202
 203 /*
 204 static int cx25821_ctrl_query(struct v4l2_queryctrl *qctrl)
 205 {
 206         int i;
 207
 208         if (qctrl->id < V4L2_CID_BASE || qctrl->id >= V4L2_CID_LASTP1)
 209                 return -EINVAL;
 210         for (i = 0; i < CX25821_CTLS; i++)
 211                 if (cx25821_ctls[i].v.id == qctrl->id)
 212                         break;
 213         if (i == CX25821_CTLS) {
 214                 *qctrl = no_ctl;
 215                 return 0;
 216         }
 217         *qctrl = cx25821_ctls[i].v;
 218         return 0;
 219 }
 220 */
 221
 222 /* resource management */
 223 int cx25821_res_get(struct cx25821_dev *dev, struct cx25821_fh *fh,
 224                     unsigned int bit)
 225 {
 226         dprintk(1, "%s()\n", __func__);
 227         if (fh->resources & bit)
 228                 /* have it already allocated */
 229                 return 1;
 230
 231         /* is it free? */
 232         mutex_lock(&dev->lock);
 233         if (dev->channels[fh->channel_id].resources & bit) {
 234                 /* no, someone else uses it */
 235                 mutex_unlock(&dev->lock);
 236                 return 0;
 237         }
 238         /* it's free, grab it */
 239         fh->resources |= bit;
 240         dev->channels[fh->channel_id].resources |= bit;
 241         dprintk(1, "res: get %d\n", bit);
 242         mutex_unlock(&dev->lock);
 243         return 1;
 244 }
 245
 246 int cx25821_res_check(struct cx25821_fh *fh, unsigned int bit)
 247 {
 248         return fh->resources & bit;
 249 }
 250
 251 int cx25821_res_locked(struct cx25821_fh *fh, unsigned int bit)
 252 {
 253         return fh->dev->channels[fh->channel_id].resources & bit;
 254 }
 255
 256 void cx25821_res_free(struct cx25821_dev *dev, struct cx25821_fh *fh,
 257                       unsigned int bits)
 258 {
 259         BUG_ON((fh->resources & bits) != bits);
 260         dprintk(1, "%s()\n", __func__);
 261
 262         mutex_lock(&dev->lock);
 263         fh->resources &= ~bits;
 264         dev->channels[fh->channel_id].resources &= ~bits;
 265         dprintk(1, "res: put %d\n", bits);
 266         mutex_unlock(&dev->lock);
 267 }
 268
 269 int cx25821_video_mux(struct cx25821_dev *dev, unsigned int input)
 270 {
 271         struct v4l2_routing route;
 272         memset(&route, 0, sizeof(route));
 273
 274         dprintk(1, "%s(): video_mux: %d [vmux=%d, gpio=0x%x,0x%x,0x%x,0x%x]\n",
 275                 __func__, input, INPUT(input)->vmux, INPUT(input)->gpio0,
 276                 INPUT(input)->gpio1, INPUT(input)->gpio2, INPUT(input)->gpio3);
 277         dev->input = input;
 278
 279         route.input = INPUT(input)->vmux;
 280
 281         /* Tell the internal A/V decoder */
 282         cx25821_call_all(dev, video, s_routing, INPUT(input)->vmux, 0, 0);
 283
 284         return 0;
 285 }
 286
 287 int cx25821_start_video_dma(struct cx25821_dev *dev,
 288                             struct cx25821_dmaqueue *q,
 289                             struct cx25821_buffer *buf,
 290                             struct sram_channel *channel)
 291 {
 292         int tmp = 0;
 293
 294         /* setup fifo + format */
 295         cx25821_sram_channel_setup(dev, channel, buf->bpl, buf->risc.dma);
 296
 297         /* reset counter */
 298         cx_write(channel->gpcnt_ctl, 3);
 299         q->count = 1;
 300
 301         /* enable irq */
 302         cx_set(PCI_INT_MSK, cx_read(PCI_INT_MSK) | (1 << channel->i));
 303         cx_set(channel->int_msk, 0x11);
 304
 305         /* start dma */
 306         cx_write(channel->dma_ctl, 0x11);       /* FIFO and RISC enable */
 307
 308         /* make sure upstream setting if any is reversed */
 309         tmp = cx_read(VID_CH_MODE_SEL);
 310         cx_write(VID_CH_MODE_SEL, tmp & 0xFFFFFE00);
 311
 312         return 0;
 313 }
 314
 315 int cx25821_restart_video_queue(struct cx25821_dev *dev,
 316                                 struct cx25821_dmaqueue *q,
 317                                 struct sram_channel *channel)
 318 {
 319         struct cx25821_buffer *buf, *prev;
 320         struct list_head *item;
 321
 322         if (!list_empty(&q->active)) {
 323                 buf =
 324                     list_entry(q->active.next, struct cx25821_buffer, vb.queue);
 325
 326                 cx25821_start_video_dma(dev, q, buf, channel);
 327
 328                 list_for_each(item, &q->active) {
 329                         buf = list_entry(item, struct cx25821_buffer, vb.queue);
 330                         buf->count = q->count++;
 331                 }
 332
 333                 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
 334                 return 0;
 335         }
 336
 337         prev = NULL;
 338         for (;;) {
 339                 if (list_empty(&q->queued))
 340                         return 0;
 341
 342                 buf =
 343                     list_entry(q->queued.next, struct cx25821_buffer, vb.queue);
 344
 345                 if (NULL == prev) {
 346                         list_move_tail(&buf->vb.queue, &q->active);
 347                         cx25821_start_video_dma(dev, q, buf, channel);
 348                         buf->vb.state = VIDEOBUF_ACTIVE;
 349                         buf->count = q->count++;
 350                         mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
 351                 } else if (prev->vb.width == buf->vb.width &&
 352                            prev->vb.height == buf->vb.height &&
 353                            prev->fmt == buf->fmt) {
 354                         list_move_tail(&buf->vb.queue, &q->active);
 355                         buf->vb.state = VIDEOBUF_ACTIVE;
 356                         buf->count = q->count++;
 357                         prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
 358                         prev->risc.jmp[2] = cpu_to_le32(0); /* Bits 63 - 32 */
 359                 } else {
 360                         return 0;
 361                 }
 362                 prev = buf;
 363         }
 364 }
 365
 366 void cx25821_vid_timeout(unsigned long data)
 367 {
 368         struct cx25821_data *timeout_data = (struct cx25821_data *)data;
 369         struct cx25821_dev *dev = timeout_data->dev;
 370         struct sram_channel *channel = timeout_data->channel;
 371         struct cx25821_dmaqueue *q = &dev->channels[channel->i].vidq;
 372         struct cx25821_buffer *buf;
 373         unsigned long flags;
 374
 375         /* cx25821_sram_channel_dump(dev, channel); */
 376         cx_clear(channel->dma_ctl, 0x11);
 377
 378         spin_lock_irqsave(&dev->slock, flags);
 379         while (!list_empty(&q->active)) {
 380                 buf =
 381                     list_entry(q->active.next, struct cx25821_buffer, vb.queue);
 382                 list_del(&buf->vb.queue);
 383
 384                 buf->vb.state = VIDEOBUF_ERROR;
 385                 wake_up(&buf->vb.done);
 386         }
 387
 388         cx25821_restart_video_queue(dev, q, channel);
 389         spin_unlock_irqrestore(&dev->slock, flags);
 390 }
 391
 392 int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status)
 393 {
 394         u32 count = 0;
 395         int handled = 0;
 396         u32 mask;
 397         struct sram_channel *channel = dev->channels[chan_num].sram_channels;
 398
 399         mask = cx_read(channel->int_msk);
 400         if (0 == (status & mask))
 401                 return handled;
 402
 403         cx_write(channel->int_stat, status);
 404
 405         /* risc op code error */
 406         if (status & (1 << 16)) {
 407                 pr_warn("%s, %s: video risc op code error\n",
 408                         dev->name, channel->name);
 409                 cx_clear(channel->dma_ctl, 0x11);
 410                 cx25821_sram_channel_dump(dev, channel);
 411         }
 412
 413         /* risc1 y */
 414         if (status & FLD_VID_DST_RISC1) {
 415                 spin_lock(&dev->slock);
 416                 count = cx_read(channel->gpcnt);
 417                 cx25821_video_wakeup(dev, &dev->channels[channel->i].vidq,
 418                                 count);
 419                 spin_unlock(&dev->slock);
 420                 handled++;
 421         }
 422
 423         /* risc2 y */
 424         if (status & 0x10) {
 425                 dprintk(2, "stopper video\n");
 426                 spin_lock(&dev->slock);
 427                 cx25821_restart_video_queue(dev,
 428                                 &dev->channels[channel->i].vidq, channel);
 429                 spin_unlock(&dev->slock);
 430                 handled++;
 431         }
 432         return handled;
 433 }
 434
 435 void cx25821_videoioctl_unregister(struct cx25821_dev *dev)
 436 {
 437         if (dev->ioctl_dev) {
 438                 if (video_is_registered(dev->ioctl_dev))
 439                         video_unregister_device(dev->ioctl_dev);
 440                 else
 441                         video_device_release(dev->ioctl_dev);
 442
 443                 dev->ioctl_dev = NULL;
 444         }
 445 }
 446
 447 void cx25821_video_unregister(struct cx25821_dev *dev, int chan_num)
 448 {
 449         cx_clear(PCI_INT_MSK, 1);
 450
 451         if (dev->channels[chan_num].video_dev) {
 452                 if (video_is_registered(dev->channels[chan_num].video_dev))
 453                         video_unregister_device(
 454                                         dev->channels[chan_num].video_dev);
 455                 else
 456                         video_device_release(
 457                                         dev->channels[chan_num].video_dev);
 458
 459                 dev->channels[chan_num].video_dev = NULL;
 460
 461                 btcx_riscmem_free(dev->pci,
 462                                 &dev->channels[chan_num].vidq.stopper);
 463
 464                 pr_warn("device %d released!\n", chan_num);
 465         }
 466
 467 }
 468
 469 int cx25821_video_register(struct cx25821_dev *dev)
 470 {
 471         int err;
 472         int i;
 473
 474         struct video_device cx25821_video_device = {
 475                 .name = "cx25821-video",
 476                 .fops = &video_fops,
 477                 .minor = -1,
 478                 .ioctl_ops = &video_ioctl_ops,
 479                 .tvnorms = CX25821_NORMS,
 480                 .current_norm = V4L2_STD_NTSC_M,
 481         };
 482
 483         spin_lock_init(&dev->slock);
 484
 485         for (i = 0; i < MAX_VID_CHANNEL_NUM - 1; ++i) {
 486                 cx25821_init_controls(dev, i);
 487
 488                 cx25821_risc_stopper(dev->pci, &dev->channels[i].vidq.stopper,
 489                                 dev->channels[i].sram_channels->dma_ctl,
 490                                 0x11, 0);
 491
 492                 dev->channels[i].sram_channels = &cx25821_sram_channels[i];
 493                 dev->channels[i].video_dev = NULL;
 494                 dev->channels[i].resources = 0;
 495
 496                 cx_write(dev->channels[i].sram_channels->int_stat, 0xffffffff);
 497
 498                 INIT_LIST_HEAD(&dev->channels[i].vidq.active);
 499                 INIT_LIST_HEAD(&dev->channels[i].vidq.queued);
 500
 501                 dev->channels[i].timeout_data.dev = dev;
 502                 dev->channels[i].timeout_data.channel =
 503                         &cx25821_sram_channels[i];
 504                 dev->channels[i].vidq.timeout.function =
 505                         cx25821_vid_timeout;
 506                 dev->channels[i].vidq.timeout.data =
 507                         (unsigned long)&dev->channels[i].timeout_data;
 508                 init_timer(&dev->channels[i].vidq.timeout);
 509
 510                 /* register v4l devices */
 511                 dev->channels[i].video_dev = cx25821_vdev_init(dev,
 512                                 dev->pci, &cx25821_video_device, "video");
 513
 514                 err = video_register_device(dev->channels[i].video_dev,
 515                                 VFL_TYPE_GRABBER, video_nr[dev->nr]);
 516
 517                 if (err < 0)
 518                         goto fail_unreg;
 519
 520         }
 521
 522         /* set PCI interrupt */
 523         cx_set(PCI_INT_MSK, 0xff);
 524
 525         /* initial device configuration */
 526         mutex_lock(&dev->lock);
 527 #ifdef TUNER_FLAG
 528         dev->tvnorm = cx25821_video_device.current_norm;
 529         cx25821_set_tvnorm(dev, dev->tvnorm);
 530 #endif
 531         mutex_unlock(&dev->lock);
 532
 533
 534         return 0;
 535
 536 fail_unreg:
 537         cx25821_video_unregister(dev, i);
 538         return err;
 539 }
 540
 541 int cx25821_buffer_setup(struct videobuf_queue *q, unsigned int *count,
 542                  unsigned int *size)
 543 {
 544         struct cx25821_fh *fh = q->priv_data;
 545
 546         *size = fh->fmt->depth * fh->width * fh->height >> 3;
 547
 548         if (0 == *count)
 549                 *count = 32;
 550
 551         if (*size * *count > vid_limit * 1024 * 1024)
 552                 *count = (vid_limit * 1024 * 1024) / *size;
 553
 554         return 0;
 555 }
 556
 557 int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
 558                    enum v4l2_field field)
 559 {
 560         struct cx25821_fh *fh = q->priv_data;
 561         struct cx25821_dev *dev = fh->dev;
 562         struct cx25821_buffer *buf =
 563             container_of(vb, struct cx25821_buffer, vb);
 564         int rc, init_buffer = 0;
 565         u32 line0_offset, line1_offset;
 566         struct videobuf_dmabuf *dma = videobuf_to_dma(&buf->vb);
 567         int bpl_local = LINE_SIZE_D1;
 568         int channel_opened = fh->channel_id;
 569
 570         BUG_ON(NULL == fh->fmt);
 571         if (fh->width < 48 || fh->width > 720 ||
 572             fh->height < 32 || fh->height > 576)
 573                 return -EINVAL;
 574
 575         buf->vb.size = (fh->width * fh->height * fh->fmt->depth) >> 3;
 576
 577         if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size)
 578                 return -EINVAL;
 579
 580         if (buf->fmt != fh->fmt ||
 581             buf->vb.width != fh->width ||
 582             buf->vb.height != fh->height || buf->vb.field != field) {
 583                 buf->fmt = fh->fmt;
 584                 buf->vb.width = fh->width;
 585                 buf->vb.height = fh->height;
 586                 buf->vb.field = field;
 587                 init_buffer = 1;
 588         }
 589
 590         if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {
 591                 init_buffer = 1;
 592                 rc = videobuf_iolock(q, &buf->vb, NULL);
 593                 if (0 != rc) {
 594                         printk(KERN_DEBUG pr_fmt("videobuf_iolock failed!\n"));
 595                         goto fail;
 596                 }
 597         }
 598
 599         dprintk(1, "init_buffer=%d\n", init_buffer);
 600
 601         if (init_buffer) {
 602
 603                 channel_opened = dev->channel_opened;
 604                 channel_opened = (channel_opened < 0
 605                                   || channel_opened > 7) ? 7 : channel_opened;
 606
 607                 if (dev->channels[channel_opened].pixel_formats ==
 608                                 PIXEL_FRMT_411)
 609                         buf->bpl = (buf->fmt->depth * buf->vb.width) >> 3;
 610                 else
 611                         buf->bpl = (buf->fmt->depth >> 3) * (buf->vb.width);
 612
 613                 if (dev->channels[channel_opened].pixel_formats ==
 614                                 PIXEL_FRMT_411) {
 615                         bpl_local = buf->bpl;
 616                 } else {
 617                         bpl_local = buf->bpl;   /* Default */
 618
 619                         if (channel_opened >= 0 && channel_opened <= 7) {
 620                                 if (dev->channels[channel_opened]
 621                                                 .use_cif_resolution) {
 622                                         if (dev->tvnorm & V4L2_STD_PAL_BG
 623                                             || dev->tvnorm & V4L2_STD_PAL_DK)
 624                                                 bpl_local = 352 << 1;
 625                                         else
 626                                                 bpl_local =
 627                                                  dev->channels[channel_opened].
 628                                                  cif_width <<
 629                                                  1;
 630                                 }
 631                         }
 632                 }
 633
 634                 switch (buf->vb.field) {
 635                 case V4L2_FIELD_TOP:
 636                         cx25821_risc_buffer(dev->pci, &buf->risc,
 637                                             dma->sglist, 0, UNSET,
 638                                             buf->bpl, 0, buf->vb.height);
 639                         break;
 640                 case V4L2_FIELD_BOTTOM:
 641                         cx25821_risc_buffer(dev->pci, &buf->risc,
 642                                             dma->sglist, UNSET, 0,
 643                                             buf->bpl, 0, buf->vb.height);
 644                         break;
 645                 case V4L2_FIELD_INTERLACED:
 646                         /* All other formats are top field first */
 647                         line0_offset = 0;
 648                         line1_offset = buf->bpl;
 649                         dprintk(1, "top field first\n");
 650
 651                         cx25821_risc_buffer(dev->pci, &buf->risc,
 652                                             dma->sglist, line0_offset,
 653                                             bpl_local, bpl_local, bpl_local,
 654                                             buf->vb.height >> 1);
 655                         break;
 656                 case V4L2_FIELD_SEQ_TB:
 657                         cx25821_risc_buffer(dev->pci, &buf->risc,
 658                                             dma->sglist,
 659                                             0, buf->bpl * (buf->vb.height >> 1),
 660                                             buf->bpl, 0, buf->vb.height >> 1);
 661                         break;
 662                 case V4L2_FIELD_SEQ_BT:
 663                         cx25821_risc_buffer(dev->pci, &buf->risc,
 664                                             dma->sglist,
 665                                             buf->bpl * (buf->vb.height >> 1), 0,
 666                                             buf->bpl, 0, buf->vb.height >> 1);
 667                         break;
 668                 default:
 669                         BUG();
 670                 }
 671         }
 672
 673         dprintk(2, "[%p/%d] buffer_prep - %dx%d %dbpp \"%s\" - dma=0x%08lx\n",
 674                 buf, buf->vb.i, fh->width, fh->height, fh->fmt->depth,
 675                 fh->fmt->name, (unsigned long)buf->risc.dma);
 676
 677         buf->vb.state = VIDEOBUF_PREPARED;
 678
 679         return 0;
 680
 681 fail:
 682         cx25821_free_buffer(q, buf);
 683         return rc;
 684 }
 685
 686 void cx25821_buffer_release(struct videobuf_queue *q,
 687                             struct videobuf_buffer *vb)
 688 {
 689         struct cx25821_buffer *buf =
 690             container_of(vb, struct cx25821_buffer, vb);
 691
 692         cx25821_free_buffer(q, buf);
 693 }
 694
 695 struct videobuf_queue *get_queue(struct cx25821_fh *fh)
 696 {
 697         switch (fh->type) {
 698         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 699                 return &fh->vidq;
 700         default:
 701                 BUG();
 702                 return NULL;
 703         }
 704 }
 705
 706 int cx25821_get_resource(struct cx25821_fh *fh, int resource)
 707 {
 708         switch (fh->type) {
 709         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 710                 return resource;
 711         default:
 712                 BUG();
 713                 return 0;
 714         }
 715 }
 716
 717 int cx25821_video_mmap(struct file *file, struct vm_area_struct *vma)
 718 {
 719         struct cx25821_fh *fh = file->private_data;
 720
 721         return videobuf_mmap_mapper(get_queue(fh), vma);
 722 }
 723
 724
 725 static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb)
 726 {
 727         struct cx25821_buffer *buf =
 728            container_of(vb, struct cx25821_buffer, vb);
 729         struct cx25821_buffer *prev;
 730         struct cx25821_fh *fh = vq->priv_data;
 731         struct cx25821_dev *dev = fh->dev;
 732         struct cx25821_dmaqueue *q = &dev->channels[fh->channel_id].vidq;
 733
 734         /* add jump to stopper */
 735         buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP | RISC_IRQ1 | RISC_CNT_INC);
 736         buf->risc.jmp[1] = cpu_to_le32(q->stopper.dma);
 737         buf->risc.jmp[2] = cpu_to_le32(0);      /* bits 63-32 */
 738
 739         dprintk(2, "jmp to stopper (0x%x)\n", buf->risc.jmp[1]);
 740
 741         if (!list_empty(&q->queued)) {
 742                 list_add_tail(&buf->vb.queue, &q->queued);
 743                 buf->vb.state = VIDEOBUF_QUEUED;
 744                 dprintk(2, "[%p/%d] buffer_queue - append to queued\n", buf,
 745                                 buf->vb.i);
 746
 747         } else if (list_empty(&q->active)) {
 748                 list_add_tail(&buf->vb.queue, &q->active);
 749                 cx25821_start_video_dma(dev, q, buf,
 750                                 dev->channels[fh->channel_id].sram_channels);
 751                 buf->vb.state = VIDEOBUF_ACTIVE;
 752                 buf->count = q->count++;
 753                 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
 754                 dprintk(2, "[%p/%d] buffer_queue - first active, buf cnt = %d, q->count = %d\n",
 755                                 buf, buf->vb.i, buf->count, q->count);
 756         } else {
 757                 prev = list_entry(q->active.prev, struct cx25821_buffer,
 758                                 vb.queue);
 759                 if (prev->vb.width == buf->vb.width
 760                    && prev->vb.height == buf->vb.height
 761                    && prev->fmt == buf->fmt) {
 762                         list_add_tail(&buf->vb.queue, &q->active);
 763                         buf->vb.state = VIDEOBUF_ACTIVE;
 764                         buf->count = q->count++;
 765                         prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
 766
 767                         /* 64 bit bits 63-32 */
 768                         prev->risc.jmp[2] = cpu_to_le32(0);
 769                         dprintk(2, "[%p/%d] buffer_queue - append to active, buf->count=%d\n",
 770                                         buf, buf->vb.i, buf->count);
 771
 772                 } else {
 773                         list_add_tail(&buf->vb.queue, &q->queued);
 774                         buf->vb.state = VIDEOBUF_QUEUED;
 775                         dprintk(2, "[%p/%d] buffer_queue - first queued\n", buf,
 776                                         buf->vb.i);
 777                 }
 778         }
 779
 780         if (list_empty(&q->active))
 781                 dprintk(2, "active queue empty!\n");
 782 }
 783
 784 static struct videobuf_queue_ops cx25821_video_qops = {
 785         .buf_setup = cx25821_buffer_setup,
 786         .buf_prepare = cx25821_buffer_prepare,
 787         .buf_queue = buffer_queue,
 788         .buf_release = cx25821_buffer_release,
 789 };
 790
 791 static int video_open(struct file *file)
 792 {
 793         struct video_device *vdev = video_devdata(file);
 794         struct cx25821_dev *h, *dev = video_drvdata(file);
 795         struct cx25821_fh *fh;
 796         struct list_head *list;
 797         int minor = video_devdata(file)->minor;
 798         enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 799         u32 pix_format;
 800         int ch_id = 0;
 801         int i;
 802
 803         dprintk(1, "open dev=%s type=%s\n", video_device_node_name(vdev),
 804                         v4l2_type_names[type]);
 805
 806         /* allocate + initialize per filehandle data */
 807         fh = kzalloc(sizeof(*fh), GFP_KERNEL);
 808         if (NULL == fh)
 809                 return -ENOMEM;
 810
 811         mutex_lock(&cx25821_devlist_mutex);
 812
 813        list_for_each(list, &cx25821_devlist)
 814        {
 815                h = list_entry(list, struct cx25821_dev, devlist);
 816
 817                for (i = 0; i < MAX_VID_CHANNEL_NUM; i++) {
 818                        if (h->channels[i].video_dev &&
 819                            h->channels[i].video_dev->minor == minor) {
 820                                dev = h;
 821                                ch_id = i;
 822                                type  = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 823                        }
 824                }
 825        }
 826
 827        if (NULL == dev) {
 828                 mutex_unlock(&cx25821_devlist_mutex);
 829                 kfree(fh);
 830                 return -ENODEV;
 831        }
 832
 833        file->private_data = fh;
 834        fh->dev = dev;
 835        fh->type = type;
 836        fh->width = 720;
 837     fh->channel_id = ch_id;
 838
 839        if (dev->tvnorm & V4L2_STD_PAL_BG || dev->tvnorm & V4L2_STD_PAL_DK)
 840                fh->height = 576;
 841        else
 842                fh->height = 480;
 843
 844        dev->channel_opened = fh->channel_id;
 845        pix_format =
 846            (dev->channels[ch_id].pixel_formats ==
 847             PIXEL_FRMT_411) ? V4L2_PIX_FMT_Y41P : V4L2_PIX_FMT_YUYV;
 848        fh->fmt = cx25821_format_by_fourcc(pix_format);
 849
 850        v4l2_prio_open(&dev->channels[ch_id].prio, &fh->prio);
 851
 852        videobuf_queue_sg_init(&fh->vidq, &cx25821_video_qops,
 853                               &dev->pci->dev, &dev->slock,
 854                               V4L2_BUF_TYPE_VIDEO_CAPTURE,
 855                               V4L2_FIELD_INTERLACED,
 856                               sizeof(struct cx25821_buffer), fh, NULL);
 857
 858        dprintk(1, "post videobuf_queue_init()\n");
 859         mutex_unlock(&cx25821_devlist_mutex);
 860
 861        return 0;
 862 }
 863
 864 static ssize_t video_read(struct file *file, char __user * data, size_t count,
 865                          loff_t *ppos)
 866 {
 867        struct cx25821_fh *fh = file->private_data;
 868
 869        switch (fh->type) {
 870        case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 871                if (cx25821_res_locked(fh, RESOURCE_VIDEO0))
 872                        return -EBUSY;
 873
 874                return videobuf_read_one(&fh->vidq, data, count, ppos,
 875                                         file->f_flags & O_NONBLOCK);
 876
 877        default:
 878                BUG();
 879                return 0;
 880        }
 881 }
 882
 883 static unsigned int video_poll(struct file *file,
 884                               struct poll_table_struct *wait)
 885 {
 886        struct cx25821_fh *fh = file->private_data;
 887        struct cx25821_buffer *buf;
 888
 889        if (cx25821_res_check(fh, RESOURCE_VIDEO0)) {
 890                /* streaming capture */
 891                if (list_empty(&fh->vidq.stream))
 892                        return POLLERR;
 893                buf = list_entry(fh->vidq.stream.next,
 894                                 struct cx25821_buffer, vb.stream);
 895        } else {
 896                /* read() capture */
 897                buf = (struct cx25821_buffer *)fh->vidq.read_buf;
 898                if (NULL == buf)
 899                        return POLLERR;
 900        }
 901
 902        poll_wait(file, &buf->vb.done, wait);
 903        if (buf->vb.state == VIDEOBUF_DONE || buf->vb.state == VIDEOBUF_ERROR) {
 904                if (buf->vb.state == VIDEOBUF_DONE) {
 905                        struct cx25821_dev *dev = fh->dev;
 906
 907                        if (dev && dev->channels[fh->channel_id]
 908                                                .use_cif_resolution) {
 909                                u8 cam_id = *((char *)buf->vb.baddr + 3);
 910                                memcpy((char *)buf->vb.baddr,
 911                                       (char *)buf->vb.baddr + (fh->width * 2),
 912                                       (fh->width * 2));
 913                                *((char *)buf->vb.baddr + 3) = cam_id;
 914                        }
 915                }
 916
 917                return POLLIN | POLLRDNORM;
 918        }
 919
 920        return 0;
 921 }
 922
 923 static int video_release(struct file *file)
 924 {
 925        struct cx25821_fh *fh = file->private_data;
 926        struct cx25821_dev *dev = fh->dev;
 927
 928        /* stop the risc engine and fifo */
 929        cx_write(channel0->dma_ctl, 0); /* FIFO and RISC disable */
 930
 931        /* stop video capture */
 932        if (cx25821_res_check(fh, RESOURCE_VIDEO0)) {
 933                videobuf_queue_cancel(&fh->vidq);
 934                cx25821_res_free(dev, fh, RESOURCE_VIDEO0);
 935        }
 936
 937        if (fh->vidq.read_buf) {
 938                cx25821_buffer_release(&fh->vidq, fh->vidq.read_buf);
 939                kfree(fh->vidq.read_buf);
 940        }
 941
 942        videobuf_mmap_free(&fh->vidq);
 943
 944        v4l2_prio_close(&dev->channels[fh->channel_id].prio, fh->prio);
 945        file->private_data = NULL;
 946        kfree(fh);
 947
 948        return 0;
 949 }
 950
 951 static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
 952 {
 953        struct cx25821_fh *fh = priv;
 954        struct cx25821_dev *dev = fh->dev;
 955
 956        if (unlikely(fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE))
 957                return -EINVAL;
 958
 959        if (unlikely(i != fh->type))
 960                return -EINVAL;
 961
 962        if (unlikely(!cx25821_res_get(dev, fh,
 963                        cx25821_get_resource(fh, RESOURCE_VIDEO0))))
 964                return -EBUSY;
 965
 966        return videobuf_streamon(get_queue(fh));
 967 }
 968
 969 static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
 970 {
 971        struct cx25821_fh *fh = priv;
 972        struct cx25821_dev *dev = fh->dev;
 973        int err, res;
 974
 975        if (fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
 976                return -EINVAL;
 977        if (i != fh->type)
 978                return -EINVAL;
 979
 980        res = cx25821_get_resource(fh, RESOURCE_VIDEO0);
 981        err = videobuf_streamoff(get_queue(fh));
 982        if (err < 0)
 983                return err;
 984        cx25821_res_free(dev, fh, res);
 985        return 0;
 986 }
 987
 988 static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
 989                                 struct v4l2_format *f)
 990 {
 991        struct cx25821_fh *fh = priv;
 992        struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
 993         struct v4l2_mbus_framefmt mbus_fmt;
 994        int err;
 995        int pix_format = PIXEL_FRMT_422;
 996
 997        if (fh) {
 998                err = v4l2_prio_check(&dev->channels[fh->channel_id]
 999                                                .prio, fh->prio);
1000                if (0 != err)
1001                        return err;
1002        }
1003
1004        dprintk(2, "%s()\n", __func__);
1005        err = cx25821_vidioc_try_fmt_vid_cap(file, priv, f);
1006
1007        if (0 != err)
1008                return err;
1009
1010        fh->fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
1011        fh->vidq.field = f->fmt.pix.field;
1012
1013        /* check if width and height is valid based on set standard */
1014        if (cx25821_is_valid_width(f->fmt.pix.width, dev->tvnorm))
1015                fh->width = f->fmt.pix.width;
1016
1017        if (cx25821_is_valid_height(f->fmt.pix.height, dev->tvnorm))
1018                fh->height = f->fmt.pix.height;
1019
1020        if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_Y41P)
1021                pix_format = PIXEL_FRMT_411;
1022        else if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_YUYV)
1023                pix_format = PIXEL_FRMT_422;
1024        else
1025                return -EINVAL;
1026
1027        cx25821_set_pixel_format(dev, SRAM_CH00, pix_format);
1028
1029        /* check if cif resolution */
1030        if (fh->width == 320 || fh->width == 352)
1031                dev->channels[fh->channel_id].use_cif_resolution = 1;
1032        else
1033                dev->channels[fh->channel_id].use_cif_resolution = 0;
1034
1035        dev->channels[fh->channel_id].cif_width = fh->width;
1036        medusa_set_resolution(dev, fh->width, SRAM_CH00);
1037
1038         dprintk(2, "%s(): width=%d height=%d field=%d\n", __func__, fh->width,
1039                 fh->height, fh->vidq.field);
1040         v4l2_fill_mbus_format(&mbus_fmt, &f->fmt.pix, V4L2_MBUS_FMT_FIXED);
1041         cx25821_call_all(dev, video, s_mbus_fmt, &mbus_fmt);
1042
1043        return 0;
1044 }
1045
1046 static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *p)
1047 {
1048        int ret_val = 0;
1049        struct cx25821_fh *fh = priv;
1050        struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1051
1052        ret_val = videobuf_dqbuf(get_queue(fh), p, file->f_flags & O_NONBLOCK);
1053
1054     p->sequence = dev->channels[fh->channel_id].vidq.count;
1055
1056        return ret_val;
1057 }
1058
1059 static int vidioc_log_status(struct file *file, void *priv)
1060 {
1061        struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1062        struct cx25821_fh *fh = priv;
1063        char name[32 + 2];
1064
1065        struct sram_channel *sram_ch = dev->channels[fh->channel_id]
1066                                                        .sram_channels;
1067        u32 tmp = 0;
1068
1069        snprintf(name, sizeof(name), "%s/2", dev->name);
1070         pr_info("%s/2: ============  START LOG STATUS  ============\n",
1071                 dev->name);
1072        cx25821_call_all(dev, core, log_status);
1073        tmp = cx_read(sram_ch->dma_ctl);
1074         pr_info("Video input 0 is %s\n",
1075                 (tmp & 0x11) ? "streaming" : "stopped");
1076         pr_info("%s/2: =============  END LOG STATUS  =============\n",
1077                 dev->name);
1078        return 0;
1079 }
1080
1081 static int vidioc_s_ctrl(struct file *file, void *priv,
1082                         struct v4l2_control *ctl)
1083 {
1084        struct cx25821_fh *fh = priv;
1085        struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1086        int err;
1087
1088        if (fh) {
1089                err = v4l2_prio_check(&dev->channels[fh->channel_id]
1090                                                .prio, fh->prio);
1091                if (0 != err)
1092                        return err;
1093        }
1094
1095        return cx25821_set_control(dev, ctl, fh->channel_id);
1096 }
1097
1098 /* VIDEO IOCTLS */
1099 int cx25821_vidioc_g_fmt_vid_cap(struct file *file, void *priv,
1100                                  struct v4l2_format *f)
1101 {
1102         struct cx25821_fh *fh = priv;
1103
1104         f->fmt.pix.width = fh->width;
1105         f->fmt.pix.height = fh->height;
1106         f->fmt.pix.field = fh->vidq.field;
1107         f->fmt.pix.pixelformat = fh->fmt->fourcc;
1108         f->fmt.pix.bytesperline = (f->fmt.pix.width * fh->fmt->depth) >> 3;
1109         f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
1110
1111         return 0;
1112 }
1113
1114 int cx25821_vidioc_try_fmt_vid_cap(struct file *file, void *priv,
1115                                    struct v4l2_format *f)
1116 {
1117         struct cx25821_fmt *fmt;
1118         enum v4l2_field field;
1119         unsigned int maxw, maxh;
1120
1121         fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
1122         if (NULL == fmt)
1123                 return -EINVAL;
1124
1125         field = f->fmt.pix.field;
1126         maxw = 720;
1127         maxh = 576;
1128
1129         if (V4L2_FIELD_ANY == field) {
1130                 field = (f->fmt.pix.height > maxh / 2)
1131                     ? V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP;
1132         }
1133
1134         switch (field) {
1135         case V4L2_FIELD_TOP:
1136         case V4L2_FIELD_BOTTOM:
1137                 maxh = maxh / 2;
1138                 break;
1139         case V4L2_FIELD_INTERLACED:
1140                 break;
1141         default:
1142                 return -EINVAL;
1143         }
1144
1145         f->fmt.pix.field = field;
1146         if (f->fmt.pix.height < 32)
1147                 f->fmt.pix.height = 32;
1148         if (f->fmt.pix.height > maxh)
1149                 f->fmt.pix.height = maxh;
1150         if (f->fmt.pix.width < 48)
1151                 f->fmt.pix.width = 48;
1152         if (f->fmt.pix.width > maxw)
1153                 f->fmt.pix.width = maxw;
1154         f->fmt.pix.width &= ~0x03;
1155         f->fmt.pix.bytesperline = (f->fmt.pix.width * fmt->depth) >> 3;
1156         f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
1157
1158         return 0;
1159 }
1160
1161 int cx25821_vidioc_querycap(struct file *file, void *priv,
1162                             struct v4l2_capability *cap)
1163 {
1164         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1165
1166         strcpy(cap->driver, "cx25821");
1167         strlcpy(cap->card, cx25821_boards[dev->board].name, sizeof(cap->card));
1168         sprintf(cap->bus_info, "PCIe:%s", pci_name(dev->pci));
1169         cap->version = CX25821_VERSION_CODE;
1170         cap->capabilities =
1171             V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE | V4L2_CAP_STREAMING;
1172         if (UNSET != dev->tuner_type)
1173                 cap->capabilities |= V4L2_CAP_TUNER;
1174         return 0;
1175 }
1176
1177 int cx25821_vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
1178                             struct v4l2_fmtdesc *f)
1179 {
1180         if (unlikely(f->index >= ARRAY_SIZE(formats)))
1181                 return -EINVAL;
1182
1183         strlcpy(f->description, formats[f->index].name, sizeof(f->description));
1184         f->pixelformat = formats[f->index].fourcc;
1185
1186         return 0;
1187 }
1188
1189 int cx25821_vidioc_reqbufs(struct file *file, void *priv,
1190                            struct v4l2_requestbuffers *p)
1191 {
1192         struct cx25821_fh *fh = priv;
1193         return videobuf_reqbufs(get_queue(fh), p);
1194 }
1195
1196 int cx25821_vidioc_querybuf(struct file *file, void *priv,
1197                             struct v4l2_buffer *p)
1198 {
1199         struct cx25821_fh *fh = priv;
1200         return videobuf_querybuf(get_queue(fh), p);
1201 }
1202
1203 int cx25821_vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *p)
1204 {
1205         struct cx25821_fh *fh = priv;
1206         return videobuf_qbuf(get_queue(fh), p);
1207 }
1208
1209 int cx25821_vidioc_g_priority(struct file *file, void *f, enum v4l2_priority *p)
1210 {
1211         struct cx25821_dev *dev = ((struct cx25821_fh *)f)->dev;
1212        struct cx25821_fh *fh = f;
1213
1214        *p = v4l2_prio_max(&dev->channels[fh->channel_id].prio);
1215
1216         return 0;
1217 }
1218
1219 int cx25821_vidioc_s_priority(struct file *file, void *f,
1220                               enum v4l2_priority prio)
1221 {
1222         struct cx25821_fh *fh = f;
1223         struct cx25821_dev *dev = ((struct cx25821_fh *)f)->dev;
1224
1225        return v4l2_prio_change(&dev->channels[fh->channel_id]
1226                                        .prio, &fh->prio, prio);
1227 }
1228
1229 #ifdef TUNER_FLAG
1230 int cx25821_vidioc_s_std(struct file *file, void *priv, v4l2_std_id * tvnorms)
1231 {
1232         struct cx25821_fh *fh = priv;
1233         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1234         int err;
1235
1236         dprintk(1, "%s()\n", __func__);
1237
1238         if (fh) {
1239                err = v4l2_prio_check(&dev->channels[fh->channel_id]
1240                                                .prio, fh->prio);
1241                 if (0 != err)
1242                         return err;
1243         }
1244
1245         if (dev->tvnorm == *tvnorms) {
1246                 return 0;
1247         }
1248
1249         mutex_lock(&dev->lock);
1250         cx25821_set_tvnorm(dev, *tvnorms);
1251         mutex_unlock(&dev->lock);
1252
1253         medusa_set_videostandard(dev);
1254
1255         return 0;
1256 }
1257 #endif
1258
1259 int cx25821_enum_input(struct cx25821_dev *dev, struct v4l2_input *i)
1260 {
1261         static const char *iname[] = {
1262                 [CX25821_VMUX_COMPOSITE] = "Composite",
1263                 [CX25821_VMUX_SVIDEO] = "S-Video",
1264                 [CX25821_VMUX_DEBUG] = "for debug only",
1265         };
1266         unsigned int n;
1267         dprintk(1, "%s()\n", __func__);
1268
1269         n = i->index;
1270         if (n >= 2)
1271                 return -EINVAL;
1272
1273         if (0 == INPUT(n)->type)
1274                 return -EINVAL;
1275
1276         i->type = V4L2_INPUT_TYPE_CAMERA;
1277         strcpy(i->name, iname[INPUT(n)->type]);
1278
1279         i->std = CX25821_NORMS;
1280         return 0;
1281 }
1282
1283 int cx25821_vidioc_enum_input(struct file *file, void *priv,
1284                               struct v4l2_input *i)
1285 {
1286         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1287         dprintk(1, "%s()\n", __func__);
1288         return cx25821_enum_input(dev, i);
1289 }
1290
1291 int cx25821_vidioc_g_input(struct file *file, void *priv, unsigned int *i)
1292 {
1293         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1294
1295         *i = dev->input;
1296         dprintk(1, "%s(): returns %d\n", __func__, *i);
1297         return 0;
1298 }
1299
1300 int cx25821_vidioc_s_input(struct file *file, void *priv, unsigned int i)
1301 {
1302         struct cx25821_fh *fh = priv;
1303         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1304         int err;
1305
1306         dprintk(1, "%s(%d)\n", __func__, i);
1307
1308         if (fh) {
1309                err = v4l2_prio_check(&dev->channels[fh->channel_id]
1310                                                .prio, fh->prio);
1311                 if (0 != err)
1312                         return err;
1313         }
1314
1315         if (i > 2) {
1316                 dprintk(1, "%s(): -EINVAL\n", __func__);
1317                 return -EINVAL;
1318         }
1319
1320         mutex_lock(&dev->lock);
1321         cx25821_video_mux(dev, i);
1322         mutex_unlock(&dev->lock);
1323         return 0;
1324 }
1325
1326 #ifdef TUNER_FLAG
1327 int cx25821_vidioc_g_frequency(struct file *file, void *priv,
1328                                struct v4l2_frequency *f)
1329 {
1330         struct cx25821_fh *fh = priv;
1331         struct cx25821_dev *dev = fh->dev;
1332
1333         f->frequency = dev->freq;
1334
1335         cx25821_call_all(dev, tuner, g_frequency, f);
1336
1337         return 0;
1338 }
1339
1340 int cx25821_set_freq(struct cx25821_dev *dev, struct v4l2_frequency *f)
1341 {
1342         mutex_lock(&dev->lock);
1343         dev->freq = f->frequency;
1344
1345         cx25821_call_all(dev, tuner, s_frequency, f);
1346
1347         /* When changing channels it is required to reset TVAUDIO */
1348         msleep(10);
1349
1350         mutex_unlock(&dev->lock);
1351
1352         return 0;
1353 }
1354
1355 int cx25821_vidioc_s_frequency(struct file *file, void *priv,
1356                                struct v4l2_frequency *f)
1357 {
1358         struct cx25821_fh *fh = priv;
1359         struct cx25821_dev *dev;
1360         int err;
1361
1362         if (fh) {
1363                dev = fh->dev;
1364                err = v4l2_prio_check(&dev->channels[fh->channel_id]
1365                                                .prio, fh->prio);
1366                 if (0 != err)
1367                         return err;
1368        } else {
1369                pr_err("Invalid fh pointer!\n");
1370                return -EINVAL;
1371         }
1372
1373         return cx25821_set_freq(dev, f);
1374 }
1375 #endif
1376
1377 #ifdef CONFIG_VIDEO_ADV_DEBUG
1378 int cx25821_vidioc_g_register(struct file *file, void *fh,
1379                       struct v4l2_dbg_register *reg)
1380 {
1381         struct cx25821_dev *dev = ((struct cx25821_fh *)fh)->dev;
1382
1383         if (!v4l2_chip_match_host(&reg->match))
1384                 return -EINVAL;
1385
1386         cx25821_call_all(dev, core, g_register, reg);
1387
1388         return 0;
1389 }
1390
1391 int cx25821_vidioc_s_register(struct file *file, void *fh,
1392                       struct v4l2_dbg_register *reg)
1393 {
1394         struct cx25821_dev *dev = ((struct cx25821_fh *)fh)->dev;
1395
1396         if (!v4l2_chip_match_host(&reg->match))
1397                 return -EINVAL;
1398
1399         cx25821_call_all(dev, core, s_register, reg);
1400
1401         return 0;
1402 }
1403
1404 #endif
1405
1406 #ifdef TUNER_FLAG
1407 int cx25821_vidioc_g_tuner(struct file *file, void *priv, struct v4l2_tuner *t)
1408 {
1409         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1410
1411         if (unlikely(UNSET == dev->tuner_type))
1412                 return -EINVAL;
1413         if (0 != t->index)
1414                 return -EINVAL;
1415
1416         strcpy(t->name, "Television");
1417         t->type = V4L2_TUNER_ANALOG_TV;
1418         t->capability = V4L2_TUNER_CAP_NORM;
1419         t->rangehigh = 0xffffffffUL;
1420
1421         t->signal = 0xffff;     /* LOCKED */
1422         return 0;
1423 }
1424
1425 int cx25821_vidioc_s_tuner(struct file *file, void *priv, struct v4l2_tuner *t)
1426 {
1427         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1428         struct cx25821_fh *fh = priv;
1429         int err;
1430
1431         if (fh) {
1432                err = v4l2_prio_check(&dev->channels[fh->channel_id]
1433                                                .prio, fh->prio);
1434                 if (0 != err)
1435                         return err;
1436         }
1437
1438         dprintk(1, "%s()\n", __func__);
1439         if (UNSET == dev->tuner_type)
1440                 return -EINVAL;
1441         if (0 != t->index)
1442                 return -EINVAL;
1443
1444         return 0;
1445 }
1446
1447 #endif
1448 /*****************************************************************************/
1449 static const struct v4l2_queryctrl no_ctl = {
1450         .name = "42",
1451         .flags = V4L2_CTRL_FLAG_DISABLED,
1452 };
1453
1454 static struct v4l2_queryctrl cx25821_ctls[] = {
1455         /* --- video --- */
1456         {
1457          .id = V4L2_CID_BRIGHTNESS,
1458          .name = "Brightness",
1459          .minimum = 0,
1460          .maximum = 10000,
1461          .step = 1,
1462          .default_value = 6200,
1463          .type = V4L2_CTRL_TYPE_INTEGER,
1464          }, {
1465              .id = V4L2_CID_CONTRAST,
1466              .name = "Contrast",
1467              .minimum = 0,
1468              .maximum = 10000,
1469              .step = 1,
1470              .default_value = 5000,
1471              .type = V4L2_CTRL_TYPE_INTEGER,
1472              }, {
1473                  .id = V4L2_CID_SATURATION,
1474                  .name = "Saturation",
1475                  .minimum = 0,
1476                  .maximum = 10000,
1477                  .step = 1,
1478                  .default_value = 5000,
1479                  .type = V4L2_CTRL_TYPE_INTEGER,
1480                  }, {
1481                      .id = V4L2_CID_HUE,
1482                      .name = "Hue",
1483                      .minimum = 0,
1484                      .maximum = 10000,
1485                      .step = 1,
1486                      .default_value = 5000,
1487                      .type = V4L2_CTRL_TYPE_INTEGER,
1488                      }
1489 };
1490 static const int CX25821_CTLS = ARRAY_SIZE(cx25821_ctls);
1491
1492 static int cx25821_ctrl_query(struct v4l2_queryctrl *qctrl)
1493 {
1494         int i;
1495
1496         if (qctrl->id < V4L2_CID_BASE || qctrl->id >= V4L2_CID_LASTP1)
1497                 return -EINVAL;
1498         for (i = 0; i < CX25821_CTLS; i++)
1499                 if (cx25821_ctls[i].id == qctrl->id)
1500                         break;
1501         if (i == CX25821_CTLS) {
1502                 *qctrl = no_ctl;
1503                 return 0;
1504         }
1505         *qctrl = cx25821_ctls[i];
1506         return 0;
1507 }
1508
1509 int cx25821_vidioc_queryctrl(struct file *file, void *priv,
1510                      struct v4l2_queryctrl *qctrl)
1511 {
1512         return cx25821_ctrl_query(qctrl);
1513 }
1514
1515 /* ------------------------------------------------------------------ */
1516 /* VIDEO CTRL IOCTLS                                                  */
1517
1518 static const struct v4l2_queryctrl *ctrl_by_id(unsigned int id)
1519 {
1520         unsigned int i;
1521
1522         for (i = 0; i < CX25821_CTLS; i++)
1523                 if (cx25821_ctls[i].id == id)
1524                         return cx25821_ctls + i;
1525         return NULL;
1526 }
1527
1528 int cx25821_vidioc_g_ctrl(struct file *file, void *priv,
1529                           struct v4l2_control *ctl)
1530 {
1531         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1532        struct cx25821_fh *fh = priv;
1533
1534         const struct v4l2_queryctrl *ctrl;
1535
1536         ctrl = ctrl_by_id(ctl->id);
1537
1538         if (NULL == ctrl)
1539                 return -EINVAL;
1540         switch (ctl->id) {
1541         case V4L2_CID_BRIGHTNESS:
1542                ctl->value = dev->channels[fh->channel_id].ctl_bright;
1543                 break;
1544         case V4L2_CID_HUE:
1545                ctl->value = dev->channels[fh->channel_id].ctl_hue;
1546                 break;
1547         case V4L2_CID_CONTRAST:
1548                ctl->value = dev->channels[fh->channel_id].ctl_contrast;
1549                 break;
1550         case V4L2_CID_SATURATION:
1551                ctl->value = dev->channels[fh->channel_id].ctl_saturation;
1552                 break;
1553         }
1554         return 0;
1555 }
1556
1557 int cx25821_set_control(struct cx25821_dev *dev,
1558                         struct v4l2_control *ctl, int chan_num)
1559 {
1560         int err;
1561         const struct v4l2_queryctrl *ctrl;
1562
1563         err = -EINVAL;
1564
1565         ctrl = ctrl_by_id(ctl->id);
1566
1567         if (NULL == ctrl)
1568                 return err;
1569
1570         switch (ctrl->type) {
1571         case V4L2_CTRL_TYPE_BOOLEAN:
1572         case V4L2_CTRL_TYPE_MENU:
1573         case V4L2_CTRL_TYPE_INTEGER:
1574                 if (ctl->value < ctrl->minimum)
1575                         ctl->value = ctrl->minimum;
1576                 if (ctl->value > ctrl->maximum)
1577                         ctl->value = ctrl->maximum;
1578                 break;
1579         default:
1580                 /* nothing */ ;
1581         }
1582
1583         switch (ctl->id) {
1584         case V4L2_CID_BRIGHTNESS:
1585                dev->channels[chan_num].ctl_bright = ctl->value;
1586                 medusa_set_brightness(dev, ctl->value, chan_num);
1587                 break;
1588         case V4L2_CID_HUE:
1589                dev->channels[chan_num].ctl_hue = ctl->value;
1590                 medusa_set_hue(dev, ctl->value, chan_num);
1591                 break;
1592         case V4L2_CID_CONTRAST:
1593                dev->channels[chan_num].ctl_contrast = ctl->value;
1594                 medusa_set_contrast(dev, ctl->value, chan_num);
1595                 break;
1596         case V4L2_CID_SATURATION:
1597                dev->channels[chan_num].ctl_saturation = ctl->value;
1598                 medusa_set_saturation(dev, ctl->value, chan_num);
1599                 break;
1600         }
1601
1602         err = 0;
1603
1604         return err;
1605 }
1606
1607 static void cx25821_init_controls(struct cx25821_dev *dev, int chan_num)
1608 {
1609         struct v4l2_control ctrl;
1610         int i;
1611         for (i = 0; i < CX25821_CTLS; i++) {
1612                 ctrl.id = cx25821_ctls[i].id;
1613                 ctrl.value = cx25821_ctls[i].default_value;
1614
1615                 cx25821_set_control(dev, &ctrl, chan_num);
1616         }
1617 }
1618
1619 int cx25821_vidioc_cropcap(struct file *file, void *priv,
1620                            struct v4l2_cropcap *cropcap)
1621 {
1622         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1623
1624         if (cropcap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
1625                 return -EINVAL;
1626         cropcap->bounds.top = cropcap->bounds.left = 0;
1627         cropcap->bounds.width = 720;
1628         cropcap->bounds.height = dev->tvnorm == V4L2_STD_PAL_BG ? 576 : 480;
1629         cropcap->pixelaspect.numerator =
1630             dev->tvnorm == V4L2_STD_PAL_BG ? 59 : 10;
1631         cropcap->pixelaspect.denominator =
1632             dev->tvnorm == V4L2_STD_PAL_BG ? 54 : 11;
1633         cropcap->defrect = cropcap->bounds;
1634         return 0;
1635 }
1636
1637 int cx25821_vidioc_s_crop(struct file *file, void *priv, struct v4l2_crop *crop)
1638 {
1639         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1640         struct cx25821_fh *fh = priv;
1641         int err;
1642
1643         if (fh) {
1644                err = v4l2_prio_check(&dev->channels[fh->channel_id].
1645                                                prio, fh->prio);
1646                 if (0 != err)
1647                         return err;
1648         }
1649        /* cx25821_vidioc_s_crop not supported */
1650         return -EINVAL;
1651 }
1652
1653 int cx25821_vidioc_g_crop(struct file *file, void *priv, struct v4l2_crop *crop)
1654 {
1655        /* cx25821_vidioc_g_crop not supported */
1656         return -EINVAL;
1657 }
1658
1659 int cx25821_vidioc_querystd(struct file *file, void *priv, v4l2_std_id * norm)
1660 {
1661        /* medusa does not support video standard sensing of current input */
1662         *norm = CX25821_NORMS;
1663
1664         return 0;
1665 }
1666
1667 int cx25821_is_valid_width(u32 width, v4l2_std_id tvnorm)
1668 {
1669         if (tvnorm == V4L2_STD_PAL_BG) {
1670                 if (width == 352 || width == 720)
1671                         return 1;
1672                 else
1673                         return 0;
1674         }
1675
1676         if (tvnorm == V4L2_STD_NTSC_M) {
1677                 if (width == 320 || width == 352 || width == 720)
1678                         return 1;
1679                 else
1680                         return 0;
1681         }
1682         return 0;
1683 }
1684
1685 int cx25821_is_valid_height(u32 height, v4l2_std_id tvnorm)
1686 {
1687         if (tvnorm == V4L2_STD_PAL_BG) {
1688                 if (height == 576 || height == 288)
1689                         return 1;
1690                 else
1691                         return 0;
1692         }
1693
1694         if (tvnorm == V4L2_STD_NTSC_M) {
1695                 if (height == 480 || height == 240)
1696                         return 1;
1697                 else
1698                         return 0;
1699         }
1700
1701         return 0;
1702 }
1703
1704 static long video_ioctl_upstream9(struct file *file, unsigned int cmd,
1705                                  unsigned long arg)
1706 {
1707        struct cx25821_fh *fh = file->private_data;
1708        struct cx25821_dev *dev = fh->dev;
1709        int command = 0;
1710        struct upstream_user_struct *data_from_user;
1711
1712        data_from_user = (struct upstream_user_struct *)arg;
1713
1714         if (!data_from_user) {
1715                 pr_err("%s(): Upstream data is INVALID. Returning\n", __func__);
1716                 return 0;
1717         }
1718
1719        command = data_from_user->command;
1720
1721        if (command != UPSTREAM_START_VIDEO &&
1722                command != UPSTREAM_STOP_VIDEO)
1723                return 0;
1724
1725        dev->input_filename = data_from_user->input_filename;
1726        dev->input_audiofilename = data_from_user->input_filename;
1727        dev->vid_stdname = data_from_user->vid_stdname;
1728        dev->pixel_format = data_from_user->pixel_format;
1729        dev->channel_select = data_from_user->channel_select;
1730        dev->command = data_from_user->command;
1731
1732        switch (command) {
1733        case UPSTREAM_START_VIDEO:
1734                cx25821_start_upstream_video_ch1(dev, data_from_user);
1735                break;
1736
1737        case UPSTREAM_STOP_VIDEO:
1738                cx25821_stop_upstream_video_ch1(dev);
1739                break;
1740        }
1741
1742        return 0;
1743 }
1744
1745 static long video_ioctl_upstream10(struct file *file, unsigned int cmd,
1746                                   unsigned long arg)
1747 {
1748        struct cx25821_fh *fh = file->private_data;
1749        struct cx25821_dev *dev = fh->dev;
1750        int command = 0;
1751        struct upstream_user_struct *data_from_user;
1752
1753        data_from_user = (struct upstream_user_struct *)arg;
1754
1755         if (!data_from_user) {
1756                 pr_err("%s(): Upstream data is INVALID. Returning\n", __func__);
1757                 return 0;
1758         }
1759
1760        command = data_from_user->command;
1761
1762        if (command != UPSTREAM_START_VIDEO &&
1763                command != UPSTREAM_STOP_VIDEO)
1764                return 0;
1765
1766        dev->input_filename_ch2 = data_from_user->input_filename;
1767        dev->input_audiofilename = data_from_user->input_filename;
1768        dev->vid_stdname_ch2 = data_from_user->vid_stdname;
1769        dev->pixel_format_ch2 = data_from_user->pixel_format;
1770        dev->channel_select_ch2 = data_from_user->channel_select;
1771        dev->command_ch2 = data_from_user->command;
1772
1773        switch (command) {
1774        case UPSTREAM_START_VIDEO:
1775                cx25821_start_upstream_video_ch2(dev, data_from_user);
1776                break;
1777
1778        case UPSTREAM_STOP_VIDEO:
1779                cx25821_stop_upstream_video_ch2(dev);
1780                break;
1781        }
1782
1783        return 0;
1784 }
1785
1786 static long video_ioctl_upstream11(struct file *file, unsigned int cmd,
1787                                   unsigned long arg)
1788 {
1789        struct cx25821_fh *fh = file->private_data;
1790        struct cx25821_dev *dev = fh->dev;
1791        int command = 0;
1792        struct upstream_user_struct *data_from_user;
1793
1794        data_from_user = (struct upstream_user_struct *)arg;
1795
1796         if (!data_from_user) {
1797                 pr_err("%s(): Upstream data is INVALID. Returning\n", __func__);
1798                 return 0;
1799         }
1800
1801        command = data_from_user->command;
1802
1803        if (command != UPSTREAM_START_AUDIO &&
1804                command != UPSTREAM_STOP_AUDIO)
1805                return 0;
1806
1807        dev->input_filename = data_from_user->input_filename;
1808        dev->input_audiofilename = data_from_user->input_filename;
1809        dev->vid_stdname = data_from_user->vid_stdname;
1810        dev->pixel_format = data_from_user->pixel_format;
1811        dev->channel_select = data_from_user->channel_select;
1812        dev->command = data_from_user->command;
1813
1814        switch (command) {
1815        case UPSTREAM_START_AUDIO:
1816                cx25821_start_upstream_audio(dev, data_from_user);
1817                break;
1818
1819        case UPSTREAM_STOP_AUDIO:
1820                cx25821_stop_upstream_audio(dev);
1821                break;
1822        }
1823
1824        return 0;
1825 }
1826
1827 static long video_ioctl_set(struct file *file, unsigned int cmd,
1828                            unsigned long arg)
1829 {
1830        struct cx25821_fh *fh = file->private_data;
1831        struct cx25821_dev *dev = fh->dev;
1832        struct downstream_user_struct *data_from_user;
1833        int command;
1834        int width = 720;
1835        int selected_channel = 0, pix_format = 0, i = 0;
1836        int cif_enable = 0, cif_width = 0;
1837        u32 value = 0;
1838
1839        data_from_user = (struct downstream_user_struct *)arg;
1840
1841         if (!data_from_user) {
1842                 pr_err("%s(): User data is INVALID. Returning\n", __func__);
1843                 return 0;
1844         }
1845
1846        command = data_from_user->command;
1847
1848        if (command != SET_VIDEO_STD && command != SET_PIXEL_FORMAT
1849            && command != ENABLE_CIF_RESOLUTION && command != REG_READ
1850            && command != REG_WRITE && command != MEDUSA_READ
1851            && command != MEDUSA_WRITE) {
1852                return 0;
1853        }
1854
1855        switch (command) {
1856        case SET_VIDEO_STD:
1857                dev->tvnorm =
1858                    !strcmp(data_from_user->vid_stdname,
1859                            "PAL") ? V4L2_STD_PAL_BG : V4L2_STD_NTSC_M;
1860                medusa_set_videostandard(dev);
1861                break;
1862
1863        case SET_PIXEL_FORMAT:
1864                selected_channel = data_from_user->decoder_select;
1865                pix_format = data_from_user->pixel_format;
1866
1867                if (!(selected_channel <= 7 && selected_channel >= 0)) {
1868                        selected_channel -= 4;
1869                        selected_channel = selected_channel % 8;
1870                }
1871
1872                if (selected_channel >= 0)
1873                        cx25821_set_pixel_format(dev, selected_channel,
1874                                                 pix_format);
1875
1876                break;
1877
1878        case ENABLE_CIF_RESOLUTION:
1879                selected_channel = data_from_user->decoder_select;
1880                cif_enable = data_from_user->cif_resolution_enable;
1881                cif_width = data_from_user->cif_width;
1882
1883                if (cif_enable) {
1884                        if (dev->tvnorm & V4L2_STD_PAL_BG
1885                            || dev->tvnorm & V4L2_STD_PAL_DK)
1886                                width = 352;
1887                        else
1888                                width = (cif_width == 320
1889                                         || cif_width == 352) ? cif_width : 320;
1890                }
1891
1892                if (!(selected_channel <= 7 && selected_channel >= 0)) {
1893                        selected_channel -= 4;
1894                        selected_channel = selected_channel % 8;
1895                }
1896
1897                if (selected_channel <= 7 && selected_channel >= 0) {
1898                        dev->channels[selected_channel].
1899                                use_cif_resolution = cif_enable;
1900                        dev->channels[selected_channel].cif_width = width;
1901                } else {
1902                        for (i = 0; i < VID_CHANNEL_NUM; i++) {
1903                                dev->channels[i].use_cif_resolution =
1904                                        cif_enable;
1905                                dev->channels[i].cif_width = width;
1906                        }
1907                }
1908
1909                medusa_set_resolution(dev, width, selected_channel);
1910                break;
1911        case REG_READ:
1912                data_from_user->reg_data = cx_read(data_from_user->reg_address);
1913                break;
1914        case REG_WRITE:
1915                cx_write(data_from_user->reg_address, data_from_user->reg_data);
1916                break;
1917        case MEDUSA_READ:
1918                value =
1919                    cx25821_i2c_read(&dev->i2c_bus[0],
1920                                     (u16) data_from_user->reg_address,
1921                                     &data_from_user->reg_data);
1922                break;
1923        case MEDUSA_WRITE:
1924                cx25821_i2c_write(&dev->i2c_bus[0],
1925                                  (u16) data_from_user->reg_address,
1926                                  data_from_user->reg_data);
1927                break;
1928        }
1929
1930        return 0;
1931 }
1932
1933 static long cx25821_video_ioctl(struct file *file,
1934                                unsigned int cmd, unsigned long arg)
1935 {
1936        int  ret = 0;
1937
1938        struct cx25821_fh  *fh  = file->private_data;
1939
1940        /* check to see if it's the video upstream */
1941        if (fh->channel_id == SRAM_CH09) {
1942                ret = video_ioctl_upstream9(file, cmd, arg);
1943                return ret;
1944        } else if (fh->channel_id == SRAM_CH10) {
1945                ret = video_ioctl_upstream10(file, cmd, arg);
1946                return ret;
1947        } else if (fh->channel_id == SRAM_CH11) {
1948                ret = video_ioctl_upstream11(file, cmd, arg);
1949                ret = video_ioctl_set(file, cmd, arg);
1950                return ret;
1951        }
1952
1953     return video_ioctl2(file, cmd, arg);
1954 }
1955
1956 /* exported stuff */
1957 static const struct v4l2_file_operations video_fops = {
1958        .owner = THIS_MODULE,
1959        .open = video_open,
1960        .release = video_release,
1961        .read = video_read,
1962        .poll = video_poll,
1963        .mmap = cx25821_video_mmap,
1964        .ioctl = cx25821_video_ioctl,
1965 };
1966
1967 static const struct v4l2_ioctl_ops video_ioctl_ops = {
1968        .vidioc_querycap = cx25821_vidioc_querycap,
1969        .vidioc_enum_fmt_vid_cap = cx25821_vidioc_enum_fmt_vid_cap,
1970        .vidioc_g_fmt_vid_cap = cx25821_vidioc_g_fmt_vid_cap,
1971        .vidioc_try_fmt_vid_cap = cx25821_vidioc_try_fmt_vid_cap,
1972        .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
1973        .vidioc_reqbufs = cx25821_vidioc_reqbufs,
1974        .vidioc_querybuf = cx25821_vidioc_querybuf,
1975        .vidioc_qbuf = cx25821_vidioc_qbuf,
1976        .vidioc_dqbuf = vidioc_dqbuf,
1977 #ifdef TUNER_FLAG
1978        .vidioc_s_std = cx25821_vidioc_s_std,
1979        .vidioc_querystd = cx25821_vidioc_querystd,
1980 #endif
1981        .vidioc_cropcap = cx25821_vidioc_cropcap,
1982        .vidioc_s_crop = cx25821_vidioc_s_crop,
1983        .vidioc_g_crop = cx25821_vidioc_g_crop,
1984        .vidioc_enum_input = cx25821_vidioc_enum_input,
1985        .vidioc_g_input = cx25821_vidioc_g_input,
1986        .vidioc_s_input = cx25821_vidioc_s_input,
1987        .vidioc_g_ctrl = cx25821_vidioc_g_ctrl,
1988        .vidioc_s_ctrl = vidioc_s_ctrl,
1989        .vidioc_queryctrl = cx25821_vidioc_queryctrl,
1990        .vidioc_streamon = vidioc_streamon,
1991        .vidioc_streamoff = vidioc_streamoff,
1992        .vidioc_log_status = vidioc_log_status,
1993        .vidioc_g_priority = cx25821_vidioc_g_priority,
1994        .vidioc_s_priority = cx25821_vidioc_s_priority,
1995 #ifdef TUNER_FLAG
1996        .vidioc_g_tuner = cx25821_vidioc_g_tuner,
1997        .vidioc_s_tuner = cx25821_vidioc_s_tuner,
1998        .vidioc_g_frequency = cx25821_vidioc_g_frequency,
1999        .vidioc_s_frequency = cx25821_vidioc_s_frequency,
2000 #endif
2001 #ifdef CONFIG_VIDEO_ADV_DEBUG
2002        .vidioc_g_register = cx25821_vidioc_g_register,
2003        .vidioc_s_register = cx25821_vidioc_s_register,
2004 #endif
2005 };
2006
2007 struct video_device cx25821_videoioctl_template = {
2008                .name = "cx25821-videoioctl",
2009                .fops = &video_fops,
2010                .ioctl_ops = &video_ioctl_ops,
2011                .tvnorms = CX25821_NORMS,
2012                .current_norm = V4L2_STD_NTSC_M,
2013 };