1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 cx231xx-core.c - driver for Conexant Cx23100/101/102 4 USB video capture devices 5 6 Copyright (C) 2008 <srinivasa.deevi at conexant dot com> 7 Based on em28xx driver 8 9 */ 10 11 #include "cx231xx.h" 12 #include <linux/init.h> 13 #include <linux/list.h> 14 #include <linux/module.h> 15 #include <linux/slab.h> 16 #include <linux/vmalloc.h> 17 #include <media/v4l2-common.h> 18 #include <media/tuner.h> 19 20 #include "cx231xx-reg.h" 21 22 /* #define ENABLE_DEBUG_ISOC_FRAMES */ 23 24 static unsigned int core_debug; 25 module_param(core_debug, int, 0644); 26 MODULE_PARM_DESC(core_debug, "enable debug messages [core]"); 27 28 #define cx231xx_coredbg(fmt, arg...) do {\ 29 if (core_debug) \ 30 printk(KERN_INFO "%s %s :"fmt, \ 31 dev->name, __func__ , ##arg); } while (0) 32 33 static unsigned int reg_debug; 34 module_param(reg_debug, int, 0644); 35 MODULE_PARM_DESC(reg_debug, "enable debug messages [URB reg]"); 36 37 static int alt = CX231XX_PINOUT; 38 module_param(alt, int, 0644); 39 MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint"); 40 41 #define cx231xx_isocdbg(fmt, arg...) do {\ 42 if (core_debug) \ 43 printk(KERN_INFO "%s %s :"fmt, \ 44 dev->name, __func__ , ##arg); } while (0) 45 46 /***************************************************************** 47 * Device control list functions * 48 ******************************************************************/ 49 50 LIST_HEAD(cx231xx_devlist); 51 static DEFINE_MUTEX(cx231xx_devlist_mutex); 52 53 /* 54 * cx231xx_realease_resources() 55 * unregisters the v4l2,i2c and usb devices 56 * called when the device gets disconnected or at module unload 57 */ 58 void cx231xx_remove_from_devlist(struct cx231xx *dev) 59 { 60 if (dev == NULL) 61 return; 62 if (dev->udev == NULL) 63 return; 64 65 if (atomic_read(&dev->devlist_count) > 0) { 66 mutex_lock(&cx231xx_devlist_mutex); 67 list_del(&dev->devlist); 68 atomic_dec(&dev->devlist_count); 69 mutex_unlock(&cx231xx_devlist_mutex); 70 } 71 }; 72 73 void cx231xx_add_into_devlist(struct cx231xx *dev) 74 { 75 mutex_lock(&cx231xx_devlist_mutex); 76 list_add_tail(&dev->devlist, &cx231xx_devlist); 77 atomic_inc(&dev->devlist_count); 78 mutex_unlock(&cx231xx_devlist_mutex); 79 }; 80 81 static LIST_HEAD(cx231xx_extension_devlist); 82 83 int cx231xx_register_extension(struct cx231xx_ops *ops) 84 { 85 struct cx231xx *dev = NULL; 86 87 mutex_lock(&cx231xx_devlist_mutex); 88 list_add_tail(&ops->next, &cx231xx_extension_devlist); 89 list_for_each_entry(dev, &cx231xx_devlist, devlist) { 90 ops->init(dev); 91 dev_info(dev->dev, "%s initialized\n", ops->name); 92 } 93 mutex_unlock(&cx231xx_devlist_mutex); 94 return 0; 95 } 96 EXPORT_SYMBOL(cx231xx_register_extension); 97 98 void cx231xx_unregister_extension(struct cx231xx_ops *ops) 99 { 100 struct cx231xx *dev = NULL; 101 102 mutex_lock(&cx231xx_devlist_mutex); 103 list_for_each_entry(dev, &cx231xx_devlist, devlist) { 104 ops->fini(dev); 105 dev_info(dev->dev, "%s removed\n", ops->name); 106 } 107 108 list_del(&ops->next); 109 mutex_unlock(&cx231xx_devlist_mutex); 110 } 111 EXPORT_SYMBOL(cx231xx_unregister_extension); 112 113 void cx231xx_init_extension(struct cx231xx *dev) 114 { 115 struct cx231xx_ops *ops = NULL; 116 117 mutex_lock(&cx231xx_devlist_mutex); 118 list_for_each_entry(ops, &cx231xx_extension_devlist, next) { 119 if (ops->init) 120 ops->init(dev); 121 } 122 mutex_unlock(&cx231xx_devlist_mutex); 123 } 124 125 void cx231xx_close_extension(struct cx231xx *dev) 126 { 127 struct cx231xx_ops *ops = NULL; 128 129 mutex_lock(&cx231xx_devlist_mutex); 130 list_for_each_entry(ops, &cx231xx_extension_devlist, next) { 131 if (ops->fini) 132 ops->fini(dev); 133 } 134 mutex_unlock(&cx231xx_devlist_mutex); 135 } 136 137 /**************************************************************** 138 * U S B related functions * 139 *****************************************************************/ 140 int cx231xx_send_usb_command(struct cx231xx_i2c *i2c_bus, 141 struct cx231xx_i2c_xfer_data *req_data) 142 { 143 int status = 0; 144 struct cx231xx *dev = i2c_bus->dev; 145 struct VENDOR_REQUEST_IN ven_req; 146 147 u8 saddr_len = 0; 148 u8 _i2c_period = 0; 149 u8 _i2c_nostop = 0; 150 u8 _i2c_reserve = 0; 151 152 if (dev->state & DEV_DISCONNECTED) 153 return -ENODEV; 154 155 /* Get the I2C period, nostop and reserve parameters */ 156 _i2c_period = i2c_bus->i2c_period; 157 _i2c_nostop = i2c_bus->i2c_nostop; 158 _i2c_reserve = i2c_bus->i2c_reserve; 159 160 saddr_len = req_data->saddr_len; 161 162 /* Set wValue */ 163 ven_req.wValue = (req_data->dev_addr << 9 | _i2c_period << 4 | 164 saddr_len << 2 | _i2c_nostop << 1 | I2C_SYNC | 165 _i2c_reserve << 6); 166 167 /* set channel number */ 168 if (req_data->direction & I2C_M_RD) { 169 /* channel number, for read,spec required channel_num +4 */ 170 ven_req.bRequest = i2c_bus->nr + 4; 171 } else 172 ven_req.bRequest = i2c_bus->nr; /* channel number, */ 173 174 /* set index value */ 175 switch (saddr_len) { 176 case 0: 177 ven_req.wIndex = 0; /* need check */ 178 break; 179 case 1: 180 ven_req.wIndex = (req_data->saddr_dat & 0xff); 181 break; 182 case 2: 183 ven_req.wIndex = req_data->saddr_dat; 184 break; 185 } 186 187 /* set wLength value */ 188 ven_req.wLength = req_data->buf_size; 189 190 /* set bData value */ 191 ven_req.bData = 0; 192 193 /* set the direction */ 194 if (req_data->direction) { 195 ven_req.direction = USB_DIR_IN; 196 memset(req_data->p_buffer, 0x00, ven_req.wLength); 197 } else 198 ven_req.direction = USB_DIR_OUT; 199 200 /* set the buffer for read / write */ 201 ven_req.pBuff = req_data->p_buffer; 202 203 204 /* call common vendor command request */ 205 status = cx231xx_send_vendor_cmd(dev, &ven_req); 206 if (status < 0 && !dev->i2c_scan_running) { 207 dev_err(dev->dev, "%s: failed with status -%d\n", 208 __func__, status); 209 } 210 211 return status; 212 } 213 EXPORT_SYMBOL_GPL(cx231xx_send_usb_command); 214 215 /* 216 * Sends/Receives URB control messages, assuring to use a kalloced buffer 217 * for all operations (dev->urb_buf), to avoid using stacked buffers, as 218 * they aren't safe for usage with USB, due to DMA restrictions. 219 * Also implements the debug code for control URB's. 220 */ 221 static int __usb_control_msg(struct cx231xx *dev, unsigned int pipe, 222 __u8 request, __u8 requesttype, __u16 value, __u16 index, 223 void *data, __u16 size, int timeout) 224 { 225 int rc, i; 226 227 if (reg_debug) { 228 printk(KERN_DEBUG "%s: (pipe 0x%08x): %s: %02x %02x %02x %02x %02x %02x %02x %02x ", 229 dev->name, 230 pipe, 231 (requesttype & USB_DIR_IN) ? "IN" : "OUT", 232 requesttype, 233 request, 234 value & 0xff, value >> 8, 235 index & 0xff, index >> 8, 236 size & 0xff, size >> 8); 237 if (!(requesttype & USB_DIR_IN)) { 238 printk(KERN_CONT ">>>"); 239 for (i = 0; i < size; i++) 240 printk(KERN_CONT " %02x", 241 ((unsigned char *)data)[i]); 242 } 243 } 244 245 /* Do the real call to usb_control_msg */ 246 mutex_lock(&dev->ctrl_urb_lock); 247 if (!(requesttype & USB_DIR_IN) && size) 248 memcpy(dev->urb_buf, data, size); 249 rc = usb_control_msg(dev->udev, pipe, request, requesttype, value, 250 index, dev->urb_buf, size, timeout); 251 if ((requesttype & USB_DIR_IN) && size) 252 memcpy(data, dev->urb_buf, size); 253 mutex_unlock(&dev->ctrl_urb_lock); 254 255 if (reg_debug) { 256 if (unlikely(rc < 0)) { 257 printk(KERN_CONT "FAILED!\n"); 258 return rc; 259 } 260 261 if ((requesttype & USB_DIR_IN)) { 262 printk(KERN_CONT "<<<"); 263 for (i = 0; i < size; i++) 264 printk(KERN_CONT " %02x", 265 ((unsigned char *)data)[i]); 266 } 267 printk(KERN_CONT "\n"); 268 } 269 270 return rc; 271 } 272 273 274 /* 275 * cx231xx_read_ctrl_reg() 276 * reads data from the usb device specifying bRequest and wValue 277 */ 278 int cx231xx_read_ctrl_reg(struct cx231xx *dev, u8 req, u16 reg, 279 char *buf, int len) 280 { 281 u8 val = 0; 282 int ret; 283 int pipe = usb_rcvctrlpipe(dev->udev, 0); 284 285 if (dev->state & DEV_DISCONNECTED) 286 return -ENODEV; 287 288 if (len > URB_MAX_CTRL_SIZE) 289 return -EINVAL; 290 291 switch (len) { 292 case 1: 293 val = ENABLE_ONE_BYTE; 294 break; 295 case 2: 296 val = ENABLE_TWE_BYTE; 297 break; 298 case 3: 299 val = ENABLE_THREE_BYTE; 300 break; 301 case 4: 302 val = ENABLE_FOUR_BYTE; 303 break; 304 default: 305 val = 0xFF; /* invalid option */ 306 } 307 308 if (val == 0xFF) 309 return -EINVAL; 310 311 ret = __usb_control_msg(dev, pipe, req, 312 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 313 val, reg, buf, len, HZ); 314 return ret; 315 } 316 317 int cx231xx_send_vendor_cmd(struct cx231xx *dev, 318 struct VENDOR_REQUEST_IN *ven_req) 319 { 320 int ret; 321 int pipe = 0; 322 int unsend_size = 0; 323 u8 *pdata; 324 325 if (dev->state & DEV_DISCONNECTED) 326 return -ENODEV; 327 328 if ((ven_req->wLength > URB_MAX_CTRL_SIZE)) 329 return -EINVAL; 330 331 if (ven_req->direction) 332 pipe = usb_rcvctrlpipe(dev->udev, 0); 333 else 334 pipe = usb_sndctrlpipe(dev->udev, 0); 335 336 /* 337 * If the cx23102 read more than 4 bytes with i2c bus, 338 * need chop to 4 byte per request 339 */ 340 if ((ven_req->wLength > 4) && ((ven_req->bRequest == 0x4) || 341 (ven_req->bRequest == 0x5) || 342 (ven_req->bRequest == 0x6) || 343 344 /* Internal Master 3 Bus can send 345 * and receive only 4 bytes per time 346 */ 347 (ven_req->bRequest == 0x2))) { 348 unsend_size = 0; 349 pdata = ven_req->pBuff; 350 351 352 unsend_size = ven_req->wLength; 353 354 /* the first package */ 355 ven_req->wValue = ven_req->wValue & 0xFFFB; 356 ven_req->wValue = (ven_req->wValue & 0xFFBD) | 0x2; 357 ret = __usb_control_msg(dev, pipe, ven_req->bRequest, 358 ven_req->direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 359 ven_req->wValue, ven_req->wIndex, pdata, 360 0x0004, HZ); 361 unsend_size = unsend_size - 4; 362 363 /* the middle package */ 364 ven_req->wValue = (ven_req->wValue & 0xFFBD) | 0x42; 365 while (unsend_size - 4 > 0) { 366 pdata = pdata + 4; 367 ret = __usb_control_msg(dev, pipe, 368 ven_req->bRequest, 369 ven_req->direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 370 ven_req->wValue, ven_req->wIndex, pdata, 371 0x0004, HZ); 372 unsend_size = unsend_size - 4; 373 } 374 375 /* the last package */ 376 ven_req->wValue = (ven_req->wValue & 0xFFBD) | 0x40; 377 pdata = pdata + 4; 378 ret = __usb_control_msg(dev, pipe, ven_req->bRequest, 379 ven_req->direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 380 ven_req->wValue, ven_req->wIndex, pdata, 381 unsend_size, HZ); 382 } else { 383 ret = __usb_control_msg(dev, pipe, ven_req->bRequest, 384 ven_req->direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 385 ven_req->wValue, ven_req->wIndex, 386 ven_req->pBuff, ven_req->wLength, HZ); 387 } 388 389 return ret; 390 } 391 392 /* 393 * cx231xx_write_ctrl_reg() 394 * sends data to the usb device, specifying bRequest 395 */ 396 int cx231xx_write_ctrl_reg(struct cx231xx *dev, u8 req, u16 reg, char *buf, 397 int len) 398 { 399 u8 val = 0; 400 int ret; 401 int pipe = usb_sndctrlpipe(dev->udev, 0); 402 403 if (dev->state & DEV_DISCONNECTED) 404 return -ENODEV; 405 406 if ((len < 1) || (len > URB_MAX_CTRL_SIZE)) 407 return -EINVAL; 408 409 switch (len) { 410 case 1: 411 val = ENABLE_ONE_BYTE; 412 break; 413 case 2: 414 val = ENABLE_TWE_BYTE; 415 break; 416 case 3: 417 val = ENABLE_THREE_BYTE; 418 break; 419 case 4: 420 val = ENABLE_FOUR_BYTE; 421 break; 422 default: 423 val = 0xFF; /* invalid option */ 424 } 425 426 if (val == 0xFF) 427 return -EINVAL; 428 429 if (reg_debug) { 430 int byte; 431 432 cx231xx_isocdbg("(pipe 0x%08x): OUT: %02x %02x %02x %02x %02x %02x %02x %02x >>>", 433 pipe, 434 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 435 req, 0, val, reg & 0xff, 436 reg >> 8, len & 0xff, len >> 8); 437 438 for (byte = 0; byte < len; byte++) 439 cx231xx_isocdbg(" %02x", (unsigned char)buf[byte]); 440 cx231xx_isocdbg("\n"); 441 } 442 443 ret = __usb_control_msg(dev, pipe, req, 444 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 445 val, reg, buf, len, HZ); 446 447 return ret; 448 } 449 450 /**************************************************************** 451 * USB Alternate Setting functions * 452 *****************************************************************/ 453 454 int cx231xx_set_video_alternate(struct cx231xx *dev) 455 { 456 int errCode, prev_alt = dev->video_mode.alt; 457 unsigned int min_pkt_size = dev->width * 2 + 4; 458 u32 usb_interface_index = 0; 459 460 /* When image size is bigger than a certain value, 461 the frame size should be increased, otherwise, only 462 green screen will be received. 463 */ 464 if (dev->width * 2 * dev->height > 720 * 240 * 2) 465 min_pkt_size *= 2; 466 467 if (dev->width > 360) { 468 /* resolutions: 720,704,640 */ 469 dev->video_mode.alt = 3; 470 } else if (dev->width > 180) { 471 /* resolutions: 360,352,320,240 */ 472 dev->video_mode.alt = 2; 473 } else if (dev->width > 0) { 474 /* resolutions: 180,176,160,128,88 */ 475 dev->video_mode.alt = 1; 476 } else { 477 /* Change to alt0 BULK to release USB bandwidth */ 478 dev->video_mode.alt = 0; 479 } 480 481 if (dev->USE_ISO == 0) 482 dev->video_mode.alt = 0; 483 484 cx231xx_coredbg("dev->video_mode.alt= %d\n", dev->video_mode.alt); 485 486 /* Get the correct video interface Index */ 487 usb_interface_index = 488 dev->current_pcb_config.hs_config_info[0].interface_info. 489 video_index + 1; 490 491 if (dev->video_mode.alt != prev_alt) { 492 cx231xx_coredbg("minimum isoc packet size: %u (alt=%d)\n", 493 min_pkt_size, dev->video_mode.alt); 494 495 if (dev->video_mode.alt_max_pkt_size != NULL) 496 dev->video_mode.max_pkt_size = 497 dev->video_mode.alt_max_pkt_size[dev->video_mode.alt]; 498 cx231xx_coredbg("setting alternate %d with wMaxPacketSize=%u\n", 499 dev->video_mode.alt, 500 dev->video_mode.max_pkt_size); 501 errCode = 502 usb_set_interface(dev->udev, usb_interface_index, 503 dev->video_mode.alt); 504 if (errCode < 0) { 505 dev_err(dev->dev, 506 "cannot change alt number to %d (error=%i)\n", 507 dev->video_mode.alt, errCode); 508 return errCode; 509 } 510 } 511 return 0; 512 } 513 514 int cx231xx_set_alt_setting(struct cx231xx *dev, u8 index, u8 alt) 515 { 516 int status = 0; 517 u32 usb_interface_index = 0; 518 u32 max_pkt_size = 0; 519 520 switch (index) { 521 case INDEX_TS1: 522 usb_interface_index = 523 dev->current_pcb_config.hs_config_info[0].interface_info. 524 ts1_index + 1; 525 dev->ts1_mode.alt = alt; 526 if (dev->ts1_mode.alt_max_pkt_size != NULL) 527 max_pkt_size = dev->ts1_mode.max_pkt_size = 528 dev->ts1_mode.alt_max_pkt_size[dev->ts1_mode.alt]; 529 break; 530 case INDEX_TS2: 531 usb_interface_index = 532 dev->current_pcb_config.hs_config_info[0].interface_info. 533 ts2_index + 1; 534 break; 535 case INDEX_AUDIO: 536 usb_interface_index = 537 dev->current_pcb_config.hs_config_info[0].interface_info. 538 audio_index + 1; 539 dev->adev.alt = alt; 540 if (dev->adev.alt_max_pkt_size != NULL) 541 max_pkt_size = dev->adev.max_pkt_size = 542 dev->adev.alt_max_pkt_size[dev->adev.alt]; 543 break; 544 case INDEX_VIDEO: 545 usb_interface_index = 546 dev->current_pcb_config.hs_config_info[0].interface_info. 547 video_index + 1; 548 dev->video_mode.alt = alt; 549 if (dev->video_mode.alt_max_pkt_size != NULL) 550 max_pkt_size = dev->video_mode.max_pkt_size = 551 dev->video_mode.alt_max_pkt_size[dev->video_mode. 552 alt]; 553 break; 554 case INDEX_VANC: 555 if (dev->board.no_alt_vanc) 556 return 0; 557 usb_interface_index = 558 dev->current_pcb_config.hs_config_info[0].interface_info. 559 vanc_index + 1; 560 dev->vbi_mode.alt = alt; 561 if (dev->vbi_mode.alt_max_pkt_size != NULL) 562 max_pkt_size = dev->vbi_mode.max_pkt_size = 563 dev->vbi_mode.alt_max_pkt_size[dev->vbi_mode.alt]; 564 break; 565 case INDEX_HANC: 566 usb_interface_index = 567 dev->current_pcb_config.hs_config_info[0].interface_info. 568 hanc_index + 1; 569 dev->sliced_cc_mode.alt = alt; 570 if (dev->sliced_cc_mode.alt_max_pkt_size != NULL) 571 max_pkt_size = dev->sliced_cc_mode.max_pkt_size = 572 dev->sliced_cc_mode.alt_max_pkt_size[dev-> 573 sliced_cc_mode. 574 alt]; 575 break; 576 default: 577 break; 578 } 579 580 if (alt > 0 && max_pkt_size == 0) { 581 dev_err(dev->dev, 582 "can't change interface %d alt no. to %d: Max. Pkt size = 0\n", 583 usb_interface_index, alt); 584 /*To workaround error number=-71 on EP0 for videograbber, 585 need add following codes.*/ 586 if (dev->board.no_alt_vanc) 587 return -1; 588 } 589 590 cx231xx_coredbg("setting alternate %d with wMaxPacketSize=%u,Interface = %d\n", 591 alt, max_pkt_size, 592 usb_interface_index); 593 594 if (usb_interface_index > 0) { 595 status = usb_set_interface(dev->udev, usb_interface_index, alt); 596 if (status < 0) { 597 dev_err(dev->dev, 598 "can't change interface %d alt no. to %d (err=%i)\n", 599 usb_interface_index, alt, status); 600 return status; 601 } 602 } 603 604 return status; 605 } 606 EXPORT_SYMBOL_GPL(cx231xx_set_alt_setting); 607 608 int cx231xx_gpio_set(struct cx231xx *dev, struct cx231xx_reg_seq *gpio) 609 { 610 int rc = 0; 611 612 if (!gpio) 613 return rc; 614 615 /* Send GPIO reset sequences specified at board entry */ 616 while (gpio->sleep >= 0) { 617 rc = cx231xx_set_gpio_value(dev, gpio->bit, gpio->val); 618 if (rc < 0) 619 return rc; 620 621 if (gpio->sleep > 0) 622 msleep(gpio->sleep); 623 624 gpio++; 625 } 626 return rc; 627 } 628 629 int cx231xx_demod_reset(struct cx231xx *dev) 630 { 631 632 u8 status = 0; 633 u8 value[4] = { 0, 0, 0, 0 }; 634 635 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, PWR_CTL_EN, 636 value, 4); 637 638 cx231xx_coredbg("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", PWR_CTL_EN, 639 value[0], value[1], value[2], value[3]); 640 641 cx231xx_coredbg("Enter cx231xx_demod_reset()\n"); 642 643 value[1] = (u8) 0x3; 644 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 645 PWR_CTL_EN, value, 4); 646 msleep(10); 647 648 value[1] = (u8) 0x0; 649 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 650 PWR_CTL_EN, value, 4); 651 msleep(10); 652 653 value[1] = (u8) 0x3; 654 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 655 PWR_CTL_EN, value, 4); 656 msleep(10); 657 658 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, PWR_CTL_EN, 659 value, 4); 660 661 cx231xx_coredbg("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", PWR_CTL_EN, 662 value[0], value[1], value[2], value[3]); 663 664 return status; 665 } 666 EXPORT_SYMBOL_GPL(cx231xx_demod_reset); 667 int is_fw_load(struct cx231xx *dev) 668 { 669 return cx231xx_check_fw(dev); 670 } 671 EXPORT_SYMBOL_GPL(is_fw_load); 672 673 int cx231xx_set_mode(struct cx231xx *dev, enum cx231xx_mode set_mode) 674 { 675 int errCode = 0; 676 677 if (dev->mode == set_mode) 678 return 0; 679 680 if (set_mode == CX231XX_SUSPEND) { 681 /* Set the chip in power saving mode */ 682 dev->mode = set_mode; 683 } 684 685 /* Resource is locked */ 686 if (dev->mode != CX231XX_SUSPEND) 687 return -EINVAL; 688 689 dev->mode = set_mode; 690 691 if (dev->mode == CX231XX_DIGITAL_MODE)/* Set Digital power mode */ { 692 /* set AGC mode to Digital */ 693 switch (dev->model) { 694 case CX231XX_BOARD_CNXT_CARRAERA: 695 case CX231XX_BOARD_CNXT_RDE_250: 696 case CX231XX_BOARD_CNXT_SHELBY: 697 case CX231XX_BOARD_CNXT_RDU_250: 698 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 0); 699 break; 700 case CX231XX_BOARD_CNXT_RDE_253S: 701 case CX231XX_BOARD_CNXT_RDU_253S: 702 case CX231XX_BOARD_PV_PLAYTV_USB_HYBRID: 703 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 1); 704 break; 705 case CX231XX_BOARD_HAUPPAUGE_EXETER: 706 case CX231XX_BOARD_HAUPPAUGE_930C_HD_1113xx: 707 errCode = cx231xx_set_power_mode(dev, 708 POLARIS_AVMODE_DIGITAL); 709 break; 710 default: 711 break; 712 } 713 } else/* Set Analog Power mode */ { 714 /* set AGC mode to Analog */ 715 switch (dev->model) { 716 case CX231XX_BOARD_CNXT_CARRAERA: 717 case CX231XX_BOARD_CNXT_RDE_250: 718 case CX231XX_BOARD_CNXT_SHELBY: 719 case CX231XX_BOARD_CNXT_RDU_250: 720 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 1); 721 break; 722 case CX231XX_BOARD_CNXT_RDE_253S: 723 case CX231XX_BOARD_CNXT_RDU_253S: 724 case CX231XX_BOARD_HAUPPAUGE_EXETER: 725 case CX231XX_BOARD_HAUPPAUGE_930C_HD_1113xx: 726 case CX231XX_BOARD_PV_PLAYTV_USB_HYBRID: 727 case CX231XX_BOARD_HAUPPAUGE_USB2_FM_PAL: 728 case CX231XX_BOARD_HAUPPAUGE_USB2_FM_NTSC: 729 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 0); 730 break; 731 default: 732 break; 733 } 734 } 735 736 if (errCode < 0) { 737 dev_err(dev->dev, "Failed to set devmode to %s: error: %i", 738 dev->mode == CX231XX_DIGITAL_MODE ? "digital" : "analog", 739 errCode); 740 return errCode; 741 } 742 743 return 0; 744 } 745 EXPORT_SYMBOL_GPL(cx231xx_set_mode); 746 747 int cx231xx_ep5_bulkout(struct cx231xx *dev, u8 *firmware, u16 size) 748 { 749 int errCode = 0; 750 int actlen = -1; 751 int ret = -ENOMEM; 752 u32 *buffer; 753 754 buffer = kmemdup(firmware, EP5_BUF_SIZE, GFP_KERNEL); 755 if (buffer == NULL) 756 return -ENOMEM; 757 758 ret = usb_bulk_msg(dev->udev, usb_sndbulkpipe(dev->udev, 5), 759 buffer, EP5_BUF_SIZE, &actlen, EP5_TIMEOUT_MS); 760 761 if (ret) 762 dev_err(dev->dev, 763 "bulk message failed: %d (%d/%d)", ret, 764 size, actlen); 765 else { 766 errCode = actlen != size ? -1 : 0; 767 } 768 kfree(buffer); 769 return errCode; 770 } 771 772 /***************************************************************** 773 * URB Streaming functions * 774 ******************************************************************/ 775 776 /* 777 * IRQ callback, called by URB callback 778 */ 779 static void cx231xx_isoc_irq_callback(struct urb *urb) 780 { 781 struct cx231xx_dmaqueue *dma_q = urb->context; 782 struct cx231xx_video_mode *vmode = 783 container_of(dma_q, struct cx231xx_video_mode, vidq); 784 struct cx231xx *dev = container_of(vmode, struct cx231xx, video_mode); 785 unsigned long flags; 786 int i; 787 788 switch (urb->status) { 789 case 0: /* success */ 790 case -ETIMEDOUT: /* NAK */ 791 break; 792 case -ECONNRESET: /* kill */ 793 case -ENOENT: 794 case -ESHUTDOWN: 795 return; 796 default: /* error */ 797 cx231xx_isocdbg("urb completion error %d.\n", urb->status); 798 break; 799 } 800 801 /* Copy data from URB */ 802 spin_lock_irqsave(&dev->video_mode.slock, flags); 803 dev->video_mode.isoc_ctl.isoc_copy(dev, urb); 804 spin_unlock_irqrestore(&dev->video_mode.slock, flags); 805 806 /* Reset urb buffers */ 807 for (i = 0; i < urb->number_of_packets; i++) { 808 urb->iso_frame_desc[i].status = 0; 809 urb->iso_frame_desc[i].actual_length = 0; 810 } 811 812 urb->status = usb_submit_urb(urb, GFP_ATOMIC); 813 if (urb->status) { 814 cx231xx_isocdbg("urb resubmit failed (error=%i)\n", 815 urb->status); 816 } 817 } 818 /***************************************************************** 819 * URB Streaming functions * 820 ******************************************************************/ 821 822 /* 823 * IRQ callback, called by URB callback 824 */ 825 static void cx231xx_bulk_irq_callback(struct urb *urb) 826 { 827 struct cx231xx_dmaqueue *dma_q = urb->context; 828 struct cx231xx_video_mode *vmode = 829 container_of(dma_q, struct cx231xx_video_mode, vidq); 830 struct cx231xx *dev = container_of(vmode, struct cx231xx, video_mode); 831 unsigned long flags; 832 833 switch (urb->status) { 834 case 0: /* success */ 835 case -ETIMEDOUT: /* NAK */ 836 break; 837 case -ECONNRESET: /* kill */ 838 case -ENOENT: 839 case -ESHUTDOWN: 840 return; 841 case -EPIPE: /* stall */ 842 cx231xx_isocdbg("urb completion error - device is stalled.\n"); 843 return; 844 default: /* error */ 845 cx231xx_isocdbg("urb completion error %d.\n", urb->status); 846 break; 847 } 848 849 /* Copy data from URB */ 850 spin_lock_irqsave(&dev->video_mode.slock, flags); 851 dev->video_mode.bulk_ctl.bulk_copy(dev, urb); 852 spin_unlock_irqrestore(&dev->video_mode.slock, flags); 853 854 /* Reset urb buffers */ 855 urb->status = usb_submit_urb(urb, GFP_ATOMIC); 856 if (urb->status) { 857 cx231xx_isocdbg("urb resubmit failed (error=%i)\n", 858 urb->status); 859 } 860 } 861 /* 862 * Stop and Deallocate URBs 863 */ 864 void cx231xx_uninit_isoc(struct cx231xx *dev) 865 { 866 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq; 867 struct urb *urb; 868 int i; 869 bool broken_pipe = false; 870 871 cx231xx_isocdbg("cx231xx: called cx231xx_uninit_isoc\n"); 872 873 dev->video_mode.isoc_ctl.nfields = -1; 874 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) { 875 urb = dev->video_mode.isoc_ctl.urb[i]; 876 if (urb) { 877 if (!irqs_disabled()) 878 usb_kill_urb(urb); 879 else 880 usb_unlink_urb(urb); 881 882 if (dev->video_mode.isoc_ctl.transfer_buffer[i]) { 883 usb_free_coherent(dev->udev, 884 urb->transfer_buffer_length, 885 dev->video_mode.isoc_ctl. 886 transfer_buffer[i], 887 urb->transfer_dma); 888 } 889 if (urb->status == -EPIPE) { 890 broken_pipe = true; 891 } 892 usb_free_urb(urb); 893 dev->video_mode.isoc_ctl.urb[i] = NULL; 894 } 895 dev->video_mode.isoc_ctl.transfer_buffer[i] = NULL; 896 } 897 898 if (broken_pipe) { 899 cx231xx_isocdbg("Reset endpoint to recover broken pipe."); 900 usb_reset_endpoint(dev->udev, dev->video_mode.end_point_addr); 901 } 902 kfree(dev->video_mode.isoc_ctl.urb); 903 kfree(dev->video_mode.isoc_ctl.transfer_buffer); 904 kfree(dma_q->p_left_data); 905 906 dev->video_mode.isoc_ctl.urb = NULL; 907 dev->video_mode.isoc_ctl.transfer_buffer = NULL; 908 dev->video_mode.isoc_ctl.num_bufs = 0; 909 dma_q->p_left_data = NULL; 910 911 if (dev->mode_tv == 0) 912 cx231xx_capture_start(dev, 0, Raw_Video); 913 else 914 cx231xx_capture_start(dev, 0, TS1_serial_mode); 915 916 917 } 918 EXPORT_SYMBOL_GPL(cx231xx_uninit_isoc); 919 920 /* 921 * Stop and Deallocate URBs 922 */ 923 void cx231xx_uninit_bulk(struct cx231xx *dev) 924 { 925 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq; 926 struct urb *urb; 927 int i; 928 bool broken_pipe = false; 929 930 cx231xx_isocdbg("cx231xx: called cx231xx_uninit_bulk\n"); 931 932 dev->video_mode.bulk_ctl.nfields = -1; 933 for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) { 934 urb = dev->video_mode.bulk_ctl.urb[i]; 935 if (urb) { 936 if (!irqs_disabled()) 937 usb_kill_urb(urb); 938 else 939 usb_unlink_urb(urb); 940 941 if (dev->video_mode.bulk_ctl.transfer_buffer[i]) { 942 usb_free_coherent(dev->udev, 943 urb->transfer_buffer_length, 944 dev->video_mode.bulk_ctl. 945 transfer_buffer[i], 946 urb->transfer_dma); 947 } 948 if (urb->status == -EPIPE) { 949 broken_pipe = true; 950 } 951 usb_free_urb(urb); 952 dev->video_mode.bulk_ctl.urb[i] = NULL; 953 } 954 dev->video_mode.bulk_ctl.transfer_buffer[i] = NULL; 955 } 956 957 if (broken_pipe) { 958 cx231xx_isocdbg("Reset endpoint to recover broken pipe."); 959 usb_reset_endpoint(dev->udev, dev->video_mode.end_point_addr); 960 } 961 kfree(dev->video_mode.bulk_ctl.urb); 962 kfree(dev->video_mode.bulk_ctl.transfer_buffer); 963 kfree(dma_q->p_left_data); 964 965 dev->video_mode.bulk_ctl.urb = NULL; 966 dev->video_mode.bulk_ctl.transfer_buffer = NULL; 967 dev->video_mode.bulk_ctl.num_bufs = 0; 968 dma_q->p_left_data = NULL; 969 970 if (dev->mode_tv == 0) 971 cx231xx_capture_start(dev, 0, Raw_Video); 972 else 973 cx231xx_capture_start(dev, 0, TS1_serial_mode); 974 975 976 } 977 EXPORT_SYMBOL_GPL(cx231xx_uninit_bulk); 978 979 /* 980 * Allocate URBs and start IRQ 981 */ 982 int cx231xx_init_isoc(struct cx231xx *dev, int max_packets, 983 int num_bufs, int max_pkt_size, 984 int (*isoc_copy) (struct cx231xx *dev, struct urb *urb)) 985 { 986 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq; 987 int i; 988 int sb_size, pipe; 989 struct urb *urb; 990 int j, k; 991 int rc; 992 993 /* De-allocates all pending stuff */ 994 cx231xx_uninit_isoc(dev); 995 996 dma_q->p_left_data = kzalloc(EP5_BUF_SIZE, GFP_KERNEL); 997 if (dma_q->p_left_data == NULL) 998 return -ENOMEM; 999 1000 dev->video_mode.isoc_ctl.isoc_copy = isoc_copy; 1001 dev->video_mode.isoc_ctl.num_bufs = num_bufs; 1002 dma_q->pos = 0; 1003 dma_q->is_partial_line = 0; 1004 dma_q->last_sav = 0; 1005 dma_q->current_field = -1; 1006 dma_q->field1_done = 0; 1007 dma_q->lines_per_field = dev->height / 2; 1008 dma_q->bytes_left_in_line = dev->width << 1; 1009 dma_q->lines_completed = 0; 1010 dma_q->mpeg_buffer_done = 0; 1011 dma_q->left_data_count = 0; 1012 dma_q->mpeg_buffer_completed = 0; 1013 dma_q->add_ps_package_head = CX231XX_NEED_ADD_PS_PACKAGE_HEAD; 1014 dma_q->ps_head[0] = 0x00; 1015 dma_q->ps_head[1] = 0x00; 1016 dma_q->ps_head[2] = 0x01; 1017 dma_q->ps_head[3] = 0xBA; 1018 for (i = 0; i < 8; i++) 1019 dma_q->partial_buf[i] = 0; 1020 1021 dev->video_mode.isoc_ctl.urb = 1022 kcalloc(num_bufs, sizeof(void *), GFP_KERNEL); 1023 if (!dev->video_mode.isoc_ctl.urb) { 1024 dev_err(dev->dev, 1025 "cannot alloc memory for usb buffers\n"); 1026 return -ENOMEM; 1027 } 1028 1029 dev->video_mode.isoc_ctl.transfer_buffer = 1030 kcalloc(num_bufs, sizeof(void *), GFP_KERNEL); 1031 if (!dev->video_mode.isoc_ctl.transfer_buffer) { 1032 dev_err(dev->dev, 1033 "cannot allocate memory for usbtransfer\n"); 1034 kfree(dev->video_mode.isoc_ctl.urb); 1035 return -ENOMEM; 1036 } 1037 1038 dev->video_mode.isoc_ctl.max_pkt_size = max_pkt_size; 1039 dev->video_mode.isoc_ctl.buf = NULL; 1040 1041 sb_size = max_packets * dev->video_mode.isoc_ctl.max_pkt_size; 1042 1043 if (dev->mode_tv == 1) 1044 dev->video_mode.end_point_addr = 0x81; 1045 else 1046 dev->video_mode.end_point_addr = 0x84; 1047 1048 1049 /* allocate urbs and transfer buffers */ 1050 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) { 1051 urb = usb_alloc_urb(max_packets, GFP_KERNEL); 1052 if (!urb) { 1053 cx231xx_uninit_isoc(dev); 1054 return -ENOMEM; 1055 } 1056 dev->video_mode.isoc_ctl.urb[i] = urb; 1057 1058 dev->video_mode.isoc_ctl.transfer_buffer[i] = 1059 usb_alloc_coherent(dev->udev, sb_size, GFP_KERNEL, 1060 &urb->transfer_dma); 1061 if (!dev->video_mode.isoc_ctl.transfer_buffer[i]) { 1062 dev_err(dev->dev, 1063 "unable to allocate %i bytes for transfer buffer %i\n", 1064 sb_size, i); 1065 cx231xx_uninit_isoc(dev); 1066 return -ENOMEM; 1067 } 1068 memset(dev->video_mode.isoc_ctl.transfer_buffer[i], 0, sb_size); 1069 1070 pipe = 1071 usb_rcvisocpipe(dev->udev, dev->video_mode.end_point_addr); 1072 1073 usb_fill_int_urb(urb, dev->udev, pipe, 1074 dev->video_mode.isoc_ctl.transfer_buffer[i], 1075 sb_size, cx231xx_isoc_irq_callback, dma_q, 1); 1076 1077 urb->number_of_packets = max_packets; 1078 urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP; 1079 1080 k = 0; 1081 for (j = 0; j < max_packets; j++) { 1082 urb->iso_frame_desc[j].offset = k; 1083 urb->iso_frame_desc[j].length = 1084 dev->video_mode.isoc_ctl.max_pkt_size; 1085 k += dev->video_mode.isoc_ctl.max_pkt_size; 1086 } 1087 } 1088 1089 init_waitqueue_head(&dma_q->wq); 1090 1091 /* submit urbs and enables IRQ */ 1092 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) { 1093 rc = usb_submit_urb(dev->video_mode.isoc_ctl.urb[i], 1094 GFP_ATOMIC); 1095 if (rc) { 1096 dev_err(dev->dev, 1097 "submit of urb %i failed (error=%i)\n", i, 1098 rc); 1099 cx231xx_uninit_isoc(dev); 1100 return rc; 1101 } 1102 } 1103 1104 if (dev->mode_tv == 0) 1105 cx231xx_capture_start(dev, 1, Raw_Video); 1106 else 1107 cx231xx_capture_start(dev, 1, TS1_serial_mode); 1108 1109 return 0; 1110 } 1111 EXPORT_SYMBOL_GPL(cx231xx_init_isoc); 1112 1113 /* 1114 * Allocate URBs and start IRQ 1115 */ 1116 int cx231xx_init_bulk(struct cx231xx *dev, int max_packets, 1117 int num_bufs, int max_pkt_size, 1118 int (*bulk_copy) (struct cx231xx *dev, struct urb *urb)) 1119 { 1120 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq; 1121 int i; 1122 int sb_size, pipe; 1123 struct urb *urb; 1124 int rc; 1125 1126 dev->video_input = dev->video_input > 2 ? 2 : dev->video_input; 1127 1128 cx231xx_coredbg("Setting Video mux to %d\n", dev->video_input); 1129 1130 video_mux(dev, dev->video_input); 1131 1132 /* De-allocates all pending stuff */ 1133 cx231xx_uninit_bulk(dev); 1134 1135 dev->video_mode.bulk_ctl.bulk_copy = bulk_copy; 1136 dev->video_mode.bulk_ctl.num_bufs = num_bufs; 1137 dma_q->pos = 0; 1138 dma_q->is_partial_line = 0; 1139 dma_q->last_sav = 0; 1140 dma_q->current_field = -1; 1141 dma_q->field1_done = 0; 1142 dma_q->lines_per_field = dev->height / 2; 1143 dma_q->bytes_left_in_line = dev->width << 1; 1144 dma_q->lines_completed = 0; 1145 dma_q->mpeg_buffer_done = 0; 1146 dma_q->left_data_count = 0; 1147 dma_q->mpeg_buffer_completed = 0; 1148 dma_q->ps_head[0] = 0x00; 1149 dma_q->ps_head[1] = 0x00; 1150 dma_q->ps_head[2] = 0x01; 1151 dma_q->ps_head[3] = 0xBA; 1152 for (i = 0; i < 8; i++) 1153 dma_q->partial_buf[i] = 0; 1154 1155 dev->video_mode.bulk_ctl.urb = 1156 kcalloc(num_bufs, sizeof(void *), GFP_KERNEL); 1157 if (!dev->video_mode.bulk_ctl.urb) { 1158 dev_err(dev->dev, 1159 "cannot alloc memory for usb buffers\n"); 1160 return -ENOMEM; 1161 } 1162 1163 dev->video_mode.bulk_ctl.transfer_buffer = 1164 kcalloc(num_bufs, sizeof(void *), GFP_KERNEL); 1165 if (!dev->video_mode.bulk_ctl.transfer_buffer) { 1166 dev_err(dev->dev, 1167 "cannot allocate memory for usbtransfer\n"); 1168 kfree(dev->video_mode.bulk_ctl.urb); 1169 return -ENOMEM; 1170 } 1171 1172 dev->video_mode.bulk_ctl.max_pkt_size = max_pkt_size; 1173 dev->video_mode.bulk_ctl.buf = NULL; 1174 1175 sb_size = max_packets * dev->video_mode.bulk_ctl.max_pkt_size; 1176 1177 if (dev->mode_tv == 1) 1178 dev->video_mode.end_point_addr = 0x81; 1179 else 1180 dev->video_mode.end_point_addr = 0x84; 1181 1182 1183 /* allocate urbs and transfer buffers */ 1184 for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) { 1185 urb = usb_alloc_urb(0, GFP_KERNEL); 1186 if (!urb) { 1187 cx231xx_uninit_bulk(dev); 1188 return -ENOMEM; 1189 } 1190 dev->video_mode.bulk_ctl.urb[i] = urb; 1191 urb->transfer_flags = URB_NO_TRANSFER_DMA_MAP; 1192 1193 dev->video_mode.bulk_ctl.transfer_buffer[i] = 1194 usb_alloc_coherent(dev->udev, sb_size, GFP_KERNEL, 1195 &urb->transfer_dma); 1196 if (!dev->video_mode.bulk_ctl.transfer_buffer[i]) { 1197 dev_err(dev->dev, 1198 "unable to allocate %i bytes for transfer buffer %i\n", 1199 sb_size, i); 1200 cx231xx_uninit_bulk(dev); 1201 return -ENOMEM; 1202 } 1203 memset(dev->video_mode.bulk_ctl.transfer_buffer[i], 0, sb_size); 1204 1205 pipe = usb_rcvbulkpipe(dev->udev, 1206 dev->video_mode.end_point_addr); 1207 usb_fill_bulk_urb(urb, dev->udev, pipe, 1208 dev->video_mode.bulk_ctl.transfer_buffer[i], 1209 sb_size, cx231xx_bulk_irq_callback, dma_q); 1210 } 1211 1212 /* clear halt */ 1213 rc = usb_clear_halt(dev->udev, dev->video_mode.bulk_ctl.urb[0]->pipe); 1214 if (rc < 0) { 1215 dev_err(dev->dev, 1216 "failed to clear USB bulk endpoint stall/halt condition (error=%i)\n", 1217 rc); 1218 cx231xx_uninit_bulk(dev); 1219 return rc; 1220 } 1221 1222 init_waitqueue_head(&dma_q->wq); 1223 1224 /* submit urbs and enables IRQ */ 1225 for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) { 1226 rc = usb_submit_urb(dev->video_mode.bulk_ctl.urb[i], 1227 GFP_ATOMIC); 1228 if (rc) { 1229 dev_err(dev->dev, 1230 "submit of urb %i failed (error=%i)\n", i, rc); 1231 cx231xx_uninit_bulk(dev); 1232 return rc; 1233 } 1234 } 1235 1236 if (dev->mode_tv == 0) 1237 cx231xx_capture_start(dev, 1, Raw_Video); 1238 else 1239 cx231xx_capture_start(dev, 1, TS1_serial_mode); 1240 1241 return 0; 1242 } 1243 EXPORT_SYMBOL_GPL(cx231xx_init_bulk); 1244 void cx231xx_stop_TS1(struct cx231xx *dev) 1245 { 1246 u8 val[4] = { 0, 0, 0, 0 }; 1247 1248 val[0] = 0x00; 1249 val[1] = 0x03; 1250 val[2] = 0x00; 1251 val[3] = 0x00; 1252 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 1253 TS_MODE_REG, val, 4); 1254 1255 val[0] = 0x00; 1256 val[1] = 0x70; 1257 val[2] = 0x04; 1258 val[3] = 0x00; 1259 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 1260 TS1_CFG_REG, val, 4); 1261 } 1262 /* EXPORT_SYMBOL_GPL(cx231xx_stop_TS1); */ 1263 void cx231xx_start_TS1(struct cx231xx *dev) 1264 { 1265 u8 val[4] = { 0, 0, 0, 0 }; 1266 1267 val[0] = 0x03; 1268 val[1] = 0x03; 1269 val[2] = 0x00; 1270 val[3] = 0x00; 1271 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 1272 TS_MODE_REG, val, 4); 1273 1274 val[0] = 0x04; 1275 val[1] = 0xA3; 1276 val[2] = 0x3B; 1277 val[3] = 0x00; 1278 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 1279 TS1_CFG_REG, val, 4); 1280 } 1281 /* EXPORT_SYMBOL_GPL(cx231xx_start_TS1); */ 1282 /***************************************************************** 1283 * Device Init/UnInit functions * 1284 ******************************************************************/ 1285 int cx231xx_dev_init(struct cx231xx *dev) 1286 { 1287 int errCode = 0; 1288 1289 /* Initialize I2C bus */ 1290 1291 /* External Master 1 Bus */ 1292 dev->i2c_bus[0].nr = 0; 1293 dev->i2c_bus[0].dev = dev; 1294 dev->i2c_bus[0].i2c_period = I2C_SPEED_100K; /* 100 KHz */ 1295 dev->i2c_bus[0].i2c_nostop = 0; 1296 dev->i2c_bus[0].i2c_reserve = 0; 1297 dev->i2c_bus[0].i2c_rc = -ENODEV; 1298 1299 /* External Master 2 Bus */ 1300 dev->i2c_bus[1].nr = 1; 1301 dev->i2c_bus[1].dev = dev; 1302 dev->i2c_bus[1].i2c_period = I2C_SPEED_100K; /* 100 KHz */ 1303 dev->i2c_bus[1].i2c_nostop = 0; 1304 dev->i2c_bus[1].i2c_reserve = 0; 1305 dev->i2c_bus[1].i2c_rc = -ENODEV; 1306 1307 /* Internal Master 3 Bus */ 1308 dev->i2c_bus[2].nr = 2; 1309 dev->i2c_bus[2].dev = dev; 1310 dev->i2c_bus[2].i2c_period = I2C_SPEED_100K; /* 100kHz */ 1311 dev->i2c_bus[2].i2c_nostop = 0; 1312 dev->i2c_bus[2].i2c_reserve = 0; 1313 dev->i2c_bus[2].i2c_rc = -ENODEV; 1314 1315 /* register I2C buses */ 1316 errCode = cx231xx_i2c_register(&dev->i2c_bus[0]); 1317 if (errCode < 0) 1318 return errCode; 1319 errCode = cx231xx_i2c_register(&dev->i2c_bus[1]); 1320 if (errCode < 0) 1321 return errCode; 1322 errCode = cx231xx_i2c_register(&dev->i2c_bus[2]); 1323 if (errCode < 0) 1324 return errCode; 1325 1326 errCode = cx231xx_i2c_mux_create(dev); 1327 if (errCode < 0) { 1328 dev_err(dev->dev, 1329 "%s: Failed to create I2C mux\n", __func__); 1330 return errCode; 1331 } 1332 errCode = cx231xx_i2c_mux_register(dev, 0); 1333 if (errCode < 0) 1334 return errCode; 1335 1336 errCode = cx231xx_i2c_mux_register(dev, 1); 1337 if (errCode < 0) 1338 return errCode; 1339 1340 /* scan the real bus segments in the order of physical port numbers */ 1341 cx231xx_do_i2c_scan(dev, I2C_0); 1342 cx231xx_do_i2c_scan(dev, I2C_1_MUX_1); 1343 cx231xx_do_i2c_scan(dev, I2C_2); 1344 cx231xx_do_i2c_scan(dev, I2C_1_MUX_3); 1345 1346 /* init hardware */ 1347 /* Note : with out calling set power mode function, 1348 afe can not be set up correctly */ 1349 if (dev->board.external_av) { 1350 errCode = cx231xx_set_power_mode(dev, 1351 POLARIS_AVMODE_ENXTERNAL_AV); 1352 if (errCode < 0) { 1353 dev_err(dev->dev, 1354 "%s: Failed to set Power - errCode [%d]!\n", 1355 __func__, errCode); 1356 return errCode; 1357 } 1358 } else { 1359 errCode = cx231xx_set_power_mode(dev, 1360 POLARIS_AVMODE_ANALOGT_TV); 1361 if (errCode < 0) { 1362 dev_err(dev->dev, 1363 "%s: Failed to set Power - errCode [%d]!\n", 1364 __func__, errCode); 1365 return errCode; 1366 } 1367 } 1368 1369 /* reset the Tuner, if it is a Xceive tuner */ 1370 if ((dev->board.tuner_type == TUNER_XC5000) || 1371 (dev->board.tuner_type == TUNER_XC2028)) 1372 cx231xx_gpio_set(dev, dev->board.tuner_gpio); 1373 1374 /* initialize Colibri block */ 1375 errCode = cx231xx_afe_init_super_block(dev, 0x23c); 1376 if (errCode < 0) { 1377 dev_err(dev->dev, 1378 "%s: cx231xx_afe init super block - errCode [%d]!\n", 1379 __func__, errCode); 1380 return errCode; 1381 } 1382 errCode = cx231xx_afe_init_channels(dev); 1383 if (errCode < 0) { 1384 dev_err(dev->dev, 1385 "%s: cx231xx_afe init channels - errCode [%d]!\n", 1386 __func__, errCode); 1387 return errCode; 1388 } 1389 1390 /* Set DIF in By pass mode */ 1391 errCode = cx231xx_dif_set_standard(dev, DIF_USE_BASEBAND); 1392 if (errCode < 0) { 1393 dev_err(dev->dev, 1394 "%s: cx231xx_dif set to By pass mode - errCode [%d]!\n", 1395 __func__, errCode); 1396 return errCode; 1397 } 1398 1399 /* I2S block related functions */ 1400 errCode = cx231xx_i2s_blk_initialize(dev); 1401 if (errCode < 0) { 1402 dev_err(dev->dev, 1403 "%s: cx231xx_i2s block initialize - errCode [%d]!\n", 1404 __func__, errCode); 1405 return errCode; 1406 } 1407 1408 /* init control pins */ 1409 errCode = cx231xx_init_ctrl_pin_status(dev); 1410 if (errCode < 0) { 1411 dev_err(dev->dev, 1412 "%s: cx231xx_init ctrl pins - errCode [%d]!\n", 1413 __func__, errCode); 1414 return errCode; 1415 } 1416 1417 /* set AGC mode to Analog */ 1418 switch (dev->model) { 1419 case CX231XX_BOARD_CNXT_CARRAERA: 1420 case CX231XX_BOARD_CNXT_RDE_250: 1421 case CX231XX_BOARD_CNXT_SHELBY: 1422 case CX231XX_BOARD_CNXT_RDU_250: 1423 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 1); 1424 break; 1425 case CX231XX_BOARD_CNXT_RDE_253S: 1426 case CX231XX_BOARD_CNXT_RDU_253S: 1427 case CX231XX_BOARD_HAUPPAUGE_EXETER: 1428 case CX231XX_BOARD_HAUPPAUGE_930C_HD_1113xx: 1429 case CX231XX_BOARD_PV_PLAYTV_USB_HYBRID: 1430 case CX231XX_BOARD_HAUPPAUGE_USB2_FM_PAL: 1431 case CX231XX_BOARD_HAUPPAUGE_USB2_FM_NTSC: 1432 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 0); 1433 break; 1434 default: 1435 break; 1436 } 1437 if (errCode < 0) { 1438 dev_err(dev->dev, 1439 "%s: cx231xx_AGC mode to Analog - errCode [%d]!\n", 1440 __func__, errCode); 1441 return errCode; 1442 } 1443 1444 /* set all alternate settings to zero initially */ 1445 cx231xx_set_alt_setting(dev, INDEX_VIDEO, 0); 1446 cx231xx_set_alt_setting(dev, INDEX_VANC, 0); 1447 cx231xx_set_alt_setting(dev, INDEX_HANC, 0); 1448 if (dev->board.has_dvb) 1449 cx231xx_set_alt_setting(dev, INDEX_TS1, 0); 1450 1451 errCode = 0; 1452 return errCode; 1453 } 1454 EXPORT_SYMBOL_GPL(cx231xx_dev_init); 1455 1456 void cx231xx_dev_uninit(struct cx231xx *dev) 1457 { 1458 /* Un Initialize I2C bus */ 1459 cx231xx_i2c_mux_unregister(dev); 1460 cx231xx_i2c_unregister(&dev->i2c_bus[2]); 1461 cx231xx_i2c_unregister(&dev->i2c_bus[1]); 1462 cx231xx_i2c_unregister(&dev->i2c_bus[0]); 1463 } 1464 EXPORT_SYMBOL_GPL(cx231xx_dev_uninit); 1465 1466 /***************************************************************** 1467 * G P I O related functions * 1468 ******************************************************************/ 1469 int cx231xx_send_gpio_cmd(struct cx231xx *dev, u32 gpio_bit, u8 *gpio_val, 1470 u8 len, u8 request, u8 direction) 1471 { 1472 int status = 0; 1473 struct VENDOR_REQUEST_IN ven_req; 1474 1475 /* Set wValue */ 1476 ven_req.wValue = (u16) (gpio_bit >> 16 & 0xffff); 1477 1478 /* set request */ 1479 if (!request) { 1480 if (direction) 1481 ven_req.bRequest = VRT_GET_GPIO; /* 0x9 gpio */ 1482 else 1483 ven_req.bRequest = VRT_SET_GPIO; /* 0x8 gpio */ 1484 } else { 1485 if (direction) 1486 ven_req.bRequest = VRT_GET_GPIE; /* 0xb gpie */ 1487 else 1488 ven_req.bRequest = VRT_SET_GPIE; /* 0xa gpie */ 1489 } 1490 1491 /* set index value */ 1492 ven_req.wIndex = (u16) (gpio_bit & 0xffff); 1493 1494 /* set wLength value */ 1495 ven_req.wLength = len; 1496 1497 /* set bData value */ 1498 ven_req.bData = 0; 1499 1500 /* set the buffer for read / write */ 1501 ven_req.pBuff = gpio_val; 1502 1503 /* set the direction */ 1504 if (direction) { 1505 ven_req.direction = USB_DIR_IN; 1506 memset(ven_req.pBuff, 0x00, ven_req.wLength); 1507 } else 1508 ven_req.direction = USB_DIR_OUT; 1509 1510 1511 /* call common vendor command request */ 1512 status = cx231xx_send_vendor_cmd(dev, &ven_req); 1513 if (status < 0) { 1514 dev_err(dev->dev, "%s: failed with status -%d\n", 1515 __func__, status); 1516 } 1517 1518 return status; 1519 } 1520 EXPORT_SYMBOL_GPL(cx231xx_send_gpio_cmd); 1521 1522 /***************************************************************** 1523 * C O N T R O L - Register R E A D / W R I T E functions * 1524 *****************************************************************/ 1525 int cx231xx_mode_register(struct cx231xx *dev, u16 address, u32 mode) 1526 { 1527 u8 value[4] = { 0x0, 0x0, 0x0, 0x0 }; 1528 u32 tmp = 0; 1529 int status = 0; 1530 1531 status = 1532 cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, address, value, 4); 1533 if (status < 0) 1534 return status; 1535 1536 tmp = le32_to_cpu(*((__le32 *) value)); 1537 tmp |= mode; 1538 1539 value[0] = (u8) tmp; 1540 value[1] = (u8) (tmp >> 8); 1541 value[2] = (u8) (tmp >> 16); 1542 value[3] = (u8) (tmp >> 24); 1543 1544 status = 1545 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, address, value, 4); 1546 1547 return status; 1548 } 1549 1550 /***************************************************************** 1551 * I 2 C Internal C O N T R O L functions * 1552 *****************************************************************/ 1553 int cx231xx_read_i2c_master(struct cx231xx *dev, u8 dev_addr, u16 saddr, 1554 u8 saddr_len, u32 *data, u8 data_len, int master) 1555 { 1556 int status = 0; 1557 struct cx231xx_i2c_xfer_data req_data; 1558 u8 value[64] = "0"; 1559 1560 if (saddr_len == 0) 1561 saddr = 0; 1562 else if (saddr_len == 1) 1563 saddr &= 0xff; 1564 1565 /* prepare xfer_data struct */ 1566 req_data.dev_addr = dev_addr >> 1; 1567 req_data.direction = I2C_M_RD; 1568 req_data.saddr_len = saddr_len; 1569 req_data.saddr_dat = saddr; 1570 req_data.buf_size = data_len; 1571 req_data.p_buffer = (u8 *) value; 1572 1573 /* usb send command */ 1574 if (master == 0) 1575 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], 1576 &req_data); 1577 else if (master == 1) 1578 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[1], 1579 &req_data); 1580 else if (master == 2) 1581 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[2], 1582 &req_data); 1583 1584 if (status >= 0) { 1585 /* Copy the data read back to main buffer */ 1586 if (data_len == 1) 1587 *data = value[0]; 1588 else if (data_len == 4) 1589 *data = 1590 value[0] | value[1] << 8 | value[2] << 16 | value[3] 1591 << 24; 1592 else if (data_len > 4) 1593 *data = value[saddr]; 1594 } 1595 1596 return status; 1597 } 1598 1599 int cx231xx_write_i2c_master(struct cx231xx *dev, u8 dev_addr, u16 saddr, 1600 u8 saddr_len, u32 data, u8 data_len, int master) 1601 { 1602 int status = 0; 1603 u8 value[4] = { 0, 0, 0, 0 }; 1604 struct cx231xx_i2c_xfer_data req_data; 1605 1606 value[0] = (u8) data; 1607 value[1] = (u8) (data >> 8); 1608 value[2] = (u8) (data >> 16); 1609 value[3] = (u8) (data >> 24); 1610 1611 if (saddr_len == 0) 1612 saddr = 0; 1613 else if (saddr_len == 1) 1614 saddr &= 0xff; 1615 1616 /* prepare xfer_data struct */ 1617 req_data.dev_addr = dev_addr >> 1; 1618 req_data.direction = 0; 1619 req_data.saddr_len = saddr_len; 1620 req_data.saddr_dat = saddr; 1621 req_data.buf_size = data_len; 1622 req_data.p_buffer = value; 1623 1624 /* usb send command */ 1625 if (master == 0) 1626 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], 1627 &req_data); 1628 else if (master == 1) 1629 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[1], 1630 &req_data); 1631 else if (master == 2) 1632 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[2], 1633 &req_data); 1634 1635 return status; 1636 } 1637 1638 int cx231xx_read_i2c_data(struct cx231xx *dev, u8 dev_addr, u16 saddr, 1639 u8 saddr_len, u32 *data, u8 data_len) 1640 { 1641 int status = 0; 1642 struct cx231xx_i2c_xfer_data req_data; 1643 u8 value[4] = { 0, 0, 0, 0 }; 1644 1645 if (saddr_len == 0) 1646 saddr = 0; 1647 else if (saddr_len == 1) 1648 saddr &= 0xff; 1649 1650 /* prepare xfer_data struct */ 1651 req_data.dev_addr = dev_addr >> 1; 1652 req_data.direction = I2C_M_RD; 1653 req_data.saddr_len = saddr_len; 1654 req_data.saddr_dat = saddr; 1655 req_data.buf_size = data_len; 1656 req_data.p_buffer = (u8 *) value; 1657 1658 /* usb send command */ 1659 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], &req_data); 1660 1661 if (status >= 0) { 1662 /* Copy the data read back to main buffer */ 1663 if (data_len == 1) 1664 *data = value[0]; 1665 else 1666 *data = 1667 value[0] | value[1] << 8 | value[2] << 16 | value[3] 1668 << 24; 1669 } 1670 1671 return status; 1672 } 1673 1674 int cx231xx_write_i2c_data(struct cx231xx *dev, u8 dev_addr, u16 saddr, 1675 u8 saddr_len, u32 data, u8 data_len) 1676 { 1677 int status = 0; 1678 u8 value[4] = { 0, 0, 0, 0 }; 1679 struct cx231xx_i2c_xfer_data req_data; 1680 1681 value[0] = (u8) data; 1682 value[1] = (u8) (data >> 8); 1683 value[2] = (u8) (data >> 16); 1684 value[3] = (u8) (data >> 24); 1685 1686 if (saddr_len == 0) 1687 saddr = 0; 1688 else if (saddr_len == 1) 1689 saddr &= 0xff; 1690 1691 /* prepare xfer_data struct */ 1692 req_data.dev_addr = dev_addr >> 1; 1693 req_data.direction = 0; 1694 req_data.saddr_len = saddr_len; 1695 req_data.saddr_dat = saddr; 1696 req_data.buf_size = data_len; 1697 req_data.p_buffer = value; 1698 1699 /* usb send command */ 1700 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], &req_data); 1701 1702 return status; 1703 } 1704 1705 int cx231xx_reg_mask_write(struct cx231xx *dev, u8 dev_addr, u8 size, 1706 u16 register_address, u8 bit_start, u8 bit_end, 1707 u32 value) 1708 { 1709 int status = 0; 1710 u32 tmp; 1711 u32 mask = 0; 1712 int i; 1713 1714 if (bit_start > (size - 1) || bit_end > (size - 1)) 1715 return -1; 1716 1717 if (size == 8) { 1718 status = 1719 cx231xx_read_i2c_data(dev, dev_addr, register_address, 2, 1720 &tmp, 1); 1721 } else { 1722 status = 1723 cx231xx_read_i2c_data(dev, dev_addr, register_address, 2, 1724 &tmp, 4); 1725 } 1726 1727 if (status < 0) 1728 return status; 1729 1730 mask = 1 << bit_end; 1731 for (i = bit_end; i > bit_start && i > 0; i--) 1732 mask = mask + (1 << (i - 1)); 1733 1734 value <<= bit_start; 1735 1736 if (size == 8) { 1737 tmp &= ~mask; 1738 tmp |= value; 1739 tmp &= 0xff; 1740 status = 1741 cx231xx_write_i2c_data(dev, dev_addr, register_address, 2, 1742 tmp, 1); 1743 } else { 1744 tmp &= ~mask; 1745 tmp |= value; 1746 status = 1747 cx231xx_write_i2c_data(dev, dev_addr, register_address, 2, 1748 tmp, 4); 1749 } 1750 1751 return status; 1752 } 1753 1754 int cx231xx_read_modify_write_i2c_dword(struct cx231xx *dev, u8 dev_addr, 1755 u16 saddr, u32 mask, u32 value) 1756 { 1757 u32 temp; 1758 int status = 0; 1759 1760 status = cx231xx_read_i2c_data(dev, dev_addr, saddr, 2, &temp, 4); 1761 1762 if (status < 0) 1763 return status; 1764 1765 temp &= ~mask; 1766 temp |= value; 1767 1768 status = cx231xx_write_i2c_data(dev, dev_addr, saddr, 2, temp, 4); 1769 1770 return status; 1771 } 1772 1773 u32 cx231xx_set_field(u32 field_mask, u32 data) 1774 { 1775 u32 temp; 1776 1777 for (temp = field_mask; (temp & 1) == 0; temp >>= 1) 1778 data <<= 1; 1779 1780 return data; 1781 } 1782