drivers/media/video/cx231xx/cx231xx-417.c

   1 /*
   2  *
   3  *  Support for a cx23417 mpeg encoder via cx231xx host port.
   4  *
   5  *    (c) 2004 Jelle Foks <jelle@foks.us>
   6  *    (c) 2004 Gerd Knorr <kraxel@bytesex.org>
   7  *    (c) 2008 Steven Toth <stoth@linuxtv.org>
   8  *      - CX23885/7/8 support
   9  *
  10  *  Includes parts from the ivtv driver( http://ivtv.sourceforge.net/),
  11  *
  12  *  This program is free software; you can redistribute it and/or modify
  13  *  it under the terms of the GNU General Public License as published by
  14  *  the Free Software Foundation; either version 2 of the License, or
  15  *  (at your option) any later version.
  16  *
  17  *  This program is distributed in the hope that it will be useful,
  18  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  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 #include <linux/module.h>
  28 #include <linux/moduleparam.h>
  29 #include <linux/init.h>
  30 #include <linux/fs.h>
  31 #include <linux/delay.h>
  32 #include <linux/device.h>
  33 #include <linux/firmware.h>
  34 #include <linux/vmalloc.h>
  35 #include <media/v4l2-common.h>
  36 #include <media/v4l2-ioctl.h>
  37 #include <media/cx2341x.h>
  38 #include <linux/usb.h>
  39
  40 #include "cx231xx.h"
  41 /*#include "cx23885-ioctl.h"*/
  42
  43 #define CX231xx_FIRM_IMAGE_SIZE 376836
  44 #define CX231xx_FIRM_IMAGE_NAME "v4l-cx23885-enc.fw"
  45
  46 /* for polaris ITVC */
  47 #define ITVC_WRITE_DIR          0x03FDFC00
  48 #define ITVC_READ_DIR            0x0001FC00
  49
  50 #define  MCI_MEMORY_DATA_BYTE0          0x00
  51 #define  MCI_MEMORY_DATA_BYTE1          0x08
  52 #define  MCI_MEMORY_DATA_BYTE2          0x10
  53 #define  MCI_MEMORY_DATA_BYTE3          0x18
  54
  55 #define  MCI_MEMORY_ADDRESS_BYTE2       0x20
  56 #define  MCI_MEMORY_ADDRESS_BYTE1       0x28
  57 #define  MCI_MEMORY_ADDRESS_BYTE0       0x30
  58
  59 #define  MCI_REGISTER_DATA_BYTE0        0x40
  60 #define  MCI_REGISTER_DATA_BYTE1        0x48
  61 #define  MCI_REGISTER_DATA_BYTE2        0x50
  62 #define  MCI_REGISTER_DATA_BYTE3        0x58
  63
  64 #define  MCI_REGISTER_ADDRESS_BYTE0     0x60
  65 #define  MCI_REGISTER_ADDRESS_BYTE1     0x68
  66
  67 #define  MCI_REGISTER_MODE              0x70
  68
  69 /* Read and write modes for polaris ITVC */
  70 #define  MCI_MODE_REGISTER_READ         0x000
  71 #define  MCI_MODE_REGISTER_WRITE        0x100
  72 #define  MCI_MODE_MEMORY_READ           0x000
  73 #define  MCI_MODE_MEMORY_WRITE          0x4000
  74
  75 static unsigned int mpegbufs = 8;
  76 module_param(mpegbufs, int, 0644);
  77 MODULE_PARM_DESC(mpegbufs, "number of mpeg buffers, range 2-32");
  78 static unsigned int mpeglines = 128;
  79 module_param(mpeglines, int, 0644);
  80 MODULE_PARM_DESC(mpeglines, "number of lines in an MPEG buffer, range 2-32");
  81 static unsigned int mpeglinesize = 512;
  82 module_param(mpeglinesize, int, 0644);
  83 MODULE_PARM_DESC(mpeglinesize,
  84         "number of bytes in each line of an MPEG buffer, range 512-1024");
  85
  86 static unsigned int v4l_debug = 1;
  87 module_param(v4l_debug, int, 0644);
  88 MODULE_PARM_DESC(v4l_debug, "enable V4L debug messages");
  89 struct cx231xx_dmaqueue *dma_qq;
  90 #define dprintk(level, fmt, arg...)\
  91         do { if (v4l_debug >= level) \
  92                 printk(KERN_INFO "%s: " fmt, \
  93                 (dev) ? dev->name : "cx231xx[?]", ## arg); \
  94         } while (0)
  95
  96 static struct cx231xx_tvnorm cx231xx_tvnorms[] = {
  97         {
  98                 .name      = "NTSC-M",
  99                 .id        = V4L2_STD_NTSC_M,
 100         }, {
 101                 .name      = "NTSC-JP",
 102                 .id        = V4L2_STD_NTSC_M_JP,
 103         }, {
 104                 .name      = "PAL-BG",
 105                 .id        = V4L2_STD_PAL_BG,
 106         }, {
 107                 .name      = "PAL-DK",
 108                 .id        = V4L2_STD_PAL_DK,
 109         }, {
 110                 .name      = "PAL-I",
 111                 .id        = V4L2_STD_PAL_I,
 112         }, {
 113                 .name      = "PAL-M",
 114                 .id        = V4L2_STD_PAL_M,
 115         }, {
 116                 .name      = "PAL-N",
 117                 .id        = V4L2_STD_PAL_N,
 118         }, {
 119                 .name      = "PAL-Nc",
 120                 .id        = V4L2_STD_PAL_Nc,
 121         }, {
 122                 .name      = "PAL-60",
 123                 .id        = V4L2_STD_PAL_60,
 124         }, {
 125                 .name      = "SECAM-L",
 126                 .id        = V4L2_STD_SECAM_L,
 127         }, {
 128                 .name      = "SECAM-DK",
 129                 .id        = V4L2_STD_SECAM_DK,
 130         }
 131 };
 132
 133 /* ------------------------------------------------------------------ */
 134 enum cx231xx_capture_type {
 135         CX231xx_MPEG_CAPTURE,
 136         CX231xx_RAW_CAPTURE,
 137         CX231xx_RAW_PASSTHRU_CAPTURE
 138 };
 139 enum cx231xx_capture_bits {
 140         CX231xx_RAW_BITS_NONE             = 0x00,
 141         CX231xx_RAW_BITS_YUV_CAPTURE      = 0x01,
 142         CX231xx_RAW_BITS_PCM_CAPTURE      = 0x02,
 143         CX231xx_RAW_BITS_VBI_CAPTURE      = 0x04,
 144         CX231xx_RAW_BITS_PASSTHRU_CAPTURE = 0x08,
 145         CX231xx_RAW_BITS_TO_HOST_CAPTURE  = 0x10
 146 };
 147 enum cx231xx_capture_end {
 148         CX231xx_END_AT_GOP, /* stop at the end of gop, generate irq */
 149         CX231xx_END_NOW, /* stop immediately, no irq */
 150 };
 151 enum cx231xx_framerate {
 152         CX231xx_FRAMERATE_NTSC_30, /* NTSC: 30fps */
 153         CX231xx_FRAMERATE_PAL_25   /* PAL: 25fps */
 154 };
 155 enum cx231xx_stream_port {
 156         CX231xx_OUTPUT_PORT_MEMORY,
 157         CX231xx_OUTPUT_PORT_STREAMING,
 158         CX231xx_OUTPUT_PORT_SERIAL
 159 };
 160 enum cx231xx_data_xfer_status {
 161         CX231xx_MORE_BUFFERS_FOLLOW,
 162         CX231xx_LAST_BUFFER,
 163 };
 164 enum cx231xx_picture_mask {
 165         CX231xx_PICTURE_MASK_NONE,
 166         CX231xx_PICTURE_MASK_I_FRAMES,
 167         CX231xx_PICTURE_MASK_I_P_FRAMES = 0x3,
 168         CX231xx_PICTURE_MASK_ALL_FRAMES = 0x7,
 169 };
 170 enum cx231xx_vbi_mode_bits {
 171         CX231xx_VBI_BITS_SLICED,
 172         CX231xx_VBI_BITS_RAW,
 173 };
 174 enum cx231xx_vbi_insertion_bits {
 175         CX231xx_VBI_BITS_INSERT_IN_XTENSION_USR_DATA,
 176         CX231xx_VBI_BITS_INSERT_IN_PRIVATE_PACKETS = 0x1 << 1,
 177         CX231xx_VBI_BITS_SEPARATE_STREAM = 0x2 << 1,
 178         CX231xx_VBI_BITS_SEPARATE_STREAM_USR_DATA = 0x4 << 1,
 179         CX231xx_VBI_BITS_SEPARATE_STREAM_PRV_DATA = 0x5 << 1,
 180 };
 181 enum cx231xx_dma_unit {
 182         CX231xx_DMA_BYTES,
 183         CX231xx_DMA_FRAMES,
 184 };
 185 enum cx231xx_dma_transfer_status_bits {
 186         CX231xx_DMA_TRANSFER_BITS_DONE = 0x01,
 187         CX231xx_DMA_TRANSFER_BITS_ERROR = 0x04,
 188         CX231xx_DMA_TRANSFER_BITS_LL_ERROR = 0x10,
 189 };
 190 enum cx231xx_pause {
 191         CX231xx_PAUSE_ENCODING,
 192         CX231xx_RESUME_ENCODING,
 193 };
 194 enum cx231xx_copyright {
 195         CX231xx_COPYRIGHT_OFF,
 196         CX231xx_COPYRIGHT_ON,
 197 };
 198 enum cx231xx_notification_type {
 199         CX231xx_NOTIFICATION_REFRESH,
 200 };
 201 enum cx231xx_notification_status {
 202         CX231xx_NOTIFICATION_OFF,
 203         CX231xx_NOTIFICATION_ON,
 204 };
 205 enum cx231xx_notification_mailbox {
 206         CX231xx_NOTIFICATION_NO_MAILBOX = -1,
 207 };
 208 enum cx231xx_field1_lines {
 209         CX231xx_FIELD1_SAA7114 = 0x00EF, /* 239 */
 210         CX231xx_FIELD1_SAA7115 = 0x00F0, /* 240 */
 211         CX231xx_FIELD1_MICRONAS = 0x0105, /* 261 */
 212 };
 213 enum cx231xx_field2_lines {
 214         CX231xx_FIELD2_SAA7114 = 0x00EF, /* 239 */
 215         CX231xx_FIELD2_SAA7115 = 0x00F0, /* 240 */
 216         CX231xx_FIELD2_MICRONAS = 0x0106, /* 262 */
 217 };
 218 enum cx231xx_custom_data_type {
 219         CX231xx_CUSTOM_EXTENSION_USR_DATA,
 220         CX231xx_CUSTOM_PRIVATE_PACKET,
 221 };
 222 enum cx231xx_mute {
 223         CX231xx_UNMUTE,
 224         CX231xx_MUTE,
 225 };
 226 enum cx231xx_mute_video_mask {
 227         CX231xx_MUTE_VIDEO_V_MASK = 0x0000FF00,
 228         CX231xx_MUTE_VIDEO_U_MASK = 0x00FF0000,
 229         CX231xx_MUTE_VIDEO_Y_MASK = 0xFF000000,
 230 };
 231 enum cx231xx_mute_video_shift {
 232         CX231xx_MUTE_VIDEO_V_SHIFT = 8,
 233         CX231xx_MUTE_VIDEO_U_SHIFT = 16,
 234         CX231xx_MUTE_VIDEO_Y_SHIFT = 24,
 235 };
 236
 237 /* defines below are from ivtv-driver.h */
 238 #define IVTV_CMD_HW_BLOCKS_RST 0xFFFFFFFF
 239
 240 /* Firmware API commands */
 241 #define IVTV_API_STD_TIMEOUT 500
 242
 243 /* Registers */
 244 /* IVTV_REG_OFFSET */
 245 #define IVTV_REG_ENC_SDRAM_REFRESH (0x07F8)
 246 #define IVTV_REG_ENC_SDRAM_PRECHARGE (0x07FC)
 247 #define IVTV_REG_SPU (0x9050)
 248 #define IVTV_REG_HW_BLOCKS (0x9054)
 249 #define IVTV_REG_VPU (0x9058)
 250 #define IVTV_REG_APU (0xA064)
 251
 252 /*
 253  * Bit definitions for MC417_RWD and MC417_OEN registers
 254  *
 255  * bits 31-16
 256  *+-----------+
 257  *| Reserved  |
 258  *|+-----------+
 259  *|  bit 15  bit 14  bit 13 bit 12  bit 11  bit 10  bit 9   bit 8
 260  *|+-------+-------+-------+-------+-------+-------+-------+-------+
 261  *|| MIWR# | MIRD# | MICS# |MIRDY# |MIADDR3|MIADDR2|MIADDR1|MIADDR0|
 262  *|+-------+-------+-------+-------+-------+-------+-------+-------+
 263  *| bit 7   bit 6   bit 5   bit 4   bit 3   bit 2   bit 1   bit 0
 264  *|+-------+-------+-------+-------+-------+-------+-------+-------+
 265  *||MIDATA7|MIDATA6|MIDATA5|MIDATA4|MIDATA3|MIDATA2|MIDATA1|MIDATA0|
 266  *|+-------+-------+-------+-------+-------+-------+-------+-------+
 267  */
 268 #define MC417_MIWR      0x8000
 269 #define MC417_MIRD      0x4000
 270 #define MC417_MICS      0x2000
 271 #define MC417_MIRDY     0x1000
 272 #define MC417_MIADDR    0x0F00
 273 #define MC417_MIDATA    0x00FF
 274
 275
 276 /* Bit definitions for MC417_CTL register ****
 277  *bits 31-6   bits 5-4   bit 3    bits 2-1       Bit 0
 278  *+--------+-------------+--------+--------------+------------+
 279  *|Reserved|MC417_SPD_CTL|Reserved|MC417_GPIO_SEL|UART_GPIO_EN|
 280  *+--------+-------------+--------+--------------+------------+
 281  */
 282 #define MC417_SPD_CTL(x)        (((x) << 4) & 0x00000030)
 283 #define MC417_GPIO_SEL(x)       (((x) << 1) & 0x00000006)
 284 #define MC417_UART_GPIO_EN      0x00000001
 285
 286 /* Values for speed control */
 287 #define MC417_SPD_CTL_SLOW      0x1
 288 #define MC417_SPD_CTL_MEDIUM    0x0
 289 #define MC417_SPD_CTL_FAST      0x3     /* b'1x, but we use b'11 */
 290
 291 /* Values for GPIO select */
 292 #define MC417_GPIO_SEL_GPIO3    0x3
 293 #define MC417_GPIO_SEL_GPIO2    0x2
 294 #define MC417_GPIO_SEL_GPIO1    0x1
 295 #define MC417_GPIO_SEL_GPIO0    0x0
 296
 297
 298 #define CX23417_GPIO_MASK 0xFC0003FF
 299 static int setITVCReg(struct cx231xx *dev, u32 gpio_direction, u32 value)
 300 {
 301         int status = 0;
 302         u32 _gpio_direction = 0;
 303
 304         _gpio_direction = _gpio_direction & CX23417_GPIO_MASK;
 305         _gpio_direction = _gpio_direction|gpio_direction;
 306         status = cx231xx_send_gpio_cmd(dev, _gpio_direction,
 307                          (u8 *)&value, 4, 0, 0);
 308         return status;
 309 }
 310 static int getITVCReg(struct cx231xx *dev, u32 gpio_direction, u32 *pValue)
 311 {
 312         int status = 0;
 313         u32 _gpio_direction = 0;
 314
 315         _gpio_direction = _gpio_direction & CX23417_GPIO_MASK;
 316         _gpio_direction = _gpio_direction|gpio_direction;
 317
 318         status = cx231xx_send_gpio_cmd(dev, _gpio_direction,
 319                  (u8 *)pValue, 4, 0, 1);
 320         return status;
 321 }
 322
 323 static int waitForMciComplete(struct cx231xx *dev)
 324 {
 325         u32 gpio;
 326         u32 gpio_driection = 0;
 327         u8 count = 0;
 328         getITVCReg(dev, gpio_driection, &gpio);
 329
 330         while (!(gpio&0x020000)) {
 331                 msleep(10);
 332
 333                 getITVCReg(dev, gpio_driection, &gpio);
 334
 335                 if (count++ > 100) {
 336                         dprintk(3, "ERROR: Timeout - gpio=%x\n", gpio);
 337                         return -1;
 338                 }
 339         }
 340         return 0;
 341 }
 342
 343 static int mc417_register_write(struct cx231xx *dev, u16 address, u32 value)
 344 {
 345         u32 temp;
 346         int status = 0;
 347
 348         temp = 0x82|MCI_REGISTER_DATA_BYTE0|((value&0x000000FF)<<8);
 349         temp = temp<<10;
 350         status = setITVCReg(dev, ITVC_WRITE_DIR, temp);
 351         if (status < 0)
 352                 return status;
 353         temp = temp|((0x05)<<10);
 354         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 355
 356         /*write data byte 1;*/
 357         temp = 0x82|MCI_REGISTER_DATA_BYTE1|(value&0x0000FF00);
 358         temp = temp<<10;
 359         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 360         temp = temp|((0x05)<<10);
 361         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 362
 363         /*write data byte 2;*/
 364         temp = 0x82|MCI_REGISTER_DATA_BYTE2|((value&0x00FF0000)>>8);
 365         temp = temp<<10;
 366         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 367         temp = temp|((0x05)<<10);
 368         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 369
 370         /*write data byte 3;*/
 371         temp = 0x82|MCI_REGISTER_DATA_BYTE3|((value&0xFF000000)>>16);
 372         temp = temp<<10;
 373         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 374         temp = temp|((0x05)<<10);
 375         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 376
 377         /*write address byte 0;*/
 378         temp = 0x82|MCI_REGISTER_ADDRESS_BYTE0|((address&0x000000FF)<<8);
 379         temp = temp<<10;
 380         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 381         temp = temp|((0x05)<<10);
 382         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 383
 384         /*write address byte 1;*/
 385         temp = 0x82|MCI_REGISTER_ADDRESS_BYTE1|(address&0x0000FF00);
 386         temp = temp<<10;
 387         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 388         temp = temp|((0x05)<<10);
 389         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 390
 391         /*Write that the mode is write.*/
 392         temp = 0x82 | MCI_REGISTER_MODE | MCI_MODE_REGISTER_WRITE;
 393         temp = temp<<10;
 394         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 395         temp = temp|((0x05)<<10);
 396         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 397
 398         return waitForMciComplete(dev);
 399 }
 400
 401 static int mc417_register_read(struct cx231xx *dev, u16 address, u32 *value)
 402 {
 403         /*write address byte 0;*/
 404         u32 temp;
 405         u32 return_value = 0;
 406         int ret = 0;
 407
 408         temp = 0x82 | MCI_REGISTER_ADDRESS_BYTE0 | ((address & 0x00FF) << 8);
 409         temp = temp << 10;
 410         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 411         temp = temp | ((0x05) << 10);
 412         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 413
 414         /*write address byte 1;*/
 415         temp = 0x82 | MCI_REGISTER_ADDRESS_BYTE1 | (address & 0xFF00);
 416         temp = temp << 10;
 417         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 418         temp = temp | ((0x05) << 10);
 419         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 420
 421         /*write that the mode is read;*/
 422         temp = 0x82 | MCI_REGISTER_MODE | MCI_MODE_REGISTER_READ;
 423         temp = temp << 10;
 424         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 425         temp = temp | ((0x05) << 10);
 426         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 427
 428         /*wait for the MIRDY line to be asserted ,
 429         signalling that the read is done;*/
 430         ret = waitForMciComplete(dev);
 431
 432         /*switch the DATA- GPIO to input mode;*/
 433
 434         /*Read data byte 0;*/
 435         temp = (0x82 | MCI_REGISTER_DATA_BYTE0) << 10;
 436         setITVCReg(dev, ITVC_READ_DIR, temp);
 437         temp = ((0x81 | MCI_REGISTER_DATA_BYTE0) << 10);
 438         setITVCReg(dev, ITVC_READ_DIR, temp);
 439         getITVCReg(dev, ITVC_READ_DIR, &temp);
 440         return_value |= ((temp & 0x03FC0000) >> 18);
 441         setITVCReg(dev, ITVC_READ_DIR, (0x87 << 10));
 442
 443         /* Read data byte 1;*/
 444         temp = (0x82 | MCI_REGISTER_DATA_BYTE1) << 10;
 445         setITVCReg(dev, ITVC_READ_DIR, temp);
 446         temp = ((0x81 | MCI_REGISTER_DATA_BYTE1) << 10);
 447         setITVCReg(dev, ITVC_READ_DIR, temp);
 448         getITVCReg(dev, ITVC_READ_DIR, &temp);
 449
 450         return_value |= ((temp & 0x03FC0000) >> 10);
 451         setITVCReg(dev, ITVC_READ_DIR, (0x87 << 10));
 452
 453         /*Read data byte 2;*/
 454         temp = (0x82 | MCI_REGISTER_DATA_BYTE2) << 10;
 455         setITVCReg(dev, ITVC_READ_DIR, temp);
 456         temp = ((0x81 | MCI_REGISTER_DATA_BYTE2) << 10);
 457         setITVCReg(dev, ITVC_READ_DIR, temp);
 458         getITVCReg(dev, ITVC_READ_DIR, &temp);
 459         return_value |= ((temp & 0x03FC0000) >> 2);
 460         setITVCReg(dev, ITVC_READ_DIR, (0x87 << 10));
 461
 462         /*Read data byte 3;*/
 463         temp = (0x82 | MCI_REGISTER_DATA_BYTE3) << 10;
 464         setITVCReg(dev, ITVC_READ_DIR, temp);
 465         temp = ((0x81 | MCI_REGISTER_DATA_BYTE3) << 10);
 466         setITVCReg(dev, ITVC_READ_DIR, temp);
 467         getITVCReg(dev, ITVC_READ_DIR, &temp);
 468         return_value |= ((temp & 0x03FC0000) << 6);
 469         setITVCReg(dev, ITVC_READ_DIR, (0x87 << 10));
 470
 471         *value  = return_value;
 472
 473
 474         return ret;
 475 }
 476
 477 static int mc417_memory_write(struct cx231xx *dev, u32 address, u32 value)
 478 {
 479         /*write data byte 0;*/
 480
 481         u32 temp;
 482         int ret = 0;
 483
 484         temp = 0x82 | MCI_MEMORY_DATA_BYTE0|((value & 0x000000FF) << 8);
 485         temp = temp << 10;
 486         ret = setITVCReg(dev, ITVC_WRITE_DIR, temp);
 487         if (ret < 0)
 488                 return ret;
 489         temp = temp | ((0x05) << 10);
 490         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 491
 492         /*write data byte 1;*/
 493         temp = 0x82 | MCI_MEMORY_DATA_BYTE1 | (value & 0x0000FF00);
 494         temp = temp << 10;
 495         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 496         temp = temp | ((0x05) << 10);
 497         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 498
 499         /*write data byte 2;*/
 500         temp = 0x82|MCI_MEMORY_DATA_BYTE2|((value&0x00FF0000)>>8);
 501         temp = temp<<10;
 502         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 503         temp = temp|((0x05)<<10);
 504         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 505
 506         /*write data byte 3;*/
 507         temp = 0x82|MCI_MEMORY_DATA_BYTE3|((value&0xFF000000)>>16);
 508         temp = temp<<10;
 509         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 510         temp = temp|((0x05)<<10);
 511         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 512
 513         /* write address byte 2;*/
 514         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE2 | MCI_MODE_MEMORY_WRITE |
 515                 ((address & 0x003F0000)>>8);
 516         temp = temp<<10;
 517         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 518         temp = temp|((0x05)<<10);
 519         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 520
 521         /* write address byte 1;*/
 522         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE1 | (address & 0xFF00);
 523         temp = temp<<10;
 524         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 525         temp = temp|((0x05)<<10);
 526         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 527
 528         /* write address byte 0;*/
 529         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE0|((address & 0x00FF)<<8);
 530         temp = temp<<10;
 531         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 532         temp = temp|((0x05)<<10);
 533         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 534
 535         /*wait for MIRDY line;*/
 536         waitForMciComplete(dev);
 537
 538         return 0;
 539 }
 540
 541 static int mc417_memory_read(struct cx231xx *dev, u32 address, u32 *value)
 542 {
 543         u32 temp = 0;
 544         u32 return_value = 0;
 545         int ret = 0;
 546
 547         /*write address byte 2;*/
 548         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE2 | MCI_MODE_MEMORY_READ |
 549                 ((address & 0x003F0000)>>8);
 550         temp = temp<<10;
 551         ret = setITVCReg(dev, ITVC_WRITE_DIR, temp);
 552         if (ret < 0)
 553                 return ret;
 554         temp = temp|((0x05)<<10);
 555         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 556
 557         /*write address byte 1*/
 558         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE1 | (address & 0xFF00);
 559         temp = temp<<10;
 560         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 561         temp = temp|((0x05)<<10);
 562         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 563
 564         /*write address byte 0*/
 565         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE0 | ((address & 0x00FF)<<8);
 566         temp = temp<<10;
 567         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 568         temp = temp|((0x05)<<10);
 569         setITVCReg(dev, ITVC_WRITE_DIR, temp);
 570
 571         /*Wait for MIRDY line*/
 572         ret = waitForMciComplete(dev);
 573
 574
 575         /*Read data byte 3;*/
 576         temp = (0x82|MCI_MEMORY_DATA_BYTE3)<<10;
 577         setITVCReg(dev, ITVC_READ_DIR, temp);
 578         temp = ((0x81|MCI_MEMORY_DATA_BYTE3)<<10);
 579         setITVCReg(dev, ITVC_READ_DIR, temp);
 580         getITVCReg(dev, ITVC_READ_DIR, &temp);
 581         return_value |= ((temp&0x03FC0000)<<6);
 582         setITVCReg(dev, ITVC_READ_DIR, (0x87<<10));
 583
 584         /*Read data byte 2;*/
 585         temp = (0x82|MCI_MEMORY_DATA_BYTE2)<<10;
 586         setITVCReg(dev, ITVC_READ_DIR, temp);
 587         temp = ((0x81|MCI_MEMORY_DATA_BYTE2)<<10);
 588         setITVCReg(dev, ITVC_READ_DIR, temp);
 589         getITVCReg(dev, ITVC_READ_DIR, &temp);
 590         return_value |= ((temp&0x03FC0000)>>2);
 591         setITVCReg(dev, ITVC_READ_DIR, (0x87<<10));
 592
 593         /* Read data byte 1;*/
 594         temp = (0x82|MCI_MEMORY_DATA_BYTE1)<<10;
 595         setITVCReg(dev, ITVC_READ_DIR, temp);
 596         temp = ((0x81|MCI_MEMORY_DATA_BYTE1)<<10);
 597         setITVCReg(dev, ITVC_READ_DIR, temp);
 598         getITVCReg(dev, ITVC_READ_DIR, &temp);
 599         return_value |= ((temp&0x03FC0000)>>10);
 600         setITVCReg(dev, ITVC_READ_DIR, (0x87<<10));
 601
 602         /*Read data byte 0;*/
 603         temp = (0x82|MCI_MEMORY_DATA_BYTE0)<<10;
 604         setITVCReg(dev, ITVC_READ_DIR, temp);
 605         temp = ((0x81|MCI_MEMORY_DATA_BYTE0)<<10);
 606         setITVCReg(dev, ITVC_READ_DIR, temp);
 607         getITVCReg(dev, ITVC_READ_DIR, &temp);
 608         return_value |= ((temp&0x03FC0000)>>18);
 609         setITVCReg(dev, ITVC_READ_DIR, (0x87<<10));
 610
 611         *value  = return_value;
 612         return ret;
 613 }
 614
 615 /* ------------------------------------------------------------------ */
 616
 617 /* MPEG encoder API */
 618 static char *cmd_to_str(int cmd)
 619 {
 620         switch (cmd) {
 621         case CX2341X_ENC_PING_FW:
 622                 return  "PING_FW";
 623         case CX2341X_ENC_START_CAPTURE:
 624                 return  "START_CAPTURE";
 625         case CX2341X_ENC_STOP_CAPTURE:
 626                 return  "STOP_CAPTURE";
 627         case CX2341X_ENC_SET_AUDIO_ID:
 628                 return  "SET_AUDIO_ID";
 629         case CX2341X_ENC_SET_VIDEO_ID:
 630                 return  "SET_VIDEO_ID";
 631         case CX2341X_ENC_SET_PCR_ID:
 632                 return  "SET_PCR_PID";
 633         case CX2341X_ENC_SET_FRAME_RATE:
 634                 return  "SET_FRAME_RATE";
 635         case CX2341X_ENC_SET_FRAME_SIZE:
 636                 return  "SET_FRAME_SIZE";
 637         case CX2341X_ENC_SET_BIT_RATE:
 638                 return  "SET_BIT_RATE";
 639         case CX2341X_ENC_SET_GOP_PROPERTIES:
 640                 return  "SET_GOP_PROPERTIES";
 641         case CX2341X_ENC_SET_ASPECT_RATIO:
 642                 return  "SET_ASPECT_RATIO";
 643         case CX2341X_ENC_SET_DNR_FILTER_MODE:
 644                 return  "SET_DNR_FILTER_PROPS";
 645         case CX2341X_ENC_SET_DNR_FILTER_PROPS:
 646                 return  "SET_DNR_FILTER_PROPS";
 647         case CX2341X_ENC_SET_CORING_LEVELS:
 648                 return  "SET_CORING_LEVELS";
 649         case CX2341X_ENC_SET_SPATIAL_FILTER_TYPE:
 650                 return  "SET_SPATIAL_FILTER_TYPE";
 651         case CX2341X_ENC_SET_VBI_LINE:
 652                 return  "SET_VBI_LINE";
 653         case CX2341X_ENC_SET_STREAM_TYPE:
 654                 return  "SET_STREAM_TYPE";
 655         case CX2341X_ENC_SET_OUTPUT_PORT:
 656                 return  "SET_OUTPUT_PORT";
 657         case CX2341X_ENC_SET_AUDIO_PROPERTIES:
 658                 return  "SET_AUDIO_PROPERTIES";
 659         case CX2341X_ENC_HALT_FW:
 660                 return  "HALT_FW";
 661         case CX2341X_ENC_GET_VERSION:
 662                 return  "GET_VERSION";
 663         case CX2341X_ENC_SET_GOP_CLOSURE:
 664                 return  "SET_GOP_CLOSURE";
 665         case CX2341X_ENC_GET_SEQ_END:
 666                 return  "GET_SEQ_END";
 667         case CX2341X_ENC_SET_PGM_INDEX_INFO:
 668                 return  "SET_PGM_INDEX_INFO";
 669         case CX2341X_ENC_SET_VBI_CONFIG:
 670                 return  "SET_VBI_CONFIG";
 671         case CX2341X_ENC_SET_DMA_BLOCK_SIZE:
 672                 return  "SET_DMA_BLOCK_SIZE";
 673         case CX2341X_ENC_GET_PREV_DMA_INFO_MB_10:
 674                 return  "GET_PREV_DMA_INFO_MB_10";
 675         case CX2341X_ENC_GET_PREV_DMA_INFO_MB_9:
 676                 return  "GET_PREV_DMA_INFO_MB_9";
 677         case CX2341X_ENC_SCHED_DMA_TO_HOST:
 678                 return  "SCHED_DMA_TO_HOST";
 679         case CX2341X_ENC_INITIALIZE_INPUT:
 680                 return  "INITIALIZE_INPUT";
 681         case CX2341X_ENC_SET_FRAME_DROP_RATE:
 682                 return  "SET_FRAME_DROP_RATE";
 683         case CX2341X_ENC_PAUSE_ENCODER:
 684                 return  "PAUSE_ENCODER";
 685         case CX2341X_ENC_REFRESH_INPUT:
 686                 return  "REFRESH_INPUT";
 687         case CX2341X_ENC_SET_COPYRIGHT:
 688                 return  "SET_COPYRIGHT";
 689         case CX2341X_ENC_SET_EVENT_NOTIFICATION:
 690                 return  "SET_EVENT_NOTIFICATION";
 691         case CX2341X_ENC_SET_NUM_VSYNC_LINES:
 692                 return  "SET_NUM_VSYNC_LINES";
 693         case CX2341X_ENC_SET_PLACEHOLDER:
 694                 return  "SET_PLACEHOLDER";
 695         case CX2341X_ENC_MUTE_VIDEO:
 696                 return  "MUTE_VIDEO";
 697         case CX2341X_ENC_MUTE_AUDIO:
 698                 return  "MUTE_AUDIO";
 699         case CX2341X_ENC_MISC:
 700                 return  "MISC";
 701         default:
 702                 return "UNKNOWN";
 703         }
 704 }
 705
 706 static int cx231xx_mbox_func(void *priv,
 707                              u32 command,
 708                              int in,
 709                              int out,
 710                              u32 data[CX2341X_MBOX_MAX_DATA])
 711 {
 712         struct cx231xx *dev = priv;
 713         unsigned long timeout;
 714         u32 value, flag, retval = 0;
 715         int i;
 716
 717         dprintk(3, "%s: command(0x%X) = %s\n", __func__, command,
 718                 cmd_to_str(command));
 719
 720         /* this may not be 100% safe if we can't read any memory location
 721            without side effects */
 722         mc417_memory_read(dev, dev->cx23417_mailbox - 4, &value);
 723         if (value != 0x12345678) {
 724                 dprintk(3,
 725                         "Firmware and/or mailbox pointer not initialized "
 726                         "or corrupted, signature = 0x%x, cmd = %s\n", value,
 727                         cmd_to_str(command));
 728                 return -1;
 729         }
 730
 731         /* This read looks at 32 bits, but flag is only 8 bits.
 732          * Seems we also bail if CMD or TIMEOUT bytes are set???
 733          */
 734         mc417_memory_read(dev, dev->cx23417_mailbox, &flag);
 735         if (flag) {
 736                 dprintk(3, "ERROR: Mailbox appears to be in use "
 737                         "(%x), cmd = %s\n", flag, cmd_to_str(command));
 738                 return -1;
 739         }
 740
 741         flag |= 1; /* tell 'em we're working on it */
 742         mc417_memory_write(dev, dev->cx23417_mailbox, flag);
 743
 744         /* write command + args + fill remaining with zeros */
 745         /* command code */
 746         mc417_memory_write(dev, dev->cx23417_mailbox + 1, command);
 747         mc417_memory_write(dev, dev->cx23417_mailbox + 3,
 748                 IVTV_API_STD_TIMEOUT); /* timeout */
 749         for (i = 0; i < in; i++) {
 750                 mc417_memory_write(dev, dev->cx23417_mailbox + 4 + i, data[i]);
 751                 dprintk(3, "API Input %d = %d\n", i, data[i]);
 752         }
 753         for (; i < CX2341X_MBOX_MAX_DATA; i++)
 754                 mc417_memory_write(dev, dev->cx23417_mailbox + 4 + i, 0);
 755
 756         flag |= 3; /* tell 'em we're done writing */
 757         mc417_memory_write(dev, dev->cx23417_mailbox, flag);
 758
 759         /* wait for firmware to handle the API command */
 760         timeout = jiffies + msecs_to_jiffies(10);
 761         for (;;) {
 762                 mc417_memory_read(dev, dev->cx23417_mailbox, &flag);
 763                 if (0 != (flag & 4))
 764                         break;
 765                 if (time_after(jiffies, timeout)) {
 766                         dprintk(3, "ERROR: API Mailbox timeout\n");
 767                         return -1;
 768                 }
 769                 udelay(10);
 770         }
 771
 772         /* read output values */
 773         for (i = 0; i < out; i++) {
 774                 mc417_memory_read(dev, dev->cx23417_mailbox + 4 + i, data + i);
 775                 dprintk(3, "API Output %d = %d\n", i, data[i]);
 776         }
 777
 778         mc417_memory_read(dev, dev->cx23417_mailbox + 2, &retval);
 779         dprintk(3, "API result = %d\n", retval);
 780
 781         flag = 0;
 782         mc417_memory_write(dev, dev->cx23417_mailbox, flag);
 783
 784         return retval;
 785 }
 786
 787 /* We don't need to call the API often, so using just one
 788  * mailbox will probably suffice
 789  */
 790 static int cx231xx_api_cmd(struct cx231xx *dev,
 791                            u32 command,
 792                            u32 inputcnt,
 793                            u32 outputcnt,
 794                            ...)
 795 {
 796         u32 data[CX2341X_MBOX_MAX_DATA];
 797         va_list vargs;
 798         int i, err;
 799
 800         dprintk(3, "%s() cmds = 0x%08x\n", __func__, command);
 801
 802         va_start(vargs, outputcnt);
 803         for (i = 0; i < inputcnt; i++)
 804                 data[i] = va_arg(vargs, int);
 805
 806         err = cx231xx_mbox_func(dev, command, inputcnt, outputcnt, data);
 807         for (i = 0; i < outputcnt; i++) {
 808                 int *vptr = va_arg(vargs, int *);
 809                 *vptr = data[i];
 810         }
 811         va_end(vargs);
 812
 813         return err;
 814 }
 815
 816 static int cx231xx_find_mailbox(struct cx231xx *dev)
 817 {
 818         u32 signature[4] = {
 819                 0x12345678, 0x34567812, 0x56781234, 0x78123456
 820         };
 821         int signaturecnt = 0;
 822         u32 value;
 823         int i;
 824         int ret = 0;
 825
 826         dprintk(2, "%s()\n", __func__);
 827
 828         for (i = 0; i < 0x100; i++) {/*CX231xx_FIRM_IMAGE_SIZE*/
 829                 ret = mc417_memory_read(dev, i, &value);
 830                 if (ret < 0)
 831                         return ret;
 832                 if (value == signature[signaturecnt])
 833                         signaturecnt++;
 834                 else
 835                         signaturecnt = 0;
 836                 if (4 == signaturecnt) {
 837                         dprintk(1, "Mailbox signature found at 0x%x\n", i+1);
 838                         return i+1;
 839                 }
 840         }
 841         dprintk(3, "Mailbox signature values not found!\n");
 842         return -1;
 843 }
 844
 845 static void mciWriteMemoryToGPIO(struct cx231xx *dev, u32 address, u32 value,
 846                 u32 *p_fw_image)
 847 {
 848
 849         u32 temp = 0;
 850         int i = 0;
 851
 852         temp = 0x82|MCI_MEMORY_DATA_BYTE0|((value&0x000000FF)<<8);
 853         temp = temp<<10;
 854         *p_fw_image = temp;
 855         p_fw_image++;
 856         temp = temp|((0x05)<<10);
 857         *p_fw_image = temp;
 858         p_fw_image++;
 859
 860         /*write data byte 1;*/
 861         temp = 0x82|MCI_MEMORY_DATA_BYTE1|(value&0x0000FF00);
 862         temp = temp<<10;
 863         *p_fw_image = temp;
 864         p_fw_image++;
 865         temp = temp|((0x05)<<10);
 866         *p_fw_image = temp;
 867         p_fw_image++;
 868
 869         /*write data byte 2;*/
 870         temp = 0x82|MCI_MEMORY_DATA_BYTE2|((value&0x00FF0000)>>8);
 871         temp = temp<<10;
 872         *p_fw_image = temp;
 873         p_fw_image++;
 874         temp = temp|((0x05)<<10);
 875         *p_fw_image = temp;
 876         p_fw_image++;
 877
 878         /*write data byte 3;*/
 879         temp = 0x82|MCI_MEMORY_DATA_BYTE3|((value&0xFF000000)>>16);
 880         temp = temp<<10;
 881         *p_fw_image = temp;
 882         p_fw_image++;
 883         temp = temp|((0x05)<<10);
 884         *p_fw_image = temp;
 885         p_fw_image++;
 886
 887         /* write address byte 2;*/
 888         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE2 | MCI_MODE_MEMORY_WRITE |
 889                 ((address & 0x003F0000)>>8);
 890         temp = temp<<10;
 891         *p_fw_image = temp;
 892         p_fw_image++;
 893         temp = temp|((0x05)<<10);
 894         *p_fw_image = temp;
 895         p_fw_image++;
 896
 897         /* write address byte 1;*/
 898         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE1 | (address & 0xFF00);
 899         temp = temp<<10;
 900         *p_fw_image = temp;
 901         p_fw_image++;
 902         temp = temp|((0x05)<<10);
 903         *p_fw_image = temp;
 904         p_fw_image++;
 905
 906         /* write address byte 0;*/
 907         temp = 0x82|MCI_MEMORY_ADDRESS_BYTE0|((address & 0x00FF)<<8);
 908         temp = temp<<10;
 909         *p_fw_image = temp;
 910         p_fw_image++;
 911         temp = temp|((0x05)<<10);
 912         *p_fw_image = temp;
 913         p_fw_image++;
 914
 915         for (i = 0; i < 6; i++) {
 916                 *p_fw_image = 0xFFFFFFFF;
 917                 p_fw_image++;
 918         }
 919 }
 920
 921
 922 static int cx231xx_load_firmware(struct cx231xx *dev)
 923 {
 924         static const unsigned char magic[8] = {
 925                 0xa7, 0x0d, 0x00, 0x00, 0x66, 0xbb, 0x55, 0xaa
 926         };
 927         const struct firmware *firmware;
 928         int i, retval = 0;
 929         u32 value = 0;
 930         u32 gpio_output = 0;
 931         /*u32 checksum = 0;*/
 932         /*u32 *dataptr;*/
 933         u32 transfer_size = 0;
 934         u32 fw_data = 0;
 935         u32 address = 0;
 936         /*u32 current_fw[800];*/
 937         u32 *p_current_fw, *p_fw;
 938         u32 *p_fw_data;
 939         int frame = 0;
 940         u16 _buffer_size = 4096;
 941         u8 *p_buffer;
 942
 943         p_current_fw = vmalloc(1884180 * 4);
 944         p_fw = p_current_fw;
 945         if (p_current_fw == NULL) {
 946                 dprintk(2, "FAIL!!!\n");
 947                 return -1;
 948         }
 949
 950         p_buffer = vmalloc(4096);
 951         if (p_buffer == NULL) {
 952                 dprintk(2, "FAIL!!!\n");
 953                 return -1;
 954         }
 955
 956         dprintk(2, "%s()\n", __func__);
 957
 958         /* Save GPIO settings before reset of APU */
 959         retval |= mc417_memory_read(dev, 0x9020, &gpio_output);
 960         retval |= mc417_memory_read(dev, 0x900C, &value);
 961
 962         retval  = mc417_register_write(dev,
 963                 IVTV_REG_VPU, 0xFFFFFFED);
 964         retval |= mc417_register_write(dev,
 965                 IVTV_REG_HW_BLOCKS, IVTV_CMD_HW_BLOCKS_RST);
 966         retval |= mc417_register_write(dev,
 967                 IVTV_REG_ENC_SDRAM_REFRESH, 0x80000800);
 968         retval |= mc417_register_write(dev,
 969                 IVTV_REG_ENC_SDRAM_PRECHARGE, 0x1A);
 970         retval |= mc417_register_write(dev,
 971                 IVTV_REG_APU, 0);
 972
 973         if (retval != 0) {
 974                 printk(KERN_ERR "%s: Error with mc417_register_write\n",
 975                         __func__);
 976                 return -1;
 977         }
 978
 979         retval = request_firmware(&firmware, CX231xx_FIRM_IMAGE_NAME,
 980                                   &dev->udev->dev);
 981
 982         if (retval != 0) {
 983                 printk(KERN_ERR
 984                         "ERROR: Hotplug firmware request failed (%s).\n",
 985                         CX231xx_FIRM_IMAGE_NAME);
 986                 printk(KERN_ERR "Please fix your hotplug setup, the board will "
 987                         "not work without firmware loaded!\n");
 988                 return -1;
 989         }
 990
 991         if (firmware->size != CX231xx_FIRM_IMAGE_SIZE) {
 992                 printk(KERN_ERR "ERROR: Firmware size mismatch "
 993                         "(have %zd, expected %d)\n",
 994                         firmware->size, CX231xx_FIRM_IMAGE_SIZE);
 995                 release_firmware(firmware);
 996                 return -1;
 997         }
 998
 999         if (0 != memcmp(firmware->data, magic, 8)) {
1000                 printk(KERN_ERR
1001                         "ERROR: Firmware magic mismatch, wrong file?\n");
1002                 release_firmware(firmware);
1003                 return -1;
1004         }
1005
1006         initGPIO(dev);
1007
1008         /* transfer to the chip */
1009         dprintk(2, "Loading firmware to GPIO...\n");
1010         p_fw_data = (u32 *)firmware->data;
1011         dprintk(2, "firmware->size=%zd\n", firmware->size);
1012         for (transfer_size = 0; transfer_size < firmware->size;
1013                  transfer_size += 4) {
1014                 fw_data = *p_fw_data;
1015
1016                  mciWriteMemoryToGPIO(dev, address, fw_data, p_current_fw);
1017                 address = address + 1;
1018                 p_current_fw += 20;
1019                 p_fw_data += 1;
1020         }
1021
1022         /*download the firmware by ep5-out*/
1023
1024         for (frame = 0; frame < (int)(CX231xx_FIRM_IMAGE_SIZE*20/_buffer_size);
1025              frame++) {
1026                 for (i = 0; i < _buffer_size; i++) {
1027                         *(p_buffer + i) = (u8)(*(p_fw + (frame * 128 * 8 + (i / 4))) & 0x000000FF);
1028                         i++;
1029                         *(p_buffer + i) = (u8)((*(p_fw + (frame * 128 * 8 + (i / 4))) & 0x0000FF00) >> 8);
1030                         i++;
1031                         *(p_buffer + i) = (u8)((*(p_fw + (frame * 128 * 8 + (i / 4))) & 0x00FF0000) >> 16);
1032                         i++;
1033                         *(p_buffer + i) = (u8)((*(p_fw + (frame * 128 * 8 + (i / 4))) & 0xFF000000) >> 24);
1034                 }
1035                 cx231xx_ep5_bulkout(dev, p_buffer, _buffer_size);
1036         }
1037
1038         p_current_fw = p_fw;
1039         vfree(p_current_fw);
1040         p_current_fw = NULL;
1041         uninitGPIO(dev);
1042         release_firmware(firmware);
1043         dprintk(1, "Firmware upload successful.\n");
1044
1045         retval |= mc417_register_write(dev, IVTV_REG_HW_BLOCKS,
1046                 IVTV_CMD_HW_BLOCKS_RST);
1047         if (retval < 0) {
1048                 printk(KERN_ERR "%s: Error with mc417_register_write\n",
1049                         __func__);
1050                 return retval;
1051         }
1052         /* F/W power up disturbs the GPIOs, restore state */
1053         retval |= mc417_register_write(dev, 0x9020, gpio_output);
1054         retval |= mc417_register_write(dev, 0x900C, value);
1055
1056         retval |= mc417_register_read(dev, IVTV_REG_VPU, &value);
1057         retval |= mc417_register_write(dev, IVTV_REG_VPU, value & 0xFFFFFFE8);
1058
1059         if (retval < 0) {
1060                 printk(KERN_ERR "%s: Error with mc417_register_write\n",
1061                         __func__);
1062                 return retval;
1063         }
1064         return 0;
1065 }
1066
1067 static void cx231xx_417_check_encoder(struct cx231xx *dev)
1068 {
1069         u32 status, seq;
1070
1071         status = 0;
1072         seq = 0;
1073         cx231xx_api_cmd(dev, CX2341X_ENC_GET_SEQ_END, 0, 2, &status, &seq);
1074         dprintk(1, "%s() status = %d, seq = %d\n", __func__, status, seq);
1075 }
1076
1077 static void cx231xx_codec_settings(struct cx231xx *dev)
1078 {
1079         dprintk(1, "%s()\n", __func__);
1080
1081         /* assign frame size */
1082         cx231xx_api_cmd(dev, CX2341X_ENC_SET_FRAME_SIZE, 2, 0,
1083                                 dev->ts1.height, dev->ts1.width);
1084
1085         dev->mpeg_params.width = dev->ts1.width;
1086         dev->mpeg_params.height = dev->ts1.height;
1087
1088         cx2341x_update(dev, cx231xx_mbox_func, NULL, &dev->mpeg_params);
1089
1090         cx231xx_api_cmd(dev, CX2341X_ENC_MISC, 2, 0, 3, 1);
1091         cx231xx_api_cmd(dev, CX2341X_ENC_MISC, 2, 0, 4, 1);
1092 }
1093
1094 static int cx231xx_initialize_codec(struct cx231xx *dev)
1095 {
1096         int version;
1097         int retval;
1098         u32 i, data[7];
1099         u32 val = 0;
1100
1101         dprintk(1, "%s()\n", __func__);
1102         cx231xx_disable656(dev);
1103         retval = cx231xx_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0); /* ping */
1104         if (retval < 0) {
1105                 dprintk(2, "%s() PING OK\n", __func__);
1106                 retval = cx231xx_load_firmware(dev);
1107                 if (retval < 0) {
1108                         printk(KERN_ERR "%s() f/w load failed\n", __func__);
1109                         return retval;
1110                 }
1111                 retval = cx231xx_find_mailbox(dev);
1112                 if (retval < 0) {
1113                         printk(KERN_ERR "%s() mailbox < 0, error\n",
1114                                 __func__);
1115                         return -1;
1116                 }
1117                 dev->cx23417_mailbox = retval;
1118                 retval = cx231xx_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0);
1119                 if (retval < 0) {
1120                         printk(KERN_ERR
1121                                 "ERROR: cx23417 firmware ping failed!\n");
1122                         return -1;
1123                 }
1124                 retval = cx231xx_api_cmd(dev, CX2341X_ENC_GET_VERSION, 0, 1,
1125                         &version);
1126                 if (retval < 0) {
1127                         printk(KERN_ERR "ERROR: cx23417 firmware get encoder :"
1128                                 "version failed!\n");
1129                         return -1;
1130                 }
1131                 dprintk(1, "cx23417 firmware version is 0x%08x\n", version);
1132                 msleep(200);
1133         }
1134
1135         for (i = 0; i < 1; i++) {
1136                 retval = mc417_register_read(dev, 0x20f8, &val);
1137                 dprintk(3, "***before enable656() VIM Capture Lines =%d ***\n",
1138                                  val);
1139                 if (retval < 0)
1140                         return retval;
1141         }
1142
1143         cx231xx_enable656(dev);
1144                         /* stop mpeg capture */
1145                         cx231xx_api_cmd(dev, CX2341X_ENC_STOP_CAPTURE,
1146                                  3, 0, 1, 3, 4);
1147
1148         cx231xx_codec_settings(dev);
1149         msleep(60);
1150
1151 /*      cx231xx_api_cmd(dev, CX2341X_ENC_SET_NUM_VSYNC_LINES, 2, 0,
1152                 CX231xx_FIELD1_SAA7115, CX231xx_FIELD2_SAA7115);
1153         cx231xx_api_cmd(dev, CX2341X_ENC_SET_PLACEHOLDER, 12, 0,
1154                 CX231xx_CUSTOM_EXTENSION_USR_DATA, 0, 0, 0, 0, 0, 0, 0, 0, 0,
1155                 0, 0);
1156 */
1157         /* Setup to capture VBI */
1158         data[0] = 0x0001BD00;
1159         data[1] = 1;          /* frames per interrupt */
1160         data[2] = 4;          /* total bufs */
1161         data[3] = 0x91559155; /* start codes */
1162         data[4] = 0x206080C0; /* stop codes */
1163         data[5] = 6;          /* lines */
1164         data[6] = 64;         /* BPL */
1165 /*
1166         cx231xx_api_cmd(dev, CX2341X_ENC_SET_VBI_CONFIG, 7, 0, data[0], data[1],
1167                 data[2], data[3], data[4], data[5], data[6]);
1168
1169         for (i = 2; i <= 24; i++) {
1170                 int valid;
1171
1172                 valid = ((i >= 19) && (i <= 21));
1173                 cx231xx_api_cmd(dev, CX2341X_ENC_SET_VBI_LINE, 5, 0, i,
1174                                 valid, 0 , 0, 0);
1175                 cx231xx_api_cmd(dev, CX2341X_ENC_SET_VBI_LINE, 5, 0,
1176                                 i | 0x80000000, valid, 0, 0, 0);
1177         }
1178 */
1179 /*      cx231xx_api_cmd(dev, CX2341X_ENC_MUTE_AUDIO, 1, 0, CX231xx_UNMUTE);
1180         msleep(60);
1181 */
1182         /* initialize the video input */
1183         retval = cx231xx_api_cmd(dev, CX2341X_ENC_INITIALIZE_INPUT, 0, 0);
1184         if (retval < 0)
1185                 return retval;
1186         msleep(60);
1187
1188         /* Enable VIP style pixel invalidation so we work with scaled mode */
1189         mc417_memory_write(dev, 2120, 0x00000080);
1190
1191         /* start capturing to the host interface */
1192         retval = cx231xx_api_cmd(dev, CX2341X_ENC_START_CAPTURE, 2, 0,
1193                 CX231xx_MPEG_CAPTURE, CX231xx_RAW_BITS_NONE);
1194         if (retval < 0)
1195                 return retval;
1196         msleep(10);
1197
1198         for (i = 0; i < 1; i++) {
1199                 mc417_register_read(dev, 0x20f8, &val);
1200         dprintk(3, "***VIM Capture Lines =%d ***\n", val);
1201         }
1202
1203         return 0;
1204 }
1205
1206 /* ------------------------------------------------------------------ */
1207
1208 static int bb_buf_setup(struct videobuf_queue *q,
1209         unsigned int *count, unsigned int *size)
1210 {
1211         struct cx231xx_fh *fh = q->priv_data;
1212
1213         fh->dev->ts1.ts_packet_size  = mpeglinesize;
1214         fh->dev->ts1.ts_packet_count = mpeglines;
1215
1216         *size = fh->dev->ts1.ts_packet_size * fh->dev->ts1.ts_packet_count;
1217         *count = mpegbufs;
1218
1219         return 0;
1220 }
1221 static void free_buffer(struct videobuf_queue *vq, struct cx231xx_buffer *buf)
1222 {
1223         struct cx231xx_fh *fh = vq->priv_data;
1224         struct cx231xx *dev = fh->dev;
1225         unsigned long flags = 0;
1226
1227         if (in_interrupt())
1228                 BUG();
1229
1230         spin_lock_irqsave(&dev->video_mode.slock, flags);
1231         if (dev->USE_ISO) {
1232                 if (dev->video_mode.isoc_ctl.buf == buf)
1233                         dev->video_mode.isoc_ctl.buf = NULL;
1234         } else {
1235                 if (dev->video_mode.bulk_ctl.buf == buf)
1236                         dev->video_mode.bulk_ctl.buf = NULL;
1237         }
1238         spin_unlock_irqrestore(&dev->video_mode.slock, flags);
1239         videobuf_waiton(vq, &buf->vb, 0, 0);
1240         videobuf_vmalloc_free(&buf->vb);
1241         buf->vb.state = VIDEOBUF_NEEDS_INIT;
1242 }
1243
1244 static void buffer_copy(struct cx231xx *dev, char *data, int len, struct urb *urb,
1245                 struct cx231xx_dmaqueue *dma_q)
1246 {
1247                 void *vbuf;
1248                 struct cx231xx_buffer *buf;
1249                 u32 tail_data = 0;
1250                 char *p_data;
1251
1252                 if (dma_q->mpeg_buffer_done == 0) {
1253                         if (list_empty(&dma_q->active))
1254                                 return;
1255
1256                         buf = list_entry(dma_q->active.next,
1257                                         struct cx231xx_buffer, vb.queue);
1258                         dev->video_mode.isoc_ctl.buf = buf;
1259                         dma_q->mpeg_buffer_done = 1;
1260                 }
1261                 /* Fill buffer */
1262                 buf = dev->video_mode.isoc_ctl.buf;
1263                 vbuf = videobuf_to_vmalloc(&buf->vb);
1264
1265                 if ((dma_q->mpeg_buffer_completed+len) <
1266                    mpeglines*mpeglinesize) {
1267                         if (dma_q->add_ps_package_head ==
1268                            CX231XX_NEED_ADD_PS_PACKAGE_HEAD) {
1269                                 memcpy(vbuf+dma_q->mpeg_buffer_completed,
1270                                        dma_q->ps_head, 3);
1271                                 dma_q->mpeg_buffer_completed =
1272                                   dma_q->mpeg_buffer_completed + 3;
1273                                 dma_q->add_ps_package_head =
1274                                   CX231XX_NONEED_PS_PACKAGE_HEAD;
1275                         }
1276                         memcpy(vbuf+dma_q->mpeg_buffer_completed, data, len);
1277                         dma_q->mpeg_buffer_completed =
1278                           dma_q->mpeg_buffer_completed + len;
1279                 } else {
1280                         dma_q->mpeg_buffer_done = 0;
1281
1282                         tail_data =
1283                           mpeglines*mpeglinesize - dma_q->mpeg_buffer_completed;
1284                         memcpy(vbuf+dma_q->mpeg_buffer_completed,
1285                                data, tail_data);
1286
1287                         buf->vb.state = VIDEOBUF_DONE;
1288                         buf->vb.field_count++;
1289                         do_gettimeofday(&buf->vb.ts);
1290                         list_del(&buf->vb.queue);
1291                         wake_up(&buf->vb.done);
1292                         dma_q->mpeg_buffer_completed = 0;
1293
1294                         if (len - tail_data > 0) {
1295                                 p_data = data + tail_data;
1296                                 dma_q->left_data_count = len - tail_data;
1297                                 memcpy(dma_q->p_left_data,
1298                                        p_data, len - tail_data);
1299                         }
1300
1301                 }
1302
1303             return;
1304 }
1305
1306 static void buffer_filled(char *data, int len, struct urb *urb,
1307                 struct cx231xx_dmaqueue *dma_q)
1308 {
1309                 void *vbuf;
1310                 struct cx231xx_buffer *buf;
1311
1312                 if (list_empty(&dma_q->active))
1313                         return;
1314
1315
1316                 buf = list_entry(dma_q->active.next,
1317                                  struct cx231xx_buffer, vb.queue);
1318
1319
1320                 /* Fill buffer */
1321                 vbuf = videobuf_to_vmalloc(&buf->vb);
1322                 memcpy(vbuf, data, len);
1323                 buf->vb.state = VIDEOBUF_DONE;
1324                 buf->vb.field_count++;
1325                 do_gettimeofday(&buf->vb.ts);
1326                 list_del(&buf->vb.queue);
1327                 wake_up(&buf->vb.done);
1328
1329             return;
1330 }
1331 static inline int cx231xx_isoc_copy(struct cx231xx *dev, struct urb *urb)
1332 {
1333         struct cx231xx_dmaqueue *dma_q = urb->context;
1334         unsigned char *p_buffer;
1335         u32 buffer_size = 0;
1336         u32 i = 0;
1337
1338         for (i = 0; i < urb->number_of_packets; i++) {
1339                 if (dma_q->left_data_count > 0) {
1340                         buffer_copy(dev, dma_q->p_left_data,
1341                                     dma_q->left_data_count, urb, dma_q);
1342                         dma_q->mpeg_buffer_completed = dma_q->left_data_count;
1343                         dma_q->left_data_count = 0;
1344                 }
1345
1346                 p_buffer = urb->transfer_buffer +
1347                                 urb->iso_frame_desc[i].offset;
1348                 buffer_size = urb->iso_frame_desc[i].actual_length;
1349
1350                 if (buffer_size > 0)
1351                         buffer_copy(dev, p_buffer, buffer_size, urb, dma_q);
1352         }
1353
1354         return 0;
1355 }
1356 static inline int cx231xx_bulk_copy(struct cx231xx *dev, struct urb *urb)
1357 {
1358
1359         /*char *outp;*/
1360         /*struct cx231xx_buffer *buf;*/
1361         struct cx231xx_dmaqueue *dma_q = urb->context;
1362         unsigned char *p_buffer, *buffer;
1363         u32 buffer_size = 0;
1364
1365         p_buffer = urb->transfer_buffer;
1366         buffer_size = urb->actual_length;
1367
1368         buffer = kmalloc(buffer_size, GFP_ATOMIC);
1369
1370         memcpy(buffer, dma_q->ps_head, 3);
1371         memcpy(buffer+3, p_buffer, buffer_size-3);
1372         memcpy(dma_q->ps_head, p_buffer+buffer_size-3, 3);
1373
1374         p_buffer = buffer;
1375         buffer_filled(p_buffer, buffer_size, urb, dma_q);
1376
1377         kfree(buffer);
1378         return 0;
1379 }
1380
1381 static int bb_buf_prepare(struct videobuf_queue *q,
1382         struct videobuf_buffer *vb, enum v4l2_field field)
1383 {
1384         struct cx231xx_fh *fh = q->priv_data;
1385         struct cx231xx_buffer *buf =
1386             container_of(vb, struct cx231xx_buffer, vb);
1387         struct cx231xx *dev = fh->dev;
1388         int rc = 0, urb_init = 0;
1389         int size = fh->dev->ts1.ts_packet_size * fh->dev->ts1.ts_packet_count;
1390
1391         dma_qq = &dev->video_mode.vidq;
1392
1393         if (0 != buf->vb.baddr  &&  buf->vb.bsize < size)
1394                 return -EINVAL;
1395         buf->vb.width = fh->dev->ts1.ts_packet_size;
1396         buf->vb.height = fh->dev->ts1.ts_packet_count;
1397         buf->vb.size = size;
1398         buf->vb.field = field;
1399
1400         if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {
1401                 rc = videobuf_iolock(q, &buf->vb, NULL);
1402                 if (rc < 0)
1403                         goto fail;
1404         }
1405
1406         if (dev->USE_ISO) {
1407                 if (!dev->video_mode.isoc_ctl.num_bufs)
1408                         urb_init = 1;
1409         } else {
1410                 if (!dev->video_mode.bulk_ctl.num_bufs)
1411                         urb_init = 1;
1412         }
1413         /*cx231xx_info("urb_init=%d dev->video_mode.max_pkt_size=%d\n",
1414                 urb_init, dev->video_mode.max_pkt_size);*/
1415         dev->mode_tv = 1;
1416
1417         if (urb_init) {
1418                 rc = cx231xx_set_mode(dev, CX231XX_DIGITAL_MODE);
1419                 rc = cx231xx_unmute_audio(dev);
1420                 if (dev->USE_ISO) {
1421                         cx231xx_set_alt_setting(dev, INDEX_TS1, 4);
1422                         rc = cx231xx_init_isoc(dev, mpeglines,
1423                                        mpegbufs,
1424                                        dev->ts1_mode.max_pkt_size,
1425                                        cx231xx_isoc_copy);
1426                 } else {
1427                         cx231xx_set_alt_setting(dev, INDEX_TS1, 0);
1428                         rc = cx231xx_init_bulk(dev, mpeglines,
1429                                        mpegbufs,
1430                                        dev->ts1_mode.max_pkt_size,
1431                                        cx231xx_bulk_copy);
1432                 }
1433                 if (rc < 0)
1434                         goto fail;
1435         }
1436
1437         buf->vb.state = VIDEOBUF_PREPARED;
1438         return 0;
1439
1440 fail:
1441         free_buffer(q, buf);
1442         return rc;
1443 }
1444
1445 static void bb_buf_queue(struct videobuf_queue *q,
1446         struct videobuf_buffer *vb)
1447 {
1448         struct cx231xx_fh *fh = q->priv_data;
1449
1450         struct cx231xx_buffer *buf =
1451             container_of(vb, struct cx231xx_buffer, vb);
1452         struct cx231xx *dev = fh->dev;
1453         struct cx231xx_dmaqueue *vidq = &dev->video_mode.vidq;
1454
1455         buf->vb.state = VIDEOBUF_QUEUED;
1456         list_add_tail(&buf->vb.queue, &vidq->active);
1457
1458 }
1459
1460 static void bb_buf_release(struct videobuf_queue *q,
1461         struct videobuf_buffer *vb)
1462 {
1463         struct cx231xx_buffer *buf =
1464             container_of(vb, struct cx231xx_buffer, vb);
1465         /*struct cx231xx_fh *fh = q->priv_data;*/
1466         /*struct cx231xx *dev = (struct cx231xx *)fh->dev;*/
1467
1468         free_buffer(q, buf);
1469 }
1470
1471 static struct videobuf_queue_ops cx231xx_qops = {
1472         .buf_setup    = bb_buf_setup,
1473         .buf_prepare  = bb_buf_prepare,
1474         .buf_queue    = bb_buf_queue,
1475         .buf_release  = bb_buf_release,
1476 };
1477
1478 /* ------------------------------------------------------------------ */
1479
1480 static const u32 *ctrl_classes[] = {
1481         cx2341x_mpeg_ctrls,
1482         NULL
1483 };
1484
1485 static int cx231xx_queryctrl(struct cx231xx *dev,
1486         struct v4l2_queryctrl *qctrl)
1487 {
1488         qctrl->id = v4l2_ctrl_next(ctrl_classes, qctrl->id);
1489         if (qctrl->id == 0)
1490                 return -EINVAL;
1491
1492         /* MPEG V4L2 controls */
1493         if (cx2341x_ctrl_query(&dev->mpeg_params, qctrl))
1494                 qctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
1495
1496         return 0;
1497 }
1498
1499 static int cx231xx_querymenu(struct cx231xx *dev,
1500         struct v4l2_querymenu *qmenu)
1501 {
1502         struct v4l2_queryctrl qctrl;
1503
1504         qctrl.id = qmenu->id;
1505         cx231xx_queryctrl(dev, &qctrl);
1506         return v4l2_ctrl_query_menu(qmenu, &qctrl,
1507                 cx2341x_ctrl_get_menu(&dev->mpeg_params, qmenu->id));
1508 }
1509
1510 static int vidioc_g_std(struct file *file, void *fh0, v4l2_std_id *norm)
1511 {
1512         struct cx231xx_fh  *fh  = file->private_data;
1513         struct cx231xx *dev = fh->dev;
1514
1515         *norm = dev->encodernorm.id;
1516         return 0;
1517 }
1518 static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *id)
1519 {
1520         struct cx231xx_fh  *fh  = file->private_data;
1521         struct cx231xx *dev = fh->dev;
1522         unsigned int i;
1523
1524         for (i = 0; i < ARRAY_SIZE(cx231xx_tvnorms); i++)
1525                 if (*id & cx231xx_tvnorms[i].id)
1526                         break;
1527         if (i == ARRAY_SIZE(cx231xx_tvnorms))
1528                 return -EINVAL;
1529         dev->encodernorm = cx231xx_tvnorms[i];
1530
1531         if (dev->encodernorm.id & 0xb000) {
1532                 dprintk(3, "encodernorm set to NTSC\n");
1533                 dev->norm = V4L2_STD_NTSC;
1534                 dev->ts1.height = 480;
1535                 dev->mpeg_params.is_50hz = 0;
1536         } else {
1537                 dprintk(3, "encodernorm set to PAL\n");
1538                 dev->norm = V4L2_STD_PAL_B;
1539                 dev->ts1.height = 576;
1540                 dev->mpeg_params.is_50hz = 1;
1541         }
1542         call_all(dev, core, s_std, dev->norm);
1543         /* do mode control overrides */
1544         cx231xx_do_mode_ctrl_overrides(dev);
1545
1546         dprintk(3, "exit vidioc_s_std() i=0x%x\n", i);
1547         return 0;
1548 }
1549 static int vidioc_g_audio(struct file *file, void *fh,
1550                                         struct v4l2_audio *a)
1551 {
1552                 struct v4l2_audio *vin = a;
1553
1554                 int ret = -EINVAL;
1555                 if (vin->index > 0)
1556                         return ret;
1557                 strncpy(vin->name, "VideoGrabber Audio", 14);
1558                 vin->capability = V4L2_AUDCAP_STEREO;
1559 return 0;
1560 }
1561 static int vidioc_enumaudio(struct file *file, void *fh,
1562                                         struct v4l2_audio *a)
1563 {
1564                 struct v4l2_audio *vin = a;
1565
1566                 int ret = -EINVAL;
1567
1568                 if (vin->index > 0)
1569                         return ret;
1570                 strncpy(vin->name, "VideoGrabber Audio", 14);
1571                 vin->capability = V4L2_AUDCAP_STEREO;
1572
1573
1574 return 0;
1575 }
1576 static const char *iname[] = {
1577         [CX231XX_VMUX_COMPOSITE1] = "Composite1",
1578         [CX231XX_VMUX_SVIDEO]     = "S-Video",
1579         [CX231XX_VMUX_TELEVISION] = "Television",
1580         [CX231XX_VMUX_CABLE]      = "Cable TV",
1581         [CX231XX_VMUX_DVB]        = "DVB",
1582         [CX231XX_VMUX_DEBUG]      = "for debug only",
1583 };
1584 static int vidioc_enum_input(struct file *file, void *priv,
1585                                 struct v4l2_input *i)
1586 {
1587         struct cx231xx_fh  *fh  = file->private_data;
1588         struct cx231xx *dev = fh->dev;
1589         struct cx231xx_input *input;
1590         int n;
1591         dprintk(3, "enter vidioc_enum_input()i->index=%d\n", i->index);
1592
1593         if (i->index >= 4)
1594                 return -EINVAL;
1595
1596
1597         input = &cx231xx_boards[dev->model].input[i->index];
1598
1599         if (input->type == 0)
1600                 return -EINVAL;
1601
1602         /* FIXME
1603          * strcpy(i->name, input->name); */
1604
1605         n = i->index;
1606         strcpy(i->name, iname[INPUT(n)->type]);
1607
1608         if (input->type == CX231XX_VMUX_TELEVISION ||
1609             input->type == CX231XX_VMUX_CABLE)
1610                 i->type = V4L2_INPUT_TYPE_TUNER;
1611         else
1612                 i->type  = V4L2_INPUT_TYPE_CAMERA;
1613
1614
1615         return 0;
1616 }
1617
1618 static int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
1619 {
1620         *i = 0;
1621         return  0;
1622 }
1623
1624 static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
1625 {
1626         struct cx231xx_fh  *fh  = file->private_data;
1627         struct cx231xx *dev = fh->dev;
1628
1629         dprintk(3, "enter vidioc_s_input() i=%d\n", i);
1630
1631         mutex_lock(&dev->lock);
1632
1633         video_mux(dev, i);
1634
1635         mutex_unlock(&dev->lock);
1636
1637         if (i >= 4)
1638                 return -EINVAL;
1639         dev->input = i;
1640         dprintk(3, "exit vidioc_s_input()\n");
1641         return 0;
1642 }
1643
1644 static int vidioc_g_tuner(struct file *file, void *priv,
1645                                 struct v4l2_tuner *t)
1646 {
1647         return 0;
1648 }
1649
1650 static int vidioc_s_tuner(struct file *file, void *priv,
1651                                 struct v4l2_tuner *t)
1652 {
1653         return 0;
1654 }
1655
1656 static int vidioc_g_frequency(struct file *file, void *priv,
1657                                 struct v4l2_frequency *f)
1658 {
1659         return 0;
1660 }
1661
1662 static int vidioc_s_frequency(struct file *file, void *priv,
1663                                 struct v4l2_frequency *f)
1664 {
1665
1666
1667         return 0;
1668 }
1669
1670 static int vidioc_s_ctrl(struct file *file, void *priv,
1671                                 struct v4l2_control *ctl)
1672 {
1673         struct cx231xx_fh  *fh  = file->private_data;
1674         struct cx231xx *dev = fh->dev;
1675         dprintk(3, "enter vidioc_s_ctrl()\n");
1676         /* Update the A/V core */
1677         call_all(dev, core, s_ctrl, ctl);
1678         dprintk(3, "exit vidioc_s_ctrl()\n");
1679         return 0;
1680 }
1681 static struct v4l2_capability pvr_capability = {
1682         .driver         = "cx231xx",
1683         .card           = "VideoGrabber",
1684         .bus_info       = "usb",
1685         .version        = 1,
1686         .capabilities   = (V4L2_CAP_VIDEO_CAPTURE |
1687                            V4L2_CAP_TUNER | V4L2_CAP_AUDIO | V4L2_CAP_RADIO |
1688                          V4L2_CAP_STREAMING | V4L2_CAP_READWRITE),
1689         .reserved       = {0, 0, 0, 0}
1690 };
1691 static int vidioc_querycap(struct file *file, void  *priv,
1692                                 struct v4l2_capability *cap)
1693 {
1694
1695
1696
1697                 memcpy(cap, &pvr_capability, sizeof(struct v4l2_capability));
1698         return 0;
1699 }
1700
1701 static int vidioc_enum_fmt_vid_cap(struct file *file, void  *priv,
1702                                         struct v4l2_fmtdesc *f)
1703 {
1704
1705         if (f->index != 0)
1706                 return -EINVAL;
1707
1708         strlcpy(f->description, "MPEG", sizeof(f->description));
1709         f->pixelformat = V4L2_PIX_FMT_MPEG;
1710
1711         return 0;
1712 }
1713
1714 static int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
1715                                 struct v4l2_format *f)
1716 {
1717         struct cx231xx_fh  *fh  = file->private_data;
1718         struct cx231xx *dev = fh->dev;
1719         dprintk(3, "enter vidioc_g_fmt_vid_cap()\n");
1720         f->fmt.pix.pixelformat  = V4L2_PIX_FMT_MPEG;
1721         f->fmt.pix.bytesperline = 0;
1722         f->fmt.pix.sizeimage    =
1723                 dev->ts1.ts_packet_size * dev->ts1.ts_packet_count;
1724         f->fmt.pix.colorspace   = 0;
1725         f->fmt.pix.width        = dev->ts1.width;
1726         f->fmt.pix.height       = dev->ts1.height;
1727         f->fmt.pix.field        = fh->vidq.field;
1728         dprintk(1, "VIDIOC_G_FMT: w: %d, h: %d, f: %d\n",
1729                 dev->ts1.width, dev->ts1.height, fh->vidq.field);
1730         dprintk(3, "exit vidioc_g_fmt_vid_cap()\n");
1731         return 0;
1732 }
1733
1734 static int vidioc_try_fmt_vid_cap(struct file *file, void *priv,
1735                                 struct v4l2_format *f)
1736 {
1737         struct cx231xx_fh  *fh  = file->private_data;
1738         struct cx231xx *dev = fh->dev;
1739         dprintk(3, "enter vidioc_try_fmt_vid_cap()\n");
1740         f->fmt.pix.pixelformat  = V4L2_PIX_FMT_MPEG;
1741         f->fmt.pix.bytesperline = 0;
1742         f->fmt.pix.sizeimage    =
1743                 dev->ts1.ts_packet_size * dev->ts1.ts_packet_count;
1744         f->fmt.pix.colorspace   = 0;
1745         dprintk(1, "VIDIOC_TRY_FMT: w: %d, h: %d, f: %d\n",
1746                 dev->ts1.width, dev->ts1.height, fh->vidq.field);
1747         dprintk(3, "exit vidioc_try_fmt_vid_cap()\n");
1748         return 0;
1749 }
1750
1751 static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
1752                                 struct v4l2_format *f)
1753 {
1754
1755         return 0;
1756 }
1757
1758 static int vidioc_reqbufs(struct file *file, void *priv,
1759                                 struct v4l2_requestbuffers *p)
1760 {
1761         struct cx231xx_fh  *fh  = file->private_data;
1762
1763         return videobuf_reqbufs(&fh->vidq, p);
1764 }
1765
1766 static int vidioc_querybuf(struct file *file, void *priv,
1767                                 struct v4l2_buffer *p)
1768 {
1769         struct cx231xx_fh  *fh  = file->private_data;
1770
1771         return videobuf_querybuf(&fh->vidq, p);
1772 }
1773
1774 static int vidioc_qbuf(struct file *file, void *priv,
1775                                 struct v4l2_buffer *p)
1776 {
1777         struct cx231xx_fh  *fh  = file->private_data;
1778
1779         return videobuf_qbuf(&fh->vidq, p);
1780 }
1781
1782 static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b)
1783 {
1784         struct cx231xx_fh  *fh  = priv;
1785
1786         return videobuf_dqbuf(&fh->vidq, b, file->f_flags & O_NONBLOCK);
1787 }
1788
1789
1790 static int vidioc_streamon(struct file *file, void *priv,
1791                                 enum v4l2_buf_type i)
1792 {
1793         struct cx231xx_fh  *fh  = file->private_data;
1794
1795         struct cx231xx *dev = fh->dev;
1796         int rc = 0;
1797         dprintk(3, "enter vidioc_streamon()\n");
1798                 cx231xx_set_alt_setting(dev, INDEX_TS1, 0);
1799                 rc = cx231xx_set_mode(dev, CX231XX_DIGITAL_MODE);
1800                 if (dev->USE_ISO)
1801                         rc = cx231xx_init_isoc(dev, CX231XX_NUM_PACKETS,
1802                                        CX231XX_NUM_BUFS,
1803                                        dev->video_mode.max_pkt_size,
1804                                        cx231xx_isoc_copy);
1805                 else {
1806                         rc = cx231xx_init_bulk(dev, 320,
1807                                        5,
1808                                        dev->ts1_mode.max_pkt_size,
1809                                        cx231xx_bulk_copy);
1810                 }
1811         dprintk(3, "exit vidioc_streamon()\n");
1812         return videobuf_streamon(&fh->vidq);
1813 }
1814
1815 static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
1816 {
1817         struct cx231xx_fh  *fh  = file->private_data;
1818
1819         return videobuf_streamoff(&fh->vidq);
1820 }
1821
1822 static int vidioc_g_ext_ctrls(struct file *file, void *priv,
1823                                 struct v4l2_ext_controls *f)
1824 {
1825         struct cx231xx_fh  *fh  = priv;
1826         struct cx231xx *dev = fh->dev;
1827         dprintk(3, "enter vidioc_g_ext_ctrls()\n");
1828         if (f->ctrl_class != V4L2_CTRL_CLASS_MPEG)
1829                 return -EINVAL;
1830         dprintk(3, "exit vidioc_g_ext_ctrls()\n");
1831         return cx2341x_ext_ctrls(&dev->mpeg_params, 0, f, VIDIOC_G_EXT_CTRLS);
1832 }
1833
1834 static int vidioc_s_ext_ctrls(struct file *file, void *priv,
1835                                 struct v4l2_ext_controls *f)
1836 {
1837         struct cx231xx_fh  *fh  = priv;
1838         struct cx231xx *dev = fh->dev;
1839         struct cx2341x_mpeg_params p;
1840         int err;
1841         dprintk(3, "enter vidioc_s_ext_ctrls()\n");
1842         if (f->ctrl_class != V4L2_CTRL_CLASS_MPEG)
1843                 return -EINVAL;
1844
1845         p = dev->mpeg_params;
1846         err = cx2341x_ext_ctrls(&p, 0, f, VIDIOC_TRY_EXT_CTRLS);
1847         if (err == 0) {
1848                 err = cx2341x_update(dev, cx231xx_mbox_func,
1849                         &dev->mpeg_params, &p);
1850                 dev->mpeg_params = p;
1851         }
1852
1853         return err;
1854
1855
1856 return 0;
1857 }
1858
1859 static int vidioc_try_ext_ctrls(struct file *file, void *priv,
1860                                 struct v4l2_ext_controls *f)
1861 {
1862         struct cx231xx_fh  *fh  = priv;
1863         struct cx231xx *dev = fh->dev;
1864         struct cx2341x_mpeg_params p;
1865         int err;
1866         dprintk(3, "enter vidioc_try_ext_ctrls()\n");
1867         if (f->ctrl_class != V4L2_CTRL_CLASS_MPEG)
1868                 return -EINVAL;
1869
1870         p = dev->mpeg_params;
1871         err = cx2341x_ext_ctrls(&p, 0, f, VIDIOC_TRY_EXT_CTRLS);
1872         dprintk(3, "exit vidioc_try_ext_ctrls() err=%d\n", err);
1873         return err;
1874 }
1875
1876 static int vidioc_log_status(struct file *file, void *priv)
1877 {
1878         struct cx231xx_fh  *fh  = priv;
1879         struct cx231xx *dev = fh->dev;
1880         char name[32 + 2];
1881
1882         snprintf(name, sizeof(name), "%s/2", dev->name);
1883         dprintk(3,
1884                 "%s/2: ============  START LOG STATUS  ============\n",
1885                dev->name);
1886         call_all(dev, core, log_status);
1887         cx2341x_log_status(&dev->mpeg_params, name);
1888         dprintk(3,
1889                 "%s/2: =============  END LOG STATUS  =============\n",
1890                dev->name);
1891         return 0;
1892 }
1893
1894 static int vidioc_querymenu(struct file *file, void *priv,
1895                                 struct v4l2_querymenu *a)
1896 {
1897         struct cx231xx_fh  *fh  = priv;
1898         struct cx231xx *dev = fh->dev;
1899         dprintk(3, "enter vidioc_querymenu()\n");
1900         dprintk(3, "exit vidioc_querymenu()\n");
1901         return cx231xx_querymenu(dev, a);
1902 }
1903
1904 static int vidioc_queryctrl(struct file *file, void *priv,
1905                                 struct v4l2_queryctrl *c)
1906 {
1907         struct cx231xx_fh  *fh  = priv;
1908         struct cx231xx *dev = fh->dev;
1909         dprintk(3, "enter vidioc_queryctrl()\n");
1910         dprintk(3, "exit vidioc_queryctrl()\n");
1911         return cx231xx_queryctrl(dev, c);
1912 }
1913
1914 static int mpeg_open(struct file *file)
1915 {
1916         int minor = video_devdata(file)->minor;
1917         struct cx231xx *h, *dev = NULL;
1918         /*struct list_head *list;*/
1919         struct cx231xx_fh *fh;
1920         /*u32 value = 0;*/
1921
1922         dprintk(2, "%s()\n", __func__);
1923
1924         list_for_each_entry(h, &cx231xx_devlist, devlist) {
1925                 if (h->v4l_device->minor == minor)
1926                         dev = h;
1927         }
1928
1929         if (dev == NULL)
1930                 return -ENODEV;
1931
1932         mutex_lock(&dev->lock);
1933
1934         /* allocate + initialize per filehandle data */
1935         fh = kzalloc(sizeof(*fh), GFP_KERNEL);
1936         if (NULL == fh) {
1937                 mutex_unlock(&dev->lock);
1938                 return -ENOMEM;
1939         }
1940
1941         file->private_data = fh;
1942         fh->dev      = dev;
1943
1944
1945         videobuf_queue_vmalloc_init(&fh->vidq, &cx231xx_qops,
1946                             NULL, &dev->video_mode.slock,
1947                             V4L2_BUF_TYPE_VIDEO_CAPTURE, V4L2_FIELD_INTERLACED,
1948                             sizeof(struct cx231xx_buffer), fh, NULL);
1949 /*
1950         videobuf_queue_sg_init(&fh->vidq, &cx231xx_qops,
1951                             &dev->udev->dev, &dev->ts1.slock,
1952                             V4L2_BUF_TYPE_VIDEO_CAPTURE,
1953                             V4L2_FIELD_INTERLACED,
1954                             sizeof(struct cx231xx_buffer),
1955                             fh, NULL);
1956 */
1957
1958
1959         cx231xx_set_alt_setting(dev, INDEX_VANC, 1);
1960         cx231xx_set_gpio_value(dev, 2, 0);
1961
1962         cx231xx_initialize_codec(dev);
1963
1964         mutex_unlock(&dev->lock);
1965         cx231xx_start_TS1(dev);
1966
1967         return 0;
1968 }
1969
1970 static int mpeg_release(struct file *file)
1971 {
1972         struct cx231xx_fh  *fh  = file->private_data;
1973         struct cx231xx *dev = fh->dev;
1974
1975         dprintk(3, "mpeg_release()! dev=0x%p\n", dev);
1976
1977         if (!dev) {
1978                 dprintk(3, "abort!!!\n");
1979                 return 0;
1980         }
1981
1982         mutex_lock(&dev->lock);
1983
1984         cx231xx_stop_TS1(dev);
1985
1986                 /* do this before setting alternate! */
1987                 if (dev->USE_ISO)
1988                         cx231xx_uninit_isoc(dev);
1989                 else
1990                         cx231xx_uninit_bulk(dev);
1991                 cx231xx_set_mode(dev, CX231XX_SUSPEND);
1992
1993                 cx231xx_api_cmd(fh->dev, CX2341X_ENC_STOP_CAPTURE, 3, 0,
1994                                 CX231xx_END_NOW, CX231xx_MPEG_CAPTURE,
1995                                 CX231xx_RAW_BITS_NONE);
1996
1997         /* FIXME: Review this crap */
1998         /* Shut device down on last close */
1999         if (atomic_cmpxchg(&fh->v4l_reading, 1, 0) == 1) {
2000                 if (atomic_dec_return(&dev->v4l_reader_count) == 0) {
2001                         /* stop mpeg capture */
2002
2003                         msleep(500);
2004                         cx231xx_417_check_encoder(dev);
2005
2006                 }
2007         }
2008
2009         if (fh->vidq.streaming)
2010                 videobuf_streamoff(&fh->vidq);
2011         if (fh->vidq.reading)
2012                 videobuf_read_stop(&fh->vidq);
2013
2014         videobuf_mmap_free(&fh->vidq);
2015         file->private_data = NULL;
2016         kfree(fh);
2017         mutex_unlock(&dev->lock);
2018         return 0;
2019 }
2020
2021 static ssize_t mpeg_read(struct file *file, char __user *data,
2022         size_t count, loff_t *ppos)
2023 {
2024         struct cx231xx_fh *fh = file->private_data;
2025         struct cx231xx *dev = fh->dev;
2026
2027
2028         /* Deal w/ A/V decoder * and mpeg encoder sync issues. */
2029         /* Start mpeg encoder on first read. */
2030         if (atomic_cmpxchg(&fh->v4l_reading, 0, 1) == 0) {
2031                 if (atomic_inc_return(&dev->v4l_reader_count) == 1) {
2032                         if (cx231xx_initialize_codec(dev) < 0)
2033                                 return -EINVAL;
2034                 }
2035         }
2036
2037         return videobuf_read_stream(&fh->vidq, data, count, ppos, 0,
2038                                     file->f_flags & O_NONBLOCK);
2039 }
2040
2041 static unsigned int mpeg_poll(struct file *file,
2042         struct poll_table_struct *wait)
2043 {
2044         struct cx231xx_fh *fh = file->private_data;
2045         /*struct cx231xx *dev = fh->dev;*/
2046
2047         /*dprintk(2, "%s\n", __func__);*/
2048
2049         return videobuf_poll_stream(file, &fh->vidq, wait);
2050 }
2051
2052 static int mpeg_mmap(struct file *file, struct vm_area_struct *vma)
2053 {
2054         struct cx231xx_fh *fh = file->private_data;
2055         struct cx231xx *dev = fh->dev;
2056
2057         dprintk(2, "%s()\n", __func__);
2058
2059         return videobuf_mmap_mapper(&fh->vidq, vma);
2060 }
2061
2062 static struct v4l2_file_operations mpeg_fops = {
2063         .owner         = THIS_MODULE,
2064         .open          = mpeg_open,
2065         .release       = mpeg_release,
2066         .read          = mpeg_read,
2067         .poll          = mpeg_poll,
2068         .mmap          = mpeg_mmap,
2069         .ioctl         = video_ioctl2,
2070 };
2071
2072 static const struct v4l2_ioctl_ops mpeg_ioctl_ops = {
2073         .vidioc_s_std            = vidioc_s_std,
2074         .vidioc_g_std            = vidioc_g_std,
2075         .vidioc_enum_input       = vidioc_enum_input,
2076         .vidioc_enumaudio        = vidioc_enumaudio,
2077         .vidioc_g_audio          = vidioc_g_audio,
2078         .vidioc_g_input          = vidioc_g_input,
2079         .vidioc_s_input          = vidioc_s_input,
2080         .vidioc_g_tuner          = vidioc_g_tuner,
2081         .vidioc_s_tuner          = vidioc_s_tuner,
2082         .vidioc_g_frequency      = vidioc_g_frequency,
2083         .vidioc_s_frequency      = vidioc_s_frequency,
2084         .vidioc_s_ctrl           = vidioc_s_ctrl,
2085         .vidioc_querycap         = vidioc_querycap,
2086         .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
2087         .vidioc_g_fmt_vid_cap    = vidioc_g_fmt_vid_cap,
2088         .vidioc_try_fmt_vid_cap  = vidioc_try_fmt_vid_cap,
2089         .vidioc_s_fmt_vid_cap    = vidioc_s_fmt_vid_cap,
2090         .vidioc_reqbufs          = vidioc_reqbufs,
2091         .vidioc_querybuf         = vidioc_querybuf,
2092         .vidioc_qbuf             = vidioc_qbuf,
2093         .vidioc_dqbuf            = vidioc_dqbuf,
2094         .vidioc_streamon         = vidioc_streamon,
2095         .vidioc_streamoff        = vidioc_streamoff,
2096         .vidioc_g_ext_ctrls      = vidioc_g_ext_ctrls,
2097         .vidioc_s_ext_ctrls      = vidioc_s_ext_ctrls,
2098         .vidioc_try_ext_ctrls    = vidioc_try_ext_ctrls,
2099         .vidioc_log_status       = vidioc_log_status,
2100         .vidioc_querymenu        = vidioc_querymenu,
2101         .vidioc_queryctrl        = vidioc_queryctrl,
2102 /*      .vidioc_g_chip_ident     = cx231xx_g_chip_ident,*/
2103 #ifdef CONFIG_VIDEO_ADV_DEBUG
2104 /*      .vidioc_g_register       = cx231xx_g_register,*/
2105 /*      .vidioc_s_register       = cx231xx_s_register,*/
2106 #endif
2107 };
2108
2109 static struct video_device cx231xx_mpeg_template = {
2110         .name          = "cx231xx",
2111         .fops          = &mpeg_fops,
2112         .ioctl_ops     = &mpeg_ioctl_ops,
2113         .minor         = -1,
2114         .tvnorms       = CX231xx_NORMS,
2115         .current_norm  = V4L2_STD_NTSC_M,
2116 };
2117
2118 void cx231xx_417_unregister(struct cx231xx *dev)
2119 {
2120         dprintk(1, "%s()\n", __func__);
2121         dprintk(3, "%s()\n", __func__);
2122
2123         if (dev->v4l_device) {
2124                 if (-1 != dev->v4l_device->minor)
2125                         video_unregister_device(dev->v4l_device);
2126                 else
2127                         video_device_release(dev->v4l_device);
2128                 dev->v4l_device = NULL;
2129         }
2130 }
2131
2132 static struct video_device *cx231xx_video_dev_alloc(
2133         struct cx231xx *dev,
2134         struct usb_device *usbdev,
2135         struct video_device *template,
2136         char *type)
2137 {
2138         struct video_device *vfd;
2139
2140         dprintk(1, "%s()\n", __func__);
2141         vfd = video_device_alloc();
2142         if (NULL == vfd)
2143                 return NULL;
2144         *vfd = *template;
2145         vfd->minor = -1;
2146         snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)", dev->name,
2147                 type, cx231xx_boards[dev->model].name);
2148
2149         vfd->v4l2_dev = &dev->v4l2_dev;
2150         vfd->release = video_device_release;
2151
2152         return vfd;
2153
2154 }
2155
2156 int cx231xx_417_register(struct cx231xx *dev)
2157 {
2158         /* FIXME: Port1 hardcoded here */
2159         int err = -ENODEV;
2160         struct cx231xx_tsport *tsport = &dev->ts1;
2161
2162         dprintk(1, "%s()\n", __func__);
2163
2164         /* Set default TV standard */
2165         dev->encodernorm = cx231xx_tvnorms[0];
2166
2167         if (dev->encodernorm.id & V4L2_STD_525_60)
2168                 tsport->height = 480;
2169         else
2170                 tsport->height = 576;
2171
2172         tsport->width = 720;
2173         cx2341x_fill_defaults(&dev->mpeg_params);
2174         dev->norm = V4L2_STD_NTSC;
2175
2176         dev->mpeg_params.port = CX2341X_PORT_SERIAL;
2177
2178         /* Allocate and initialize V4L video device */
2179         dev->v4l_device = cx231xx_video_dev_alloc(dev,
2180                 dev->udev, &cx231xx_mpeg_template, "mpeg");
2181         err = video_register_device(dev->v4l_device,
2182                 VFL_TYPE_GRABBER, -1);
2183         if (err < 0) {
2184                 dprintk(3, "%s: can't register mpeg device\n", dev->name);
2185                 return err;
2186         }
2187
2188         dprintk(3, "%s: registered device video%d [mpeg]\n",
2189                dev->name, dev->v4l_device->num);
2190
2191         return 0;
2192 }