drivers/media/video/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         for (i = 0; i < ARRAY_SIZE(formats); i++)
 105                 if (formats[i].fourcc == fourcc)
 106                         return formats + i;
 107
 108         pr_err("%s(0x%08x) NOT FOUND\n", __func__, fourcc);
 109         return NULL;
 110 }
 111
 112 void cx25821_dump_video_queue(struct cx25821_dev *dev,
 113                               struct cx25821_dmaqueue *q)
 114 {
 115         struct cx25821_buffer *buf;
 116         struct list_head *item;
 117         dprintk(1, "%s()\n", __func__);
 118
 119         if (!list_empty(&q->active)) {
 120                 list_for_each(item, &q->active)
 121                     buf = list_entry(item, struct cx25821_buffer, vb.queue);
 122         }
 123
 124         if (!list_empty(&q->queued)) {
 125                 list_for_each(item, &q->queued)
 126                     buf = list_entry(item, struct cx25821_buffer, vb.queue);
 127         }
 128
 129 }
 130
 131 void cx25821_video_wakeup(struct cx25821_dev *dev, struct cx25821_dmaqueue *q,
 132                           u32 count)
 133 {
 134         struct cx25821_buffer *buf;
 135         int bc;
 136
 137         for (bc = 0;; bc++) {
 138                 if (list_empty(&q->active)) {
 139                         dprintk(1, "bc=%d (=0: active empty)\n", bc);
 140                         break;
 141                 }
 142
 143                 buf =
 144                     list_entry(q->active.next, struct cx25821_buffer, vb.queue);
 145
 146                 /* count comes from the hw and it is 16bit wide --
 147                  * this trick handles wrap-arounds correctly for
 148                  * up to 32767 buffers in flight... */
 149                 if ((s16) (count - buf->count) < 0)
 150                         break;
 151
 152                 do_gettimeofday(&buf->vb.ts);
 153                 buf->vb.state = VIDEOBUF_DONE;
 154                 list_del(&buf->vb.queue);
 155                 wake_up(&buf->vb.done);
 156         }
 157
 158         if (list_empty(&q->active))
 159                 del_timer(&q->timeout);
 160         else
 161                 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
 162         if (bc != 1)
 163                 pr_err("%s: %d buffers handled (should be 1)\n", __func__, bc);
 164 }
 165
 166 #ifdef TUNER_FLAG
 167 int cx25821_set_tvnorm(struct cx25821_dev *dev, v4l2_std_id norm)
 168 {
 169         dprintk(1, "%s(norm = 0x%08x) name: [%s]\n",
 170                 __func__, (unsigned int)norm, v4l2_norm_to_name(norm));
 171
 172         dev->tvnorm = norm;
 173
 174         /* Tell the internal A/V decoder */
 175         cx25821_call_all(dev, core, s_std, norm);
 176
 177         return 0;
 178 }
 179 #endif
 180
 181 struct video_device *cx25821_vdev_init(struct cx25821_dev *dev,
 182                                        struct pci_dev *pci,
 183                                        struct video_device *template,
 184                                        char *type)
 185 {
 186         struct video_device *vfd;
 187         dprintk(1, "%s()\n", __func__);
 188
 189         vfd = video_device_alloc();
 190         if (NULL == vfd)
 191                 return NULL;
 192         *vfd = *template;
 193         vfd->v4l2_dev = &dev->v4l2_dev;
 194         vfd->release = video_device_release;
 195         snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)", dev->name, type,
 196                  cx25821_boards[dev->board].name);
 197         video_set_drvdata(vfd, dev);
 198         return vfd;
 199 }
 200
 201 /*
 202 static int cx25821_ctrl_query(struct v4l2_queryctrl *qctrl)
 203 {
 204         int i;
 205
 206         if (qctrl->id < V4L2_CID_BASE || qctrl->id >= V4L2_CID_LASTP1)
 207                 return -EINVAL;
 208         for (i = 0; i < CX25821_CTLS; i++)
 209                 if (cx25821_ctls[i].v.id == qctrl->id)
 210                         break;
 211         if (i == CX25821_CTLS) {
 212                 *qctrl = no_ctl;
 213                 return 0;
 214         }
 215         *qctrl = cx25821_ctls[i].v;
 216         return 0;
 217 }
 218 */
 219
 220 /* resource management */
 221 int cx25821_res_get(struct cx25821_dev *dev, struct cx25821_fh *fh,
 222                     unsigned int bit)
 223 {
 224         dprintk(1, "%s()\n", __func__);
 225         if (fh->resources & bit)
 226                 /* have it already allocated */
 227                 return 1;
 228
 229         /* is it free? */
 230         mutex_lock(&dev->lock);
 231         if (dev->channels[fh->channel_id].resources & bit) {
 232                 /* no, someone else uses it */
 233                 mutex_unlock(&dev->lock);
 234                 return 0;
 235         }
 236         /* it's free, grab it */
 237         fh->resources |= bit;
 238         dev->channels[fh->channel_id].resources |= bit;
 239         dprintk(1, "res: get %d\n", bit);
 240         mutex_unlock(&dev->lock);
 241         return 1;
 242 }
 243
 244 int cx25821_res_check(struct cx25821_fh *fh, unsigned int bit)
 245 {
 246         return fh->resources & bit;
 247 }
 248
 249 int cx25821_res_locked(struct cx25821_fh *fh, unsigned int bit)
 250 {
 251         return fh->dev->channels[fh->channel_id].resources & bit;
 252 }
 253
 254 void cx25821_res_free(struct cx25821_dev *dev, struct cx25821_fh *fh,
 255                       unsigned int bits)
 256 {
 257         BUG_ON((fh->resources & bits) != bits);
 258         dprintk(1, "%s()\n", __func__);
 259
 260         mutex_lock(&dev->lock);
 261         fh->resources &= ~bits;
 262         dev->channels[fh->channel_id].resources &= ~bits;
 263         dprintk(1, "res: put %d\n", bits);
 264         mutex_unlock(&dev->lock);
 265 }
 266
 267 int cx25821_video_mux(struct cx25821_dev *dev, unsigned int input)
 268 {
 269         struct v4l2_routing route;
 270         memset(&route, 0, sizeof(route));
 271
 272         dprintk(1, "%s(): video_mux: %d [vmux=%d, gpio=0x%x,0x%x,0x%x,0x%x]\n",
 273                 __func__, input, INPUT(input)->vmux, INPUT(input)->gpio0,
 274                 INPUT(input)->gpio1, INPUT(input)->gpio2, INPUT(input)->gpio3);
 275         dev->input = input;
 276
 277         route.input = INPUT(input)->vmux;
 278
 279         /* Tell the internal A/V decoder */
 280         cx25821_call_all(dev, video, s_routing, INPUT(input)->vmux, 0, 0);
 281
 282         return 0;
 283 }
 284
 285 int cx25821_start_video_dma(struct cx25821_dev *dev,
 286                             struct cx25821_dmaqueue *q,
 287                             struct cx25821_buffer *buf,
 288                             struct sram_channel *channel)
 289 {
 290         int tmp = 0;
 291
 292         /* setup fifo + format */
 293         cx25821_sram_channel_setup(dev, channel, buf->bpl, buf->risc.dma);
 294
 295         /* reset counter */
 296         cx_write(channel->gpcnt_ctl, 3);
 297         q->count = 1;
 298
 299         /* enable irq */
 300         cx_set(PCI_INT_MSK, cx_read(PCI_INT_MSK) | (1 << channel->i));
 301         cx_set(channel->int_msk, 0x11);
 302
 303         /* start dma */
 304         cx_write(channel->dma_ctl, 0x11);       /* FIFO and RISC enable */
 305
 306         /* make sure upstream setting if any is reversed */
 307         tmp = cx_read(VID_CH_MODE_SEL);
 308         cx_write(VID_CH_MODE_SEL, tmp & 0xFFFFFE00);
 309
 310         return 0;
 311 }
 312
 313 int cx25821_restart_video_queue(struct cx25821_dev *dev,
 314                                 struct cx25821_dmaqueue *q,
 315                                 struct sram_channel *channel)
 316 {
 317         struct cx25821_buffer *buf, *prev;
 318         struct list_head *item;
 319
 320         if (!list_empty(&q->active)) {
 321                 buf =
 322                     list_entry(q->active.next, struct cx25821_buffer, vb.queue);
 323
 324                 cx25821_start_video_dma(dev, q, buf, channel);
 325
 326                 list_for_each(item, &q->active) {
 327                         buf = list_entry(item, struct cx25821_buffer, vb.queue);
 328                         buf->count = q->count++;
 329                 }
 330
 331                 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
 332                 return 0;
 333         }
 334
 335         prev = NULL;
 336         for (;;) {
 337                 if (list_empty(&q->queued))
 338                         return 0;
 339
 340                 buf =
 341                     list_entry(q->queued.next, struct cx25821_buffer, vb.queue);
 342
 343                 if (NULL == prev) {
 344                         list_move_tail(&buf->vb.queue, &q->active);
 345                         cx25821_start_video_dma(dev, q, buf, channel);
 346                         buf->vb.state = VIDEOBUF_ACTIVE;
 347                         buf->count = q->count++;
 348                         mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
 349                 } else if (prev->vb.width == buf->vb.width &&
 350                            prev->vb.height == buf->vb.height &&
 351                            prev->fmt == buf->fmt) {
 352                         list_move_tail(&buf->vb.queue, &q->active);
 353                         buf->vb.state = VIDEOBUF_ACTIVE;
 354                         buf->count = q->count++;
 355                         prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
 356                         prev->risc.jmp[2] = cpu_to_le32(0); /* Bits 63 - 32 */
 357                 } else {
 358                         return 0;
 359                 }
 360                 prev = buf;
 361         }
 362 }
 363
 364 void cx25821_vid_timeout(unsigned long data)
 365 {
 366         struct cx25821_data *timeout_data = (struct cx25821_data *)data;
 367         struct cx25821_dev *dev = timeout_data->dev;
 368         struct sram_channel *channel = timeout_data->channel;
 369         struct cx25821_dmaqueue *q = &dev->channels[channel->i].vidq;
 370         struct cx25821_buffer *buf;
 371         unsigned long flags;
 372
 373         /* cx25821_sram_channel_dump(dev, channel); */
 374         cx_clear(channel->dma_ctl, 0x11);
 375
 376         spin_lock_irqsave(&dev->slock, flags);
 377         while (!list_empty(&q->active)) {
 378                 buf =
 379                     list_entry(q->active.next, struct cx25821_buffer, vb.queue);
 380                 list_del(&buf->vb.queue);
 381
 382                 buf->vb.state = VIDEOBUF_ERROR;
 383                 wake_up(&buf->vb.done);
 384         }
 385
 386         cx25821_restart_video_queue(dev, q, channel);
 387         spin_unlock_irqrestore(&dev->slock, flags);
 388 }
 389
 390 int cx25821_video_irq(struct cx25821_dev *dev, int chan_num, u32 status)
 391 {
 392         u32 count = 0;
 393         int handled = 0;
 394         u32 mask;
 395         struct sram_channel *channel = dev->channels[chan_num].sram_channels;
 396
 397         mask = cx_read(channel->int_msk);
 398         if (0 == (status & mask))
 399                 return handled;
 400
 401         cx_write(channel->int_stat, status);
 402
 403         /* risc op code error */
 404         if (status & (1 << 16)) {
 405                 pr_warn("%s, %s: video risc op code error\n",
 406                         dev->name, channel->name);
 407                 cx_clear(channel->dma_ctl, 0x11);
 408                 cx25821_sram_channel_dump(dev, channel);
 409         }
 410
 411         /* risc1 y */
 412         if (status & FLD_VID_DST_RISC1) {
 413                 spin_lock(&dev->slock);
 414                 count = cx_read(channel->gpcnt);
 415                 cx25821_video_wakeup(dev, &dev->channels[channel->i].vidq,
 416                                 count);
 417                 spin_unlock(&dev->slock);
 418                 handled++;
 419         }
 420
 421         /* risc2 y */
 422         if (status & 0x10) {
 423                 dprintk(2, "stopper video\n");
 424                 spin_lock(&dev->slock);
 425                 cx25821_restart_video_queue(dev,
 426                                 &dev->channels[channel->i].vidq, channel);
 427                 spin_unlock(&dev->slock);
 428                 handled++;
 429         }
 430         return handled;
 431 }
 432
 433 void cx25821_videoioctl_unregister(struct cx25821_dev *dev)
 434 {
 435         if (dev->ioctl_dev) {
 436                 if (video_is_registered(dev->ioctl_dev))
 437                         video_unregister_device(dev->ioctl_dev);
 438                 else
 439                         video_device_release(dev->ioctl_dev);
 440
 441                 dev->ioctl_dev = NULL;
 442         }
 443 }
 444
 445 void cx25821_video_unregister(struct cx25821_dev *dev, int chan_num)
 446 {
 447         cx_clear(PCI_INT_MSK, 1);
 448
 449         if (dev->channels[chan_num].video_dev) {
 450                 if (video_is_registered(dev->channels[chan_num].video_dev))
 451                         video_unregister_device(
 452                                         dev->channels[chan_num].video_dev);
 453                 else
 454                         video_device_release(
 455                                         dev->channels[chan_num].video_dev);
 456
 457                 dev->channels[chan_num].video_dev = NULL;
 458
 459                 btcx_riscmem_free(dev->pci,
 460                                 &dev->channels[chan_num].vidq.stopper);
 461
 462                 pr_warn("device %d released!\n", chan_num);
 463         }
 464
 465 }
 466
 467 int cx25821_video_register(struct cx25821_dev *dev)
 468 {
 469         int err;
 470         int i;
 471
 472         struct video_device cx25821_video_device = {
 473                 .name = "cx25821-video",
 474                 .fops = &video_fops,
 475                 .minor = -1,
 476                 .ioctl_ops = &video_ioctl_ops,
 477                 .tvnorms = CX25821_NORMS,
 478                 .current_norm = V4L2_STD_NTSC_M,
 479         };
 480
 481         spin_lock_init(&dev->slock);
 482
 483         for (i = 0; i < MAX_VID_CHANNEL_NUM - 1; ++i) {
 484                 cx25821_init_controls(dev, i);
 485
 486                 cx25821_risc_stopper(dev->pci, &dev->channels[i].vidq.stopper,
 487                                 dev->channels[i].sram_channels->dma_ctl,
 488                                 0x11, 0);
 489
 490                 dev->channels[i].sram_channels = &cx25821_sram_channels[i];
 491                 dev->channels[i].video_dev = NULL;
 492                 dev->channels[i].resources = 0;
 493
 494                 cx_write(dev->channels[i].sram_channels->int_stat, 0xffffffff);
 495
 496                 INIT_LIST_HEAD(&dev->channels[i].vidq.active);
 497                 INIT_LIST_HEAD(&dev->channels[i].vidq.queued);
 498
 499                 dev->channels[i].timeout_data.dev = dev;
 500                 dev->channels[i].timeout_data.channel =
 501                         &cx25821_sram_channels[i];
 502                 dev->channels[i].vidq.timeout.function =
 503                         cx25821_vid_timeout;
 504                 dev->channels[i].vidq.timeout.data =
 505                         (unsigned long)&dev->channels[i].timeout_data;
 506                 init_timer(&dev->channels[i].vidq.timeout);
 507
 508                 /* register v4l devices */
 509                 dev->channels[i].video_dev = cx25821_vdev_init(dev,
 510                                 dev->pci, &cx25821_video_device, "video");
 511
 512                 err = video_register_device(dev->channels[i].video_dev,
 513                                 VFL_TYPE_GRABBER, video_nr[dev->nr]);
 514
 515                 if (err < 0)
 516                         goto fail_unreg;
 517
 518         }
 519
 520         /* set PCI interrupt */
 521         cx_set(PCI_INT_MSK, 0xff);
 522
 523         /* initial device configuration */
 524         mutex_lock(&dev->lock);
 525 #ifdef TUNER_FLAG
 526         dev->tvnorm = cx25821_video_device.current_norm;
 527         cx25821_set_tvnorm(dev, dev->tvnorm);
 528 #endif
 529         mutex_unlock(&dev->lock);
 530
 531
 532         return 0;
 533
 534 fail_unreg:
 535         cx25821_video_unregister(dev, i);
 536         return err;
 537 }
 538
 539 int cx25821_buffer_setup(struct videobuf_queue *q, unsigned int *count,
 540                  unsigned int *size)
 541 {
 542         struct cx25821_fh *fh = q->priv_data;
 543
 544         *size = fh->fmt->depth * fh->width * fh->height >> 3;
 545
 546         if (0 == *count)
 547                 *count = 32;
 548
 549         if (*size * *count > vid_limit * 1024 * 1024)
 550                 *count = (vid_limit * 1024 * 1024) / *size;
 551
 552         return 0;
 553 }
 554
 555 int cx25821_buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
 556                    enum v4l2_field field)
 557 {
 558         struct cx25821_fh *fh = q->priv_data;
 559         struct cx25821_dev *dev = fh->dev;
 560         struct cx25821_buffer *buf =
 561             container_of(vb, struct cx25821_buffer, vb);
 562         int rc, init_buffer = 0;
 563         u32 line0_offset, line1_offset;
 564         struct videobuf_dmabuf *dma = videobuf_to_dma(&buf->vb);
 565         int bpl_local = LINE_SIZE_D1;
 566         int channel_opened = fh->channel_id;
 567
 568         BUG_ON(NULL == fh->fmt);
 569         if (fh->width < 48 || fh->width > 720 ||
 570             fh->height < 32 || fh->height > 576)
 571                 return -EINVAL;
 572
 573         buf->vb.size = (fh->width * fh->height * fh->fmt->depth) >> 3;
 574
 575         if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size)
 576                 return -EINVAL;
 577
 578         if (buf->fmt != fh->fmt ||
 579             buf->vb.width != fh->width ||
 580             buf->vb.height != fh->height || buf->vb.field != field) {
 581                 buf->fmt = fh->fmt;
 582                 buf->vb.width = fh->width;
 583                 buf->vb.height = fh->height;
 584                 buf->vb.field = field;
 585                 init_buffer = 1;
 586         }
 587
 588         if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {
 589                 init_buffer = 1;
 590                 rc = videobuf_iolock(q, &buf->vb, NULL);
 591                 if (0 != rc) {
 592                         printk(KERN_DEBUG pr_fmt("videobuf_iolock failed!\n"));
 593                         goto fail;
 594                 }
 595         }
 596
 597         dprintk(1, "init_buffer=%d\n", init_buffer);
 598
 599         if (init_buffer) {
 600
 601                 channel_opened = dev->channel_opened;
 602                 if (channel_opened < 0 || channel_opened > 7)
 603                         channel_opened = 7;
 604
 605                 if (dev->channels[channel_opened].pixel_formats ==
 606                                 PIXEL_FRMT_411)
 607                         buf->bpl = (buf->fmt->depth * buf->vb.width) >> 3;
 608                 else
 609                         buf->bpl = (buf->fmt->depth >> 3) * (buf->vb.width);
 610
 611                 if (dev->channels[channel_opened].pixel_formats ==
 612                                 PIXEL_FRMT_411) {
 613                         bpl_local = buf->bpl;
 614                 } else {
 615                         bpl_local = buf->bpl;   /* Default */
 616
 617                         if (channel_opened >= 0 && channel_opened <= 7) {
 618                                 if (dev->channels[channel_opened]
 619                                                 .use_cif_resolution) {
 620                                         if (dev->tvnorm & V4L2_STD_PAL_BG
 621                                             || dev->tvnorm & V4L2_STD_PAL_DK)
 622                                                 bpl_local = 352 << 1;
 623                                         else
 624                                                 bpl_local =
 625                                                  dev->channels[channel_opened].
 626                                                  cif_width <<
 627                                                  1;
 628                                 }
 629                         }
 630                 }
 631
 632                 switch (buf->vb.field) {
 633                 case V4L2_FIELD_TOP:
 634                         cx25821_risc_buffer(dev->pci, &buf->risc,
 635                                             dma->sglist, 0, UNSET,
 636                                             buf->bpl, 0, buf->vb.height);
 637                         break;
 638                 case V4L2_FIELD_BOTTOM:
 639                         cx25821_risc_buffer(dev->pci, &buf->risc,
 640                                             dma->sglist, UNSET, 0,
 641                                             buf->bpl, 0, buf->vb.height);
 642                         break;
 643                 case V4L2_FIELD_INTERLACED:
 644                         /* All other formats are top field first */
 645                         line0_offset = 0;
 646                         line1_offset = buf->bpl;
 647                         dprintk(1, "top field first\n");
 648
 649                         cx25821_risc_buffer(dev->pci, &buf->risc,
 650                                             dma->sglist, line0_offset,
 651                                             bpl_local, bpl_local, bpl_local,
 652                                             buf->vb.height >> 1);
 653                         break;
 654                 case V4L2_FIELD_SEQ_TB:
 655                         cx25821_risc_buffer(dev->pci, &buf->risc,
 656                                             dma->sglist,
 657                                             0, buf->bpl * (buf->vb.height >> 1),
 658                                             buf->bpl, 0, buf->vb.height >> 1);
 659                         break;
 660                 case V4L2_FIELD_SEQ_BT:
 661                         cx25821_risc_buffer(dev->pci, &buf->risc,
 662                                             dma->sglist,
 663                                             buf->bpl * (buf->vb.height >> 1), 0,
 664                                             buf->bpl, 0, buf->vb.height >> 1);
 665                         break;
 666                 default:
 667                         BUG();
 668                 }
 669         }
 670
 671         dprintk(2, "[%p/%d] buffer_prep - %dx%d %dbpp \"%s\" - dma=0x%08lx\n",
 672                 buf, buf->vb.i, fh->width, fh->height, fh->fmt->depth,
 673                 fh->fmt->name, (unsigned long)buf->risc.dma);
 674
 675         buf->vb.state = VIDEOBUF_PREPARED;
 676
 677         return 0;
 678
 679 fail:
 680         cx25821_free_buffer(q, buf);
 681         return rc;
 682 }
 683
 684 void cx25821_buffer_release(struct videobuf_queue *q,
 685                             struct videobuf_buffer *vb)
 686 {
 687         struct cx25821_buffer *buf =
 688             container_of(vb, struct cx25821_buffer, vb);
 689
 690         cx25821_free_buffer(q, buf);
 691 }
 692
 693 struct videobuf_queue *get_queue(struct cx25821_fh *fh)
 694 {
 695         switch (fh->type) {
 696         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 697                 return &fh->vidq;
 698         default:
 699                 BUG();
 700                 return NULL;
 701         }
 702 }
 703
 704 int cx25821_get_resource(struct cx25821_fh *fh, int resource)
 705 {
 706         switch (fh->type) {
 707         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 708                 return resource;
 709         default:
 710                 BUG();
 711                 return 0;
 712         }
 713 }
 714
 715 int cx25821_video_mmap(struct file *file, struct vm_area_struct *vma)
 716 {
 717         struct cx25821_fh *fh = file->private_data;
 718
 719         return videobuf_mmap_mapper(get_queue(fh), vma);
 720 }
 721
 722
 723 static void buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb)
 724 {
 725         struct cx25821_buffer *buf =
 726            container_of(vb, struct cx25821_buffer, vb);
 727         struct cx25821_buffer *prev;
 728         struct cx25821_fh *fh = vq->priv_data;
 729         struct cx25821_dev *dev = fh->dev;
 730         struct cx25821_dmaqueue *q = &dev->channels[fh->channel_id].vidq;
 731
 732         /* add jump to stopper */
 733         buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP | RISC_IRQ1 | RISC_CNT_INC);
 734         buf->risc.jmp[1] = cpu_to_le32(q->stopper.dma);
 735         buf->risc.jmp[2] = cpu_to_le32(0);      /* bits 63-32 */
 736
 737         dprintk(2, "jmp to stopper (0x%x)\n", buf->risc.jmp[1]);
 738
 739         if (!list_empty(&q->queued)) {
 740                 list_add_tail(&buf->vb.queue, &q->queued);
 741                 buf->vb.state = VIDEOBUF_QUEUED;
 742                 dprintk(2, "[%p/%d] buffer_queue - append to queued\n", buf,
 743                                 buf->vb.i);
 744
 745         } else if (list_empty(&q->active)) {
 746                 list_add_tail(&buf->vb.queue, &q->active);
 747                 cx25821_start_video_dma(dev, q, buf,
 748                                 dev->channels[fh->channel_id].sram_channels);
 749                 buf->vb.state = VIDEOBUF_ACTIVE;
 750                 buf->count = q->count++;
 751                 mod_timer(&q->timeout, jiffies + BUFFER_TIMEOUT);
 752                 dprintk(2, "[%p/%d] buffer_queue - first active, buf cnt = %d, q->count = %d\n",
 753                                 buf, buf->vb.i, buf->count, q->count);
 754         } else {
 755                 prev = list_entry(q->active.prev, struct cx25821_buffer,
 756                                 vb.queue);
 757                 if (prev->vb.width == buf->vb.width
 758                    && prev->vb.height == buf->vb.height
 759                    && prev->fmt == buf->fmt) {
 760                         list_add_tail(&buf->vb.queue, &q->active);
 761                         buf->vb.state = VIDEOBUF_ACTIVE;
 762                         buf->count = q->count++;
 763                         prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
 764
 765                         /* 64 bit bits 63-32 */
 766                         prev->risc.jmp[2] = cpu_to_le32(0);
 767                         dprintk(2, "[%p/%d] buffer_queue - append to active, buf->count=%d\n",
 768                                         buf, buf->vb.i, buf->count);
 769
 770                 } else {
 771                         list_add_tail(&buf->vb.queue, &q->queued);
 772                         buf->vb.state = VIDEOBUF_QUEUED;
 773                         dprintk(2, "[%p/%d] buffer_queue - first queued\n", buf,
 774                                         buf->vb.i);
 775                 }
 776         }
 777
 778         if (list_empty(&q->active))
 779                 dprintk(2, "active queue empty!\n");
 780 }
 781
 782 static struct videobuf_queue_ops cx25821_video_qops = {
 783         .buf_setup = cx25821_buffer_setup,
 784         .buf_prepare = cx25821_buffer_prepare,
 785         .buf_queue = buffer_queue,
 786         .buf_release = cx25821_buffer_release,
 787 };
 788
 789 static int video_open(struct file *file)
 790 {
 791         struct video_device *vdev = video_devdata(file);
 792         struct cx25821_dev *h, *dev = video_drvdata(file);
 793         struct cx25821_fh *fh;
 794         struct list_head *list;
 795         int minor = video_devdata(file)->minor;
 796         enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 797         u32 pix_format;
 798         int ch_id = 0;
 799         int i;
 800
 801         dprintk(1, "open dev=%s type=%s\n", video_device_node_name(vdev),
 802                         v4l2_type_names[type]);
 803
 804         /* allocate + initialize per filehandle data */
 805         fh = kzalloc(sizeof(*fh), GFP_KERNEL);
 806         if (NULL == fh)
 807                 return -ENOMEM;
 808
 809         mutex_lock(&cx25821_devlist_mutex);
 810
 811         list_for_each(list, &cx25821_devlist)
 812         {
 813                 h = list_entry(list, struct cx25821_dev, devlist);
 814
 815                 for (i = 0; i < MAX_VID_CHANNEL_NUM; i++) {
 816                         if (h->channels[i].video_dev &&
 817                            h->channels[i].video_dev->minor == minor) {
 818                                 dev = h;
 819                                 ch_id = i;
 820                                 type  = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 821                         }
 822                 }
 823         }
 824
 825         if (NULL == dev) {
 826                 mutex_unlock(&cx25821_devlist_mutex);
 827                 kfree(fh);
 828                 return -ENODEV;
 829         }
 830
 831         file->private_data = fh;
 832         fh->dev = dev;
 833         fh->type = type;
 834         fh->width = 720;
 835         fh->channel_id = ch_id;
 836
 837         if (dev->tvnorm & V4L2_STD_PAL_BG || dev->tvnorm & V4L2_STD_PAL_DK)
 838                 fh->height = 576;
 839         else
 840                 fh->height = 480;
 841
 842         dev->channel_opened = fh->channel_id;
 843         if (dev->channels[ch_id].pixel_formats == PIXEL_FRMT_411)
 844                 pix_format = V4L2_PIX_FMT_Y41P;
 845         else
 846                 pix_format = V4L2_PIX_FMT_YUYV;
 847         fh->fmt = cx25821_format_by_fourcc(pix_format);
 848
 849         v4l2_prio_open(&dev->channels[ch_id].prio, &fh->prio);
 850
 851         videobuf_queue_sg_init(&fh->vidq, &cx25821_video_qops,
 852                               &dev->pci->dev, &dev->slock,
 853                               V4L2_BUF_TYPE_VIDEO_CAPTURE,
 854                               V4L2_FIELD_INTERLACED,
 855                               sizeof(struct cx25821_buffer), fh, NULL);
 856
 857         dprintk(1, "post videobuf_queue_init()\n");
 858         mutex_unlock(&cx25821_devlist_mutex);
 859
 860         return 0;
 861 }
 862
 863 static ssize_t video_read(struct file *file, char __user * data, size_t count,
 864                          loff_t *ppos)
 865 {
 866         struct cx25821_fh *fh = file->private_data;
 867
 868         switch (fh->type) {
 869         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 870                 if (cx25821_res_locked(fh, RESOURCE_VIDEO0))
 871                         return -EBUSY;
 872
 873                 return videobuf_read_one(&fh->vidq, data, count, ppos,
 874                                         file->f_flags & O_NONBLOCK);
 875
 876         default:
 877                 BUG();
 878                 return 0;
 879         }
 880 }
 881
 882 static unsigned int video_poll(struct file *file,
 883                               struct poll_table_struct *wait)
 884 {
 885         struct cx25821_fh *fh = file->private_data;
 886         struct cx25821_buffer *buf;
 887
 888         if (cx25821_res_check(fh, RESOURCE_VIDEO0)) {
 889                 /* streaming capture */
 890                 if (list_empty(&fh->vidq.stream))
 891                         return POLLERR;
 892                 buf = list_entry(fh->vidq.stream.next,
 893                                 struct cx25821_buffer, vb.stream);
 894         } else {
 895                 /* read() capture */
 896                 buf = (struct cx25821_buffer *)fh->vidq.read_buf;
 897                 if (NULL == buf)
 898                         return POLLERR;
 899         }
 900
 901         poll_wait(file, &buf->vb.done, wait);
 902         if (buf->vb.state == VIDEOBUF_DONE || buf->vb.state == VIDEOBUF_ERROR) {
 903                 if (buf->vb.state == VIDEOBUF_DONE) {
 904                         struct cx25821_dev *dev = fh->dev;
 905
 906                         if (dev && dev->channels[fh->channel_id]
 907                                         .use_cif_resolution) {
 908                                 u8 cam_id = *((char *)buf->vb.baddr + 3);
 909                                 memcpy((char *)buf->vb.baddr,
 910                                       (char *)buf->vb.baddr + (fh->width * 2),
 911                                       (fh->width * 2));
 912                                 *((char *)buf->vb.baddr + 3) = cam_id;
 913                         }
 914                 }
 915
 916                 return POLLIN | POLLRDNORM;
 917         }
 918
 919         return 0;
 920 }
 921
 922 static int video_release(struct file *file)
 923 {
 924         struct cx25821_fh *fh = file->private_data;
 925         struct cx25821_dev *dev = fh->dev;
 926
 927         /* stop the risc engine and fifo */
 928         cx_write(channel0->dma_ctl, 0); /* FIFO and RISC disable */
 929
 930         /* stop video capture */
 931         if (cx25821_res_check(fh, RESOURCE_VIDEO0)) {
 932                 videobuf_queue_cancel(&fh->vidq);
 933                 cx25821_res_free(dev, fh, RESOURCE_VIDEO0);
 934         }
 935
 936         if (fh->vidq.read_buf) {
 937                 cx25821_buffer_release(&fh->vidq, fh->vidq.read_buf);
 938                 kfree(fh->vidq.read_buf);
 939         }
 940
 941         videobuf_mmap_free(&fh->vidq);
 942
 943         v4l2_prio_close(&dev->channels[fh->channel_id].prio, fh->prio);
 944         file->private_data = NULL;
 945         kfree(fh);
 946
 947         return 0;
 948 }
 949
 950 static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
 951 {
 952         struct cx25821_fh *fh = priv;
 953         struct cx25821_dev *dev = fh->dev;
 954
 955         if (unlikely(fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE))
 956                 return -EINVAL;
 957
 958         if (unlikely(i != fh->type))
 959                 return -EINVAL;
 960
 961         if (unlikely(!cx25821_res_get(dev, fh, cx25821_get_resource(fh,
 962                                                 RESOURCE_VIDEO0))))
 963                 return -EBUSY;
 964
 965         return videobuf_streamon(get_queue(fh));
 966 }
 967
 968 static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
 969 {
 970         struct cx25821_fh *fh = priv;
 971         struct cx25821_dev *dev = fh->dev;
 972         int err, res;
 973
 974         if (fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
 975                 return -EINVAL;
 976         if (i != fh->type)
 977                 return -EINVAL;
 978
 979         res = cx25821_get_resource(fh, RESOURCE_VIDEO0);
 980         err = videobuf_streamoff(get_queue(fh));
 981         if (err < 0)
 982                 return err;
 983         cx25821_res_free(dev, fh, res);
 984         return 0;
 985 }
 986
 987 static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
 988                                 struct v4l2_format *f)
 989 {
 990         struct cx25821_fh *fh = priv;
 991         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
 992         struct v4l2_mbus_framefmt mbus_fmt;
 993         int err;
 994         int pix_format = PIXEL_FRMT_422;
 995
 996         if (fh) {
 997                 err = v4l2_prio_check(&dev->channels[fh->channel_id].prio,
 998                                       fh->prio);
 999                 if (0 != err)
1000                         return err;
1001         }
1002
1003         dprintk(2, "%s()\n", __func__);
1004         err = cx25821_vidioc_try_fmt_vid_cap(file, priv, f);
1005
1006         if (0 != err)
1007                 return err;
1008
1009         fh->fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
1010         fh->vidq.field = f->fmt.pix.field;
1011
1012         /* check if width and height is valid based on set standard */
1013         if (cx25821_is_valid_width(f->fmt.pix.width, dev->tvnorm))
1014                 fh->width = f->fmt.pix.width;
1015
1016         if (cx25821_is_valid_height(f->fmt.pix.height, dev->tvnorm))
1017                 fh->height = f->fmt.pix.height;
1018
1019         if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_Y41P)
1020                 pix_format = PIXEL_FRMT_411;
1021         else if (f->fmt.pix.pixelformat == V4L2_PIX_FMT_YUYV)
1022                 pix_format = PIXEL_FRMT_422;
1023         else
1024                 return -EINVAL;
1025
1026         cx25821_set_pixel_format(dev, SRAM_CH00, pix_format);
1027
1028         /* check if cif resolution */
1029         if (fh->width == 320 || fh->width == 352)
1030                 dev->channels[fh->channel_id].use_cif_resolution = 1;
1031         else
1032                 dev->channels[fh->channel_id].use_cif_resolution = 0;
1033
1034         dev->channels[fh->channel_id].cif_width = fh->width;
1035         medusa_set_resolution(dev, fh->width, SRAM_CH00);
1036
1037         dprintk(2, "%s(): width=%d height=%d field=%d\n", __func__, fh->width,
1038                 fh->height, fh->vidq.field);
1039         v4l2_fill_mbus_format(&mbus_fmt, &f->fmt.pix, V4L2_MBUS_FMT_FIXED);
1040         cx25821_call_all(dev, video, s_mbus_fmt, &mbus_fmt);
1041
1042         return 0;
1043 }
1044
1045 static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *p)
1046 {
1047         int ret_val = 0;
1048         struct cx25821_fh *fh = priv;
1049         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1050
1051         ret_val = videobuf_dqbuf(get_queue(fh), p, file->f_flags & O_NONBLOCK);
1052
1053         p->sequence = dev->channels[fh->channel_id].vidq.count;
1054
1055         return ret_val;
1056 }
1057
1058 static int vidioc_log_status(struct file *file, void *priv)
1059 {
1060         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1061         struct cx25821_fh *fh = priv;
1062         char name[32 + 2];
1063
1064         struct sram_channel *sram_ch = dev->channels[fh->channel_id]
1065                                                                 .sram_channels;
1066         u32 tmp = 0;
1067
1068         snprintf(name, sizeof(name), "%s/2", dev->name);
1069         pr_info("%s/2: ============  START LOG STATUS  ============\n",
1070                 dev->name);
1071         cx25821_call_all(dev, core, log_status);
1072         tmp = cx_read(sram_ch->dma_ctl);
1073         pr_info("Video input 0 is %s\n",
1074                 (tmp & 0x11) ? "streaming" : "stopped");
1075         pr_info("%s/2: =============  END LOG STATUS  =============\n",
1076                 dev->name);
1077         return 0;
1078 }
1079
1080 static int vidioc_s_ctrl(struct file *file, void *priv,
1081                         struct v4l2_control *ctl)
1082 {
1083         struct cx25821_fh *fh = priv;
1084         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1085         int err;
1086
1087         if (fh) {
1088                 err = v4l2_prio_check(&dev->channels[fh->channel_id].prio,
1089                                       fh->prio);
1090                 if (0 != err)
1091                         return err;
1092         }
1093
1094         return cx25821_set_control(dev, ctl, fh->channel_id);
1095 }
1096
1097 /* VIDEO IOCTLS */
1098 int cx25821_vidioc_g_fmt_vid_cap(struct file *file, void *priv,
1099                                  struct v4l2_format *f)
1100 {
1101         struct cx25821_fh *fh = priv;
1102
1103         f->fmt.pix.width = fh->width;
1104         f->fmt.pix.height = fh->height;
1105         f->fmt.pix.field = fh->vidq.field;
1106         f->fmt.pix.pixelformat = fh->fmt->fourcc;
1107         f->fmt.pix.bytesperline = (f->fmt.pix.width * fh->fmt->depth) >> 3;
1108         f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
1109
1110         return 0;
1111 }
1112
1113 int cx25821_vidioc_try_fmt_vid_cap(struct file *file, void *priv,
1114                                    struct v4l2_format *f)
1115 {
1116         struct cx25821_fmt *fmt;
1117         enum v4l2_field field;
1118         unsigned int maxw, maxh;
1119
1120         fmt = cx25821_format_by_fourcc(f->fmt.pix.pixelformat);
1121         if (NULL == fmt)
1122                 return -EINVAL;
1123
1124         field = f->fmt.pix.field;
1125         maxw = 720;
1126         maxh = 576;
1127
1128         if (V4L2_FIELD_ANY == field) {
1129                 if (f->fmt.pix.height > maxh / 2)
1130                         field = V4L2_FIELD_INTERLACED;
1131                 else
1132                         field = V4L2_FIELD_TOP;
1133         }
1134
1135         switch (field) {
1136         case V4L2_FIELD_TOP:
1137         case V4L2_FIELD_BOTTOM:
1138                 maxh = maxh / 2;
1139                 break;
1140         case V4L2_FIELD_INTERLACED:
1141                 break;
1142         default:
1143                 return -EINVAL;
1144         }
1145
1146         f->fmt.pix.field = field;
1147         if (f->fmt.pix.height < 32)
1148                 f->fmt.pix.height = 32;
1149         if (f->fmt.pix.height > maxh)
1150                 f->fmt.pix.height = maxh;
1151         if (f->fmt.pix.width < 48)
1152                 f->fmt.pix.width = 48;
1153         if (f->fmt.pix.width > maxw)
1154                 f->fmt.pix.width = maxw;
1155         f->fmt.pix.width &= ~0x03;
1156         f->fmt.pix.bytesperline = (f->fmt.pix.width * fmt->depth) >> 3;
1157         f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline;
1158
1159         return 0;
1160 }
1161
1162 int cx25821_vidioc_querycap(struct file *file, void *priv,
1163                             struct v4l2_capability *cap)
1164 {
1165         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1166
1167         strcpy(cap->driver, "cx25821");
1168         strlcpy(cap->card, cx25821_boards[dev->board].name, sizeof(cap->card));
1169         sprintf(cap->bus_info, "PCIe:%s", pci_name(dev->pci));
1170         cap->version = CX25821_VERSION_CODE;
1171         cap->capabilities =
1172             V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE | V4L2_CAP_STREAMING;
1173         if (UNSET != dev->tuner_type)
1174                 cap->capabilities |= V4L2_CAP_TUNER;
1175         return 0;
1176 }
1177
1178 int cx25821_vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
1179                             struct v4l2_fmtdesc *f)
1180 {
1181         if (unlikely(f->index >= ARRAY_SIZE(formats)))
1182                 return -EINVAL;
1183
1184         strlcpy(f->description, formats[f->index].name, sizeof(f->description));
1185         f->pixelformat = formats[f->index].fourcc;
1186
1187         return 0;
1188 }
1189
1190 int cx25821_vidioc_reqbufs(struct file *file, void *priv,
1191                            struct v4l2_requestbuffers *p)
1192 {
1193         struct cx25821_fh *fh = priv;
1194         return videobuf_reqbufs(get_queue(fh), p);
1195 }
1196
1197 int cx25821_vidioc_querybuf(struct file *file, void *priv,
1198                             struct v4l2_buffer *p)
1199 {
1200         struct cx25821_fh *fh = priv;
1201         return videobuf_querybuf(get_queue(fh), p);
1202 }
1203
1204 int cx25821_vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *p)
1205 {
1206         struct cx25821_fh *fh = priv;
1207         return videobuf_qbuf(get_queue(fh), p);
1208 }
1209
1210 int cx25821_vidioc_g_priority(struct file *file, void *f, enum v4l2_priority *p)
1211 {
1212         struct cx25821_dev *dev = ((struct cx25821_fh *)f)->dev;
1213         struct cx25821_fh *fh = f;
1214
1215         *p = v4l2_prio_max(&dev->channels[fh->channel_id].prio);
1216
1217         return 0;
1218 }
1219
1220 int cx25821_vidioc_s_priority(struct file *file, void *f,
1221                               enum v4l2_priority prio)
1222 {
1223         struct cx25821_fh *fh = f;
1224         struct cx25821_dev *dev = ((struct cx25821_fh *)f)->dev;
1225
1226         return v4l2_prio_change(&dev->channels[fh->channel_id].prio, &fh->prio,
1227                         prio);
1228 }
1229
1230 #ifdef TUNER_FLAG
1231 int cx25821_vidioc_s_std(struct file *file, void *priv, v4l2_std_id * tvnorms)
1232 {
1233         struct cx25821_fh *fh = priv;
1234         struct cx25821_dev *dev = ((struct cx25821_fh *)priv)->dev;
1235         int err;
1236
1237         dprintk(1, "%s()\n", __func__);
1238
1239         if (fh) {
1240                 err = v4l2_prio_check(&dev->channels[fh->channel_id].prio,
1241                                       fh->prio);
1242                 if (0 != err)
1243                         return err;
1244         }
1245
1246         if (dev->tvnorm == *tvnorms)
1247                 return 0;
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 * const 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].prio,
1310                                       fh->prio);
1311                 if (0 != err)
1312                         return err;
1313         }
1314
1315         if (i >= CX25821_NR_INPUT) {
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].prio,
1365                                       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].prio,
1433                                       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].prio,
1645                                       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 && command != UPSTREAM_STOP_VIDEO)
1722                 return 0;
1723
1724         dev->input_filename = data_from_user->input_filename;
1725         dev->input_audiofilename = data_from_user->input_filename;
1726         dev->vid_stdname = data_from_user->vid_stdname;
1727         dev->pixel_format = data_from_user->pixel_format;
1728         dev->channel_select = data_from_user->channel_select;
1729         dev->command = data_from_user->command;
1730
1731         switch (command) {
1732         case UPSTREAM_START_VIDEO:
1733                 cx25821_start_upstream_video_ch1(dev, data_from_user);
1734                 break;
1735
1736         case UPSTREAM_STOP_VIDEO:
1737                 cx25821_stop_upstream_video_ch1(dev);
1738                 break;
1739         }
1740
1741         return 0;
1742 }
1743
1744 static long video_ioctl_upstream10(struct file *file, unsigned int cmd,
1745                                   unsigned long arg)
1746 {
1747         struct cx25821_fh *fh = file->private_data;
1748         struct cx25821_dev *dev = fh->dev;
1749         int command = 0;
1750         struct upstream_user_struct *data_from_user;
1751
1752         data_from_user = (struct upstream_user_struct *)arg;
1753
1754         if (!data_from_user) {
1755                 pr_err("%s(): Upstream data is INVALID. Returning\n", __func__);
1756                 return 0;
1757         }
1758
1759         command = data_from_user->command;
1760
1761         if (command != UPSTREAM_START_VIDEO && command != UPSTREAM_STOP_VIDEO)
1762                 return 0;
1763
1764         dev->input_filename_ch2 = data_from_user->input_filename;
1765         dev->input_audiofilename = data_from_user->input_filename;
1766         dev->vid_stdname_ch2 = data_from_user->vid_stdname;
1767         dev->pixel_format_ch2 = data_from_user->pixel_format;
1768         dev->channel_select_ch2 = data_from_user->channel_select;
1769         dev->command_ch2 = data_from_user->command;
1770
1771         switch (command) {
1772         case UPSTREAM_START_VIDEO:
1773                 cx25821_start_upstream_video_ch2(dev, data_from_user);
1774                 break;
1775
1776         case UPSTREAM_STOP_VIDEO:
1777                 cx25821_stop_upstream_video_ch2(dev);
1778                 break;
1779         }
1780
1781         return 0;
1782 }
1783
1784 static long video_ioctl_upstream11(struct file *file, unsigned int cmd,
1785                                   unsigned long arg)
1786 {
1787         struct cx25821_fh *fh = file->private_data;
1788         struct cx25821_dev *dev = fh->dev;
1789         int command = 0;
1790         struct upstream_user_struct *data_from_user;
1791
1792         data_from_user = (struct upstream_user_struct *)arg;
1793
1794         if (!data_from_user) {
1795                 pr_err("%s(): Upstream data is INVALID. Returning\n", __func__);
1796                 return 0;
1797         }
1798
1799         command = data_from_user->command;
1800
1801         if (command != UPSTREAM_START_AUDIO && command != UPSTREAM_STOP_AUDIO)
1802                 return 0;
1803
1804         dev->input_filename = data_from_user->input_filename;
1805         dev->input_audiofilename = data_from_user->input_filename;
1806         dev->vid_stdname = data_from_user->vid_stdname;
1807         dev->pixel_format = data_from_user->pixel_format;
1808         dev->channel_select = data_from_user->channel_select;
1809         dev->command = data_from_user->command;
1810
1811         switch (command) {
1812         case UPSTREAM_START_AUDIO:
1813                 cx25821_start_upstream_audio(dev, data_from_user);
1814                 break;
1815
1816         case UPSTREAM_STOP_AUDIO:
1817                 cx25821_stop_upstream_audio(dev);
1818                 break;
1819         }
1820
1821         return 0;
1822 }
1823
1824 static long video_ioctl_set(struct file *file, unsigned int cmd,
1825                            unsigned long arg)
1826 {
1827         struct cx25821_fh *fh = file->private_data;
1828         struct cx25821_dev *dev = fh->dev;
1829         struct downstream_user_struct *data_from_user;
1830         int command;
1831         int width = 720;
1832         int selected_channel = 0, pix_format = 0, i = 0;
1833         int cif_enable = 0, cif_width = 0;
1834         u32 value = 0;
1835
1836         data_from_user = (struct downstream_user_struct *)arg;
1837
1838         if (!data_from_user) {
1839                 pr_err("%s(): User data is INVALID. Returning\n", __func__);
1840                 return 0;
1841         }
1842
1843         command = data_from_user->command;
1844
1845         if (command != SET_VIDEO_STD && command != SET_PIXEL_FORMAT
1846            && command != ENABLE_CIF_RESOLUTION && command != REG_READ
1847            && command != REG_WRITE && command != MEDUSA_READ
1848            && command != MEDUSA_WRITE) {
1849                 return 0;
1850         }
1851
1852         switch (command) {
1853         case SET_VIDEO_STD:
1854                 if (!strcmp(data_from_user->vid_stdname, "PAL"))
1855                         dev->tvnorm = V4L2_STD_PAL_BG;
1856                 else
1857                         dev->tvnorm = V4L2_STD_NTSC_M;
1858                 medusa_set_videostandard(dev);
1859                 break;
1860
1861         case SET_PIXEL_FORMAT:
1862                 selected_channel = data_from_user->decoder_select;
1863                 pix_format = data_from_user->pixel_format;
1864
1865                 if (!(selected_channel <= 7 && selected_channel >= 0)) {
1866                         selected_channel -= 4;
1867                         selected_channel = selected_channel % 8;
1868                 }
1869
1870                 if (selected_channel >= 0)
1871                         cx25821_set_pixel_format(dev, selected_channel,
1872                                                 pix_format);
1873
1874                 break;
1875
1876         case ENABLE_CIF_RESOLUTION:
1877                 selected_channel = data_from_user->decoder_select;
1878                 cif_enable = data_from_user->cif_resolution_enable;
1879                 cif_width = data_from_user->cif_width;
1880
1881                 if (cif_enable) {
1882                         if (dev->tvnorm & V4L2_STD_PAL_BG
1883                             || dev->tvnorm & V4L2_STD_PAL_DK) {
1884                                 width = 352;
1885                         } else {
1886                                 width = cif_width;
1887                                 if (cif_width != 320 && cif_width != 352)
1888                                         width = 320;
1889                         }
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 = cx25821_i2c_read(&dev->i2c_bus[0],
1919                                          (u16) data_from_user->reg_address,
1920                                          &data_from_user->reg_data);
1921                 break;
1922         case MEDUSA_WRITE:
1923                 cx25821_i2c_write(&dev->i2c_bus[0],
1924                                   (u16) data_from_user->reg_address,
1925                                   data_from_user->reg_data);
1926                 break;
1927         }
1928
1929         return 0;
1930 }
1931
1932 static long cx25821_video_ioctl(struct file *file,
1933                                 unsigned int cmd, unsigned long arg)
1934 {
1935         int  ret = 0;
1936
1937         struct cx25821_fh  *fh  = file->private_data;
1938
1939         /* check to see if it's the video upstream */
1940         if (fh->channel_id == SRAM_CH09) {
1941                 ret = video_ioctl_upstream9(file, cmd, arg);
1942                 return ret;
1943         } else if (fh->channel_id == SRAM_CH10) {
1944                 ret = video_ioctl_upstream10(file, cmd, arg);
1945                 return ret;
1946         } else if (fh->channel_id == SRAM_CH11) {
1947                 ret = video_ioctl_upstream11(file, cmd, arg);
1948                 ret = video_ioctl_set(file, cmd, arg);
1949                 return ret;
1950         }
1951
1952         return video_ioctl2(file, cmd, arg);
1953 }
1954
1955 /* exported stuff */
1956 static const struct v4l2_file_operations video_fops = {
1957         .owner = THIS_MODULE,
1958         .open = video_open,
1959         .release = video_release,
1960         .read = video_read,
1961         .poll = video_poll,
1962         .mmap = cx25821_video_mmap,
1963         .ioctl = cx25821_video_ioctl,
1964 };
1965
1966 static const struct v4l2_ioctl_ops video_ioctl_ops = {
1967         .vidioc_querycap = cx25821_vidioc_querycap,
1968         .vidioc_enum_fmt_vid_cap = cx25821_vidioc_enum_fmt_vid_cap,
1969         .vidioc_g_fmt_vid_cap = cx25821_vidioc_g_fmt_vid_cap,
1970         .vidioc_try_fmt_vid_cap = cx25821_vidioc_try_fmt_vid_cap,
1971         .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
1972         .vidioc_reqbufs = cx25821_vidioc_reqbufs,
1973         .vidioc_querybuf = cx25821_vidioc_querybuf,
1974         .vidioc_qbuf = cx25821_vidioc_qbuf,
1975         .vidioc_dqbuf = vidioc_dqbuf,
1976 #ifdef TUNER_FLAG
1977         .vidioc_s_std = cx25821_vidioc_s_std,
1978         .vidioc_querystd = cx25821_vidioc_querystd,
1979 #endif
1980         .vidioc_cropcap = cx25821_vidioc_cropcap,
1981         .vidioc_s_crop = cx25821_vidioc_s_crop,
1982         .vidioc_g_crop = cx25821_vidioc_g_crop,
1983         .vidioc_enum_input = cx25821_vidioc_enum_input,
1984         .vidioc_g_input = cx25821_vidioc_g_input,
1985         .vidioc_s_input = cx25821_vidioc_s_input,
1986         .vidioc_g_ctrl = cx25821_vidioc_g_ctrl,
1987         .vidioc_s_ctrl = vidioc_s_ctrl,
1988         .vidioc_queryctrl = cx25821_vidioc_queryctrl,
1989         .vidioc_streamon = vidioc_streamon,
1990         .vidioc_streamoff = vidioc_streamoff,
1991         .vidioc_log_status = vidioc_log_status,
1992         .vidioc_g_priority = cx25821_vidioc_g_priority,
1993         .vidioc_s_priority = cx25821_vidioc_s_priority,
1994 #ifdef TUNER_FLAG
1995         .vidioc_g_tuner = cx25821_vidioc_g_tuner,
1996         .vidioc_s_tuner = cx25821_vidioc_s_tuner,
1997         .vidioc_g_frequency = cx25821_vidioc_g_frequency,
1998         .vidioc_s_frequency = cx25821_vidioc_s_frequency,
1999 #endif
2000 #ifdef CONFIG_VIDEO_ADV_DEBUG
2001         .vidioc_g_register = cx25821_vidioc_g_register,
2002         .vidioc_s_register = cx25821_vidioc_s_register,
2003 #endif
2004 };
2005
2006 struct video_device cx25821_videoioctl_template = {
2007         .name = "cx25821-videoioctl",
2008         .fops = &video_fops,
2009         .ioctl_ops = &video_ioctl_ops,
2010         .tvnorms = CX25821_NORMS,
2011         .current_norm = V4L2_STD_NTSC_M,
2012 };