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 = kzalloc(4096, GFP_KERNEL); 755 if (buffer == NULL) 756 return -ENOMEM; 757 memcpy(&buffer[0], firmware, 4096); 758 759 ret = usb_bulk_msg(dev->udev, usb_sndbulkpipe(dev->udev, 5), 760 buffer, 4096, &actlen, 2000); 761 762 if (ret) 763 dev_err(dev->dev, 764 "bulk message failed: %d (%d/%d)", ret, 765 size, actlen); 766 else { 767 errCode = actlen != size ? -1 : 0; 768 } 769 kfree(buffer); 770 return errCode; 771 } 772 773 /***************************************************************** 774 * URB Streaming functions * 775 ******************************************************************/ 776 777 /* 778 * IRQ callback, called by URB callback 779 */ 780 static void cx231xx_isoc_irq_callback(struct urb *urb) 781 { 782 struct cx231xx_dmaqueue *dma_q = urb->context; 783 struct cx231xx_video_mode *vmode = 784 container_of(dma_q, struct cx231xx_video_mode, vidq); 785 struct cx231xx *dev = container_of(vmode, struct cx231xx, video_mode); 786 unsigned long flags; 787 int i; 788 789 switch (urb->status) { 790 case 0: /* success */ 791 case -ETIMEDOUT: /* NAK */ 792 break; 793 case -ECONNRESET: /* kill */ 794 case -ENOENT: 795 case -ESHUTDOWN: 796 return; 797 default: /* error */ 798 cx231xx_isocdbg("urb completion error %d.\n", urb->status); 799 break; 800 } 801 802 /* Copy data from URB */ 803 spin_lock_irqsave(&dev->video_mode.slock, flags); 804 dev->video_mode.isoc_ctl.isoc_copy(dev, urb); 805 spin_unlock_irqrestore(&dev->video_mode.slock, flags); 806 807 /* Reset urb buffers */ 808 for (i = 0; i < urb->number_of_packets; i++) { 809 urb->iso_frame_desc[i].status = 0; 810 urb->iso_frame_desc[i].actual_length = 0; 811 } 812 813 urb->status = usb_submit_urb(urb, GFP_ATOMIC); 814 if (urb->status) { 815 cx231xx_isocdbg("urb resubmit failed (error=%i)\n", 816 urb->status); 817 } 818 } 819 /***************************************************************** 820 * URB Streaming functions * 821 ******************************************************************/ 822 823 /* 824 * IRQ callback, called by URB callback 825 */ 826 static void cx231xx_bulk_irq_callback(struct urb *urb) 827 { 828 struct cx231xx_dmaqueue *dma_q = urb->context; 829 struct cx231xx_video_mode *vmode = 830 container_of(dma_q, struct cx231xx_video_mode, vidq); 831 struct cx231xx *dev = container_of(vmode, struct cx231xx, video_mode); 832 unsigned long flags; 833 834 switch (urb->status) { 835 case 0: /* success */ 836 case -ETIMEDOUT: /* NAK */ 837 break; 838 case -ECONNRESET: /* kill */ 839 case -ENOENT: 840 case -ESHUTDOWN: 841 return; 842 case -EPIPE: /* stall */ 843 cx231xx_isocdbg("urb completion error - device is stalled.\n"); 844 return; 845 default: /* error */ 846 cx231xx_isocdbg("urb completion error %d.\n", urb->status); 847 break; 848 } 849 850 /* Copy data from URB */ 851 spin_lock_irqsave(&dev->video_mode.slock, flags); 852 dev->video_mode.bulk_ctl.bulk_copy(dev, urb); 853 spin_unlock_irqrestore(&dev->video_mode.slock, flags); 854 855 /* Reset urb buffers */ 856 urb->status = usb_submit_urb(urb, GFP_ATOMIC); 857 if (urb->status) { 858 cx231xx_isocdbg("urb resubmit failed (error=%i)\n", 859 urb->status); 860 } 861 } 862 /* 863 * Stop and Deallocate URBs 864 */ 865 void cx231xx_uninit_isoc(struct cx231xx *dev) 866 { 867 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq; 868 struct urb *urb; 869 int i; 870 bool broken_pipe = false; 871 872 cx231xx_isocdbg("cx231xx: called cx231xx_uninit_isoc\n"); 873 874 dev->video_mode.isoc_ctl.nfields = -1; 875 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) { 876 urb = dev->video_mode.isoc_ctl.urb[i]; 877 if (urb) { 878 if (!irqs_disabled()) 879 usb_kill_urb(urb); 880 else 881 usb_unlink_urb(urb); 882 883 if (dev->video_mode.isoc_ctl.transfer_buffer[i]) { 884 usb_free_coherent(dev->udev, 885 urb->transfer_buffer_length, 886 dev->video_mode.isoc_ctl. 887 transfer_buffer[i], 888 urb->transfer_dma); 889 } 890 if (urb->status == -EPIPE) { 891 broken_pipe = true; 892 } 893 usb_free_urb(urb); 894 dev->video_mode.isoc_ctl.urb[i] = NULL; 895 } 896 dev->video_mode.isoc_ctl.transfer_buffer[i] = NULL; 897 } 898 899 if (broken_pipe) { 900 cx231xx_isocdbg("Reset endpoint to recover broken pipe."); 901 usb_reset_endpoint(dev->udev, dev->video_mode.end_point_addr); 902 } 903 kfree(dev->video_mode.isoc_ctl.urb); 904 kfree(dev->video_mode.isoc_ctl.transfer_buffer); 905 kfree(dma_q->p_left_data); 906 907 dev->video_mode.isoc_ctl.urb = NULL; 908 dev->video_mode.isoc_ctl.transfer_buffer = NULL; 909 dev->video_mode.isoc_ctl.num_bufs = 0; 910 dma_q->p_left_data = NULL; 911 912 if (dev->mode_tv == 0) 913 cx231xx_capture_start(dev, 0, Raw_Video); 914 else 915 cx231xx_capture_start(dev, 0, TS1_serial_mode); 916 917 918 } 919 EXPORT_SYMBOL_GPL(cx231xx_uninit_isoc); 920 921 /* 922 * Stop and Deallocate URBs 923 */ 924 void cx231xx_uninit_bulk(struct cx231xx *dev) 925 { 926 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq; 927 struct urb *urb; 928 int i; 929 bool broken_pipe = false; 930 931 cx231xx_isocdbg("cx231xx: called cx231xx_uninit_bulk\n"); 932 933 dev->video_mode.bulk_ctl.nfields = -1; 934 for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) { 935 urb = dev->video_mode.bulk_ctl.urb[i]; 936 if (urb) { 937 if (!irqs_disabled()) 938 usb_kill_urb(urb); 939 else 940 usb_unlink_urb(urb); 941 942 if (dev->video_mode.bulk_ctl.transfer_buffer[i]) { 943 usb_free_coherent(dev->udev, 944 urb->transfer_buffer_length, 945 dev->video_mode.bulk_ctl. 946 transfer_buffer[i], 947 urb->transfer_dma); 948 } 949 if (urb->status == -EPIPE) { 950 broken_pipe = true; 951 } 952 usb_free_urb(urb); 953 dev->video_mode.bulk_ctl.urb[i] = NULL; 954 } 955 dev->video_mode.bulk_ctl.transfer_buffer[i] = NULL; 956 } 957 958 if (broken_pipe) { 959 cx231xx_isocdbg("Reset endpoint to recover broken pipe."); 960 usb_reset_endpoint(dev->udev, dev->video_mode.end_point_addr); 961 } 962 kfree(dev->video_mode.bulk_ctl.urb); 963 kfree(dev->video_mode.bulk_ctl.transfer_buffer); 964 kfree(dma_q->p_left_data); 965 966 dev->video_mode.bulk_ctl.urb = NULL; 967 dev->video_mode.bulk_ctl.transfer_buffer = NULL; 968 dev->video_mode.bulk_ctl.num_bufs = 0; 969 dma_q->p_left_data = NULL; 970 971 if (dev->mode_tv == 0) 972 cx231xx_capture_start(dev, 0, Raw_Video); 973 else 974 cx231xx_capture_start(dev, 0, TS1_serial_mode); 975 976 977 } 978 EXPORT_SYMBOL_GPL(cx231xx_uninit_bulk); 979 980 /* 981 * Allocate URBs and start IRQ 982 */ 983 int cx231xx_init_isoc(struct cx231xx *dev, int max_packets, 984 int num_bufs, int max_pkt_size, 985 int (*isoc_copy) (struct cx231xx *dev, struct urb *urb)) 986 { 987 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq; 988 int i; 989 int sb_size, pipe; 990 struct urb *urb; 991 int j, k; 992 int rc; 993 994 /* De-allocates all pending stuff */ 995 cx231xx_uninit_isoc(dev); 996 997 dma_q->p_left_data = kzalloc(4096, GFP_KERNEL); 998 if (dma_q->p_left_data == NULL) 999 return -ENOMEM; 1000 1001 dev->video_mode.isoc_ctl.isoc_copy = isoc_copy; 1002 dev->video_mode.isoc_ctl.num_bufs = num_bufs; 1003 dma_q->pos = 0; 1004 dma_q->is_partial_line = 0; 1005 dma_q->last_sav = 0; 1006 dma_q->current_field = -1; 1007 dma_q->field1_done = 0; 1008 dma_q->lines_per_field = dev->height / 2; 1009 dma_q->bytes_left_in_line = dev->width << 1; 1010 dma_q->lines_completed = 0; 1011 dma_q->mpeg_buffer_done = 0; 1012 dma_q->left_data_count = 0; 1013 dma_q->mpeg_buffer_completed = 0; 1014 dma_q->add_ps_package_head = CX231XX_NEED_ADD_PS_PACKAGE_HEAD; 1015 dma_q->ps_head[0] = 0x00; 1016 dma_q->ps_head[1] = 0x00; 1017 dma_q->ps_head[2] = 0x01; 1018 dma_q->ps_head[3] = 0xBA; 1019 for (i = 0; i < 8; i++) 1020 dma_q->partial_buf[i] = 0; 1021 1022 dev->video_mode.isoc_ctl.urb = 1023 kcalloc(num_bufs, sizeof(void *), GFP_KERNEL); 1024 if (!dev->video_mode.isoc_ctl.urb) { 1025 dev_err(dev->dev, 1026 "cannot alloc memory for usb buffers\n"); 1027 kfree(dma_q->p_left_data); 1028 return -ENOMEM; 1029 } 1030 1031 dev->video_mode.isoc_ctl.transfer_buffer = 1032 kcalloc(num_bufs, sizeof(void *), GFP_KERNEL); 1033 if (!dev->video_mode.isoc_ctl.transfer_buffer) { 1034 dev_err(dev->dev, 1035 "cannot allocate memory for usbtransfer\n"); 1036 kfree(dev->video_mode.isoc_ctl.urb); 1037 kfree(dma_q->p_left_data); 1038 return -ENOMEM; 1039 } 1040 1041 dev->video_mode.isoc_ctl.max_pkt_size = max_pkt_size; 1042 dev->video_mode.isoc_ctl.buf = NULL; 1043 1044 sb_size = max_packets * dev->video_mode.isoc_ctl.max_pkt_size; 1045 1046 if (dev->mode_tv == 1) 1047 dev->video_mode.end_point_addr = 0x81; 1048 else 1049 dev->video_mode.end_point_addr = 0x84; 1050 1051 1052 /* allocate urbs and transfer buffers */ 1053 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) { 1054 urb = usb_alloc_urb(max_packets, GFP_KERNEL); 1055 if (!urb) { 1056 cx231xx_uninit_isoc(dev); 1057 return -ENOMEM; 1058 } 1059 dev->video_mode.isoc_ctl.urb[i] = urb; 1060 1061 dev->video_mode.isoc_ctl.transfer_buffer[i] = 1062 usb_alloc_coherent(dev->udev, sb_size, GFP_KERNEL, 1063 &urb->transfer_dma); 1064 if (!dev->video_mode.isoc_ctl.transfer_buffer[i]) { 1065 dev_err(dev->dev, 1066 "unable to allocate %i bytes for transfer buffer %i\n", 1067 sb_size, i); 1068 cx231xx_uninit_isoc(dev); 1069 return -ENOMEM; 1070 } 1071 memset(dev->video_mode.isoc_ctl.transfer_buffer[i], 0, sb_size); 1072 1073 pipe = 1074 usb_rcvisocpipe(dev->udev, dev->video_mode.end_point_addr); 1075 1076 usb_fill_int_urb(urb, dev->udev, pipe, 1077 dev->video_mode.isoc_ctl.transfer_buffer[i], 1078 sb_size, cx231xx_isoc_irq_callback, dma_q, 1); 1079 1080 urb->number_of_packets = max_packets; 1081 urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP; 1082 1083 k = 0; 1084 for (j = 0; j < max_packets; j++) { 1085 urb->iso_frame_desc[j].offset = k; 1086 urb->iso_frame_desc[j].length = 1087 dev->video_mode.isoc_ctl.max_pkt_size; 1088 k += dev->video_mode.isoc_ctl.max_pkt_size; 1089 } 1090 } 1091 1092 init_waitqueue_head(&dma_q->wq); 1093 1094 /* submit urbs and enables IRQ */ 1095 for (i = 0; i < dev->video_mode.isoc_ctl.num_bufs; i++) { 1096 rc = usb_submit_urb(dev->video_mode.isoc_ctl.urb[i], 1097 GFP_ATOMIC); 1098 if (rc) { 1099 dev_err(dev->dev, 1100 "submit of urb %i failed (error=%i)\n", i, 1101 rc); 1102 cx231xx_uninit_isoc(dev); 1103 return rc; 1104 } 1105 } 1106 1107 if (dev->mode_tv == 0) 1108 cx231xx_capture_start(dev, 1, Raw_Video); 1109 else 1110 cx231xx_capture_start(dev, 1, TS1_serial_mode); 1111 1112 return 0; 1113 } 1114 EXPORT_SYMBOL_GPL(cx231xx_init_isoc); 1115 1116 /* 1117 * Allocate URBs and start IRQ 1118 */ 1119 int cx231xx_init_bulk(struct cx231xx *dev, int max_packets, 1120 int num_bufs, int max_pkt_size, 1121 int (*bulk_copy) (struct cx231xx *dev, struct urb *urb)) 1122 { 1123 struct cx231xx_dmaqueue *dma_q = &dev->video_mode.vidq; 1124 int i; 1125 int sb_size, pipe; 1126 struct urb *urb; 1127 int rc; 1128 1129 dev->video_input = dev->video_input > 2 ? 2 : dev->video_input; 1130 1131 cx231xx_coredbg("Setting Video mux to %d\n", dev->video_input); 1132 1133 video_mux(dev, dev->video_input); 1134 1135 /* De-allocates all pending stuff */ 1136 cx231xx_uninit_bulk(dev); 1137 1138 dev->video_mode.bulk_ctl.bulk_copy = bulk_copy; 1139 dev->video_mode.bulk_ctl.num_bufs = num_bufs; 1140 dma_q->pos = 0; 1141 dma_q->is_partial_line = 0; 1142 dma_q->last_sav = 0; 1143 dma_q->current_field = -1; 1144 dma_q->field1_done = 0; 1145 dma_q->lines_per_field = dev->height / 2; 1146 dma_q->bytes_left_in_line = dev->width << 1; 1147 dma_q->lines_completed = 0; 1148 dma_q->mpeg_buffer_done = 0; 1149 dma_q->left_data_count = 0; 1150 dma_q->mpeg_buffer_completed = 0; 1151 dma_q->ps_head[0] = 0x00; 1152 dma_q->ps_head[1] = 0x00; 1153 dma_q->ps_head[2] = 0x01; 1154 dma_q->ps_head[3] = 0xBA; 1155 for (i = 0; i < 8; i++) 1156 dma_q->partial_buf[i] = 0; 1157 1158 dev->video_mode.bulk_ctl.urb = 1159 kcalloc(num_bufs, sizeof(void *), GFP_KERNEL); 1160 if (!dev->video_mode.bulk_ctl.urb) { 1161 dev_err(dev->dev, 1162 "cannot alloc memory for usb buffers\n"); 1163 return -ENOMEM; 1164 } 1165 1166 dev->video_mode.bulk_ctl.transfer_buffer = 1167 kcalloc(num_bufs, sizeof(void *), GFP_KERNEL); 1168 if (!dev->video_mode.bulk_ctl.transfer_buffer) { 1169 dev_err(dev->dev, 1170 "cannot allocate memory for usbtransfer\n"); 1171 kfree(dev->video_mode.bulk_ctl.urb); 1172 return -ENOMEM; 1173 } 1174 1175 dev->video_mode.bulk_ctl.max_pkt_size = max_pkt_size; 1176 dev->video_mode.bulk_ctl.buf = NULL; 1177 1178 sb_size = max_packets * dev->video_mode.bulk_ctl.max_pkt_size; 1179 1180 if (dev->mode_tv == 1) 1181 dev->video_mode.end_point_addr = 0x81; 1182 else 1183 dev->video_mode.end_point_addr = 0x84; 1184 1185 1186 /* allocate urbs and transfer buffers */ 1187 for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) { 1188 urb = usb_alloc_urb(0, GFP_KERNEL); 1189 if (!urb) { 1190 cx231xx_uninit_bulk(dev); 1191 return -ENOMEM; 1192 } 1193 dev->video_mode.bulk_ctl.urb[i] = urb; 1194 urb->transfer_flags = URB_NO_TRANSFER_DMA_MAP; 1195 1196 dev->video_mode.bulk_ctl.transfer_buffer[i] = 1197 usb_alloc_coherent(dev->udev, sb_size, GFP_KERNEL, 1198 &urb->transfer_dma); 1199 if (!dev->video_mode.bulk_ctl.transfer_buffer[i]) { 1200 dev_err(dev->dev, 1201 "unable to allocate %i bytes for transfer buffer %i\n", 1202 sb_size, i); 1203 cx231xx_uninit_bulk(dev); 1204 return -ENOMEM; 1205 } 1206 memset(dev->video_mode.bulk_ctl.transfer_buffer[i], 0, sb_size); 1207 1208 pipe = usb_rcvbulkpipe(dev->udev, 1209 dev->video_mode.end_point_addr); 1210 usb_fill_bulk_urb(urb, dev->udev, pipe, 1211 dev->video_mode.bulk_ctl.transfer_buffer[i], 1212 sb_size, cx231xx_bulk_irq_callback, dma_q); 1213 } 1214 1215 /* clear halt */ 1216 rc = usb_clear_halt(dev->udev, dev->video_mode.bulk_ctl.urb[0]->pipe); 1217 if (rc < 0) { 1218 dev_err(dev->dev, 1219 "failed to clear USB bulk endpoint stall/halt condition (error=%i)\n", 1220 rc); 1221 cx231xx_uninit_bulk(dev); 1222 return rc; 1223 } 1224 1225 init_waitqueue_head(&dma_q->wq); 1226 1227 /* submit urbs and enables IRQ */ 1228 for (i = 0; i < dev->video_mode.bulk_ctl.num_bufs; i++) { 1229 rc = usb_submit_urb(dev->video_mode.bulk_ctl.urb[i], 1230 GFP_ATOMIC); 1231 if (rc) { 1232 dev_err(dev->dev, 1233 "submit of urb %i failed (error=%i)\n", i, rc); 1234 cx231xx_uninit_bulk(dev); 1235 return rc; 1236 } 1237 } 1238 1239 if (dev->mode_tv == 0) 1240 cx231xx_capture_start(dev, 1, Raw_Video); 1241 else 1242 cx231xx_capture_start(dev, 1, TS1_serial_mode); 1243 1244 return 0; 1245 } 1246 EXPORT_SYMBOL_GPL(cx231xx_init_bulk); 1247 void cx231xx_stop_TS1(struct cx231xx *dev) 1248 { 1249 u8 val[4] = { 0, 0, 0, 0 }; 1250 1251 val[0] = 0x00; 1252 val[1] = 0x03; 1253 val[2] = 0x00; 1254 val[3] = 0x00; 1255 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 1256 TS_MODE_REG, val, 4); 1257 1258 val[0] = 0x00; 1259 val[1] = 0x70; 1260 val[2] = 0x04; 1261 val[3] = 0x00; 1262 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 1263 TS1_CFG_REG, val, 4); 1264 } 1265 /* EXPORT_SYMBOL_GPL(cx231xx_stop_TS1); */ 1266 void cx231xx_start_TS1(struct cx231xx *dev) 1267 { 1268 u8 val[4] = { 0, 0, 0, 0 }; 1269 1270 val[0] = 0x03; 1271 val[1] = 0x03; 1272 val[2] = 0x00; 1273 val[3] = 0x00; 1274 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 1275 TS_MODE_REG, val, 4); 1276 1277 val[0] = 0x04; 1278 val[1] = 0xA3; 1279 val[2] = 0x3B; 1280 val[3] = 0x00; 1281 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, 1282 TS1_CFG_REG, val, 4); 1283 } 1284 /* EXPORT_SYMBOL_GPL(cx231xx_start_TS1); */ 1285 /***************************************************************** 1286 * Device Init/UnInit functions * 1287 ******************************************************************/ 1288 int cx231xx_dev_init(struct cx231xx *dev) 1289 { 1290 int errCode = 0; 1291 1292 /* Initialize I2C bus */ 1293 1294 /* External Master 1 Bus */ 1295 dev->i2c_bus[0].nr = 0; 1296 dev->i2c_bus[0].dev = dev; 1297 dev->i2c_bus[0].i2c_period = I2C_SPEED_100K; /* 100 KHz */ 1298 dev->i2c_bus[0].i2c_nostop = 0; 1299 dev->i2c_bus[0].i2c_reserve = 0; 1300 dev->i2c_bus[0].i2c_rc = -ENODEV; 1301 1302 /* External Master 2 Bus */ 1303 dev->i2c_bus[1].nr = 1; 1304 dev->i2c_bus[1].dev = dev; 1305 dev->i2c_bus[1].i2c_period = I2C_SPEED_100K; /* 100 KHz */ 1306 dev->i2c_bus[1].i2c_nostop = 0; 1307 dev->i2c_bus[1].i2c_reserve = 0; 1308 dev->i2c_bus[1].i2c_rc = -ENODEV; 1309 1310 /* Internal Master 3 Bus */ 1311 dev->i2c_bus[2].nr = 2; 1312 dev->i2c_bus[2].dev = dev; 1313 dev->i2c_bus[2].i2c_period = I2C_SPEED_100K; /* 100kHz */ 1314 dev->i2c_bus[2].i2c_nostop = 0; 1315 dev->i2c_bus[2].i2c_reserve = 0; 1316 dev->i2c_bus[2].i2c_rc = -ENODEV; 1317 1318 /* register I2C buses */ 1319 errCode = cx231xx_i2c_register(&dev->i2c_bus[0]); 1320 if (errCode < 0) 1321 return errCode; 1322 errCode = cx231xx_i2c_register(&dev->i2c_bus[1]); 1323 if (errCode < 0) 1324 return errCode; 1325 errCode = cx231xx_i2c_register(&dev->i2c_bus[2]); 1326 if (errCode < 0) 1327 return errCode; 1328 1329 errCode = cx231xx_i2c_mux_create(dev); 1330 if (errCode < 0) { 1331 dev_err(dev->dev, 1332 "%s: Failed to create I2C mux\n", __func__); 1333 return errCode; 1334 } 1335 errCode = cx231xx_i2c_mux_register(dev, 0); 1336 if (errCode < 0) 1337 return errCode; 1338 1339 errCode = cx231xx_i2c_mux_register(dev, 1); 1340 if (errCode < 0) 1341 return errCode; 1342 1343 /* scan the real bus segments in the order of physical port numbers */ 1344 cx231xx_do_i2c_scan(dev, I2C_0); 1345 cx231xx_do_i2c_scan(dev, I2C_1_MUX_1); 1346 cx231xx_do_i2c_scan(dev, I2C_2); 1347 cx231xx_do_i2c_scan(dev, I2C_1_MUX_3); 1348 1349 /* init hardware */ 1350 /* Note : with out calling set power mode function, 1351 afe can not be set up correctly */ 1352 if (dev->board.external_av) { 1353 errCode = cx231xx_set_power_mode(dev, 1354 POLARIS_AVMODE_ENXTERNAL_AV); 1355 if (errCode < 0) { 1356 dev_err(dev->dev, 1357 "%s: Failed to set Power - errCode [%d]!\n", 1358 __func__, errCode); 1359 return errCode; 1360 } 1361 } else { 1362 errCode = cx231xx_set_power_mode(dev, 1363 POLARIS_AVMODE_ANALOGT_TV); 1364 if (errCode < 0) { 1365 dev_err(dev->dev, 1366 "%s: Failed to set Power - errCode [%d]!\n", 1367 __func__, errCode); 1368 return errCode; 1369 } 1370 } 1371 1372 /* reset the Tuner, if it is a Xceive tuner */ 1373 if ((dev->board.tuner_type == TUNER_XC5000) || 1374 (dev->board.tuner_type == TUNER_XC2028)) 1375 cx231xx_gpio_set(dev, dev->board.tuner_gpio); 1376 1377 /* initialize Colibri block */ 1378 errCode = cx231xx_afe_init_super_block(dev, 0x23c); 1379 if (errCode < 0) { 1380 dev_err(dev->dev, 1381 "%s: cx231xx_afe init super block - errCode [%d]!\n", 1382 __func__, errCode); 1383 return errCode; 1384 } 1385 errCode = cx231xx_afe_init_channels(dev); 1386 if (errCode < 0) { 1387 dev_err(dev->dev, 1388 "%s: cx231xx_afe init channels - errCode [%d]!\n", 1389 __func__, errCode); 1390 return errCode; 1391 } 1392 1393 /* Set DIF in By pass mode */ 1394 errCode = cx231xx_dif_set_standard(dev, DIF_USE_BASEBAND); 1395 if (errCode < 0) { 1396 dev_err(dev->dev, 1397 "%s: cx231xx_dif set to By pass mode - errCode [%d]!\n", 1398 __func__, errCode); 1399 return errCode; 1400 } 1401 1402 /* I2S block related functions */ 1403 errCode = cx231xx_i2s_blk_initialize(dev); 1404 if (errCode < 0) { 1405 dev_err(dev->dev, 1406 "%s: cx231xx_i2s block initialize - errCode [%d]!\n", 1407 __func__, errCode); 1408 return errCode; 1409 } 1410 1411 /* init control pins */ 1412 errCode = cx231xx_init_ctrl_pin_status(dev); 1413 if (errCode < 0) { 1414 dev_err(dev->dev, 1415 "%s: cx231xx_init ctrl pins - errCode [%d]!\n", 1416 __func__, errCode); 1417 return errCode; 1418 } 1419 1420 /* set AGC mode to Analog */ 1421 switch (dev->model) { 1422 case CX231XX_BOARD_CNXT_CARRAERA: 1423 case CX231XX_BOARD_CNXT_RDE_250: 1424 case CX231XX_BOARD_CNXT_SHELBY: 1425 case CX231XX_BOARD_CNXT_RDU_250: 1426 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 1); 1427 break; 1428 case CX231XX_BOARD_CNXT_RDE_253S: 1429 case CX231XX_BOARD_CNXT_RDU_253S: 1430 case CX231XX_BOARD_HAUPPAUGE_EXETER: 1431 case CX231XX_BOARD_HAUPPAUGE_930C_HD_1113xx: 1432 case CX231XX_BOARD_PV_PLAYTV_USB_HYBRID: 1433 case CX231XX_BOARD_HAUPPAUGE_USB2_FM_PAL: 1434 case CX231XX_BOARD_HAUPPAUGE_USB2_FM_NTSC: 1435 errCode = cx231xx_set_agc_analog_digital_mux_select(dev, 0); 1436 break; 1437 default: 1438 break; 1439 } 1440 if (errCode < 0) { 1441 dev_err(dev->dev, 1442 "%s: cx231xx_AGC mode to Analog - errCode [%d]!\n", 1443 __func__, errCode); 1444 return errCode; 1445 } 1446 1447 /* set all alternate settings to zero initially */ 1448 cx231xx_set_alt_setting(dev, INDEX_VIDEO, 0); 1449 cx231xx_set_alt_setting(dev, INDEX_VANC, 0); 1450 cx231xx_set_alt_setting(dev, INDEX_HANC, 0); 1451 if (dev->board.has_dvb) 1452 cx231xx_set_alt_setting(dev, INDEX_TS1, 0); 1453 1454 errCode = 0; 1455 return errCode; 1456 } 1457 EXPORT_SYMBOL_GPL(cx231xx_dev_init); 1458 1459 void cx231xx_dev_uninit(struct cx231xx *dev) 1460 { 1461 /* Un Initialize I2C bus */ 1462 cx231xx_i2c_mux_unregister(dev); 1463 cx231xx_i2c_unregister(&dev->i2c_bus[2]); 1464 cx231xx_i2c_unregister(&dev->i2c_bus[1]); 1465 cx231xx_i2c_unregister(&dev->i2c_bus[0]); 1466 } 1467 EXPORT_SYMBOL_GPL(cx231xx_dev_uninit); 1468 1469 /***************************************************************** 1470 * G P I O related functions * 1471 ******************************************************************/ 1472 int cx231xx_send_gpio_cmd(struct cx231xx *dev, u32 gpio_bit, u8 *gpio_val, 1473 u8 len, u8 request, u8 direction) 1474 { 1475 int status = 0; 1476 struct VENDOR_REQUEST_IN ven_req; 1477 1478 /* Set wValue */ 1479 ven_req.wValue = (u16) (gpio_bit >> 16 & 0xffff); 1480 1481 /* set request */ 1482 if (!request) { 1483 if (direction) 1484 ven_req.bRequest = VRT_GET_GPIO; /* 0x9 gpio */ 1485 else 1486 ven_req.bRequest = VRT_SET_GPIO; /* 0x8 gpio */ 1487 } else { 1488 if (direction) 1489 ven_req.bRequest = VRT_GET_GPIE; /* 0xb gpie */ 1490 else 1491 ven_req.bRequest = VRT_SET_GPIE; /* 0xa gpie */ 1492 } 1493 1494 /* set index value */ 1495 ven_req.wIndex = (u16) (gpio_bit & 0xffff); 1496 1497 /* set wLength value */ 1498 ven_req.wLength = len; 1499 1500 /* set bData value */ 1501 ven_req.bData = 0; 1502 1503 /* set the buffer for read / write */ 1504 ven_req.pBuff = gpio_val; 1505 1506 /* set the direction */ 1507 if (direction) { 1508 ven_req.direction = USB_DIR_IN; 1509 memset(ven_req.pBuff, 0x00, ven_req.wLength); 1510 } else 1511 ven_req.direction = USB_DIR_OUT; 1512 1513 1514 /* call common vendor command request */ 1515 status = cx231xx_send_vendor_cmd(dev, &ven_req); 1516 if (status < 0) { 1517 dev_err(dev->dev, "%s: failed with status -%d\n", 1518 __func__, status); 1519 } 1520 1521 return status; 1522 } 1523 EXPORT_SYMBOL_GPL(cx231xx_send_gpio_cmd); 1524 1525 /***************************************************************** 1526 * C O N T R O L - Register R E A D / W R I T E functions * 1527 *****************************************************************/ 1528 int cx231xx_mode_register(struct cx231xx *dev, u16 address, u32 mode) 1529 { 1530 u8 value[4] = { 0x0, 0x0, 0x0, 0x0 }; 1531 u32 tmp = 0; 1532 int status = 0; 1533 1534 status = 1535 cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, address, value, 4); 1536 if (status < 0) 1537 return status; 1538 1539 tmp = le32_to_cpu(*((__le32 *) value)); 1540 tmp |= mode; 1541 1542 value[0] = (u8) tmp; 1543 value[1] = (u8) (tmp >> 8); 1544 value[2] = (u8) (tmp >> 16); 1545 value[3] = (u8) (tmp >> 24); 1546 1547 status = 1548 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, address, value, 4); 1549 1550 return status; 1551 } 1552 1553 /***************************************************************** 1554 * I 2 C Internal C O N T R O L functions * 1555 *****************************************************************/ 1556 int cx231xx_read_i2c_master(struct cx231xx *dev, u8 dev_addr, u16 saddr, 1557 u8 saddr_len, u32 *data, u8 data_len, int master) 1558 { 1559 int status = 0; 1560 struct cx231xx_i2c_xfer_data req_data; 1561 u8 value[64] = "0"; 1562 1563 if (saddr_len == 0) 1564 saddr = 0; 1565 else if (saddr_len == 1) 1566 saddr &= 0xff; 1567 1568 /* prepare xfer_data struct */ 1569 req_data.dev_addr = dev_addr >> 1; 1570 req_data.direction = I2C_M_RD; 1571 req_data.saddr_len = saddr_len; 1572 req_data.saddr_dat = saddr; 1573 req_data.buf_size = data_len; 1574 req_data.p_buffer = (u8 *) value; 1575 1576 /* usb send command */ 1577 if (master == 0) 1578 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], 1579 &req_data); 1580 else if (master == 1) 1581 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[1], 1582 &req_data); 1583 else if (master == 2) 1584 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[2], 1585 &req_data); 1586 1587 if (status >= 0) { 1588 /* Copy the data read back to main buffer */ 1589 if (data_len == 1) 1590 *data = value[0]; 1591 else if (data_len == 4) 1592 *data = 1593 value[0] | value[1] << 8 | value[2] << 16 | value[3] 1594 << 24; 1595 else if (data_len > 4) 1596 *data = value[saddr]; 1597 } 1598 1599 return status; 1600 } 1601 1602 int cx231xx_write_i2c_master(struct cx231xx *dev, u8 dev_addr, u16 saddr, 1603 u8 saddr_len, u32 data, u8 data_len, int master) 1604 { 1605 int status = 0; 1606 u8 value[4] = { 0, 0, 0, 0 }; 1607 struct cx231xx_i2c_xfer_data req_data; 1608 1609 value[0] = (u8) data; 1610 value[1] = (u8) (data >> 8); 1611 value[2] = (u8) (data >> 16); 1612 value[3] = (u8) (data >> 24); 1613 1614 if (saddr_len == 0) 1615 saddr = 0; 1616 else if (saddr_len == 1) 1617 saddr &= 0xff; 1618 1619 /* prepare xfer_data struct */ 1620 req_data.dev_addr = dev_addr >> 1; 1621 req_data.direction = 0; 1622 req_data.saddr_len = saddr_len; 1623 req_data.saddr_dat = saddr; 1624 req_data.buf_size = data_len; 1625 req_data.p_buffer = value; 1626 1627 /* usb send command */ 1628 if (master == 0) 1629 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], 1630 &req_data); 1631 else if (master == 1) 1632 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[1], 1633 &req_data); 1634 else if (master == 2) 1635 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[2], 1636 &req_data); 1637 1638 return status; 1639 } 1640 1641 int cx231xx_read_i2c_data(struct cx231xx *dev, u8 dev_addr, u16 saddr, 1642 u8 saddr_len, u32 *data, u8 data_len) 1643 { 1644 int status = 0; 1645 struct cx231xx_i2c_xfer_data req_data; 1646 u8 value[4] = { 0, 0, 0, 0 }; 1647 1648 if (saddr_len == 0) 1649 saddr = 0; 1650 else if (saddr_len == 1) 1651 saddr &= 0xff; 1652 1653 /* prepare xfer_data struct */ 1654 req_data.dev_addr = dev_addr >> 1; 1655 req_data.direction = I2C_M_RD; 1656 req_data.saddr_len = saddr_len; 1657 req_data.saddr_dat = saddr; 1658 req_data.buf_size = data_len; 1659 req_data.p_buffer = (u8 *) value; 1660 1661 /* usb send command */ 1662 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], &req_data); 1663 1664 if (status >= 0) { 1665 /* Copy the data read back to main buffer */ 1666 if (data_len == 1) 1667 *data = value[0]; 1668 else 1669 *data = 1670 value[0] | value[1] << 8 | value[2] << 16 | value[3] 1671 << 24; 1672 } 1673 1674 return status; 1675 } 1676 1677 int cx231xx_write_i2c_data(struct cx231xx *dev, u8 dev_addr, u16 saddr, 1678 u8 saddr_len, u32 data, u8 data_len) 1679 { 1680 int status = 0; 1681 u8 value[4] = { 0, 0, 0, 0 }; 1682 struct cx231xx_i2c_xfer_data req_data; 1683 1684 value[0] = (u8) data; 1685 value[1] = (u8) (data >> 8); 1686 value[2] = (u8) (data >> 16); 1687 value[3] = (u8) (data >> 24); 1688 1689 if (saddr_len == 0) 1690 saddr = 0; 1691 else if (saddr_len == 1) 1692 saddr &= 0xff; 1693 1694 /* prepare xfer_data struct */ 1695 req_data.dev_addr = dev_addr >> 1; 1696 req_data.direction = 0; 1697 req_data.saddr_len = saddr_len; 1698 req_data.saddr_dat = saddr; 1699 req_data.buf_size = data_len; 1700 req_data.p_buffer = value; 1701 1702 /* usb send command */ 1703 status = dev->cx231xx_send_usb_command(&dev->i2c_bus[0], &req_data); 1704 1705 return status; 1706 } 1707 1708 int cx231xx_reg_mask_write(struct cx231xx *dev, u8 dev_addr, u8 size, 1709 u16 register_address, u8 bit_start, u8 bit_end, 1710 u32 value) 1711 { 1712 int status = 0; 1713 u32 tmp; 1714 u32 mask = 0; 1715 int i; 1716 1717 if (bit_start > (size - 1) || bit_end > (size - 1)) 1718 return -1; 1719 1720 if (size == 8) { 1721 status = 1722 cx231xx_read_i2c_data(dev, dev_addr, register_address, 2, 1723 &tmp, 1); 1724 } else { 1725 status = 1726 cx231xx_read_i2c_data(dev, dev_addr, register_address, 2, 1727 &tmp, 4); 1728 } 1729 1730 if (status < 0) 1731 return status; 1732 1733 mask = 1 << bit_end; 1734 for (i = bit_end; i > bit_start && i > 0; i--) 1735 mask = mask + (1 << (i - 1)); 1736 1737 value <<= bit_start; 1738 1739 if (size == 8) { 1740 tmp &= ~mask; 1741 tmp |= value; 1742 tmp &= 0xff; 1743 status = 1744 cx231xx_write_i2c_data(dev, dev_addr, register_address, 2, 1745 tmp, 1); 1746 } else { 1747 tmp &= ~mask; 1748 tmp |= value; 1749 status = 1750 cx231xx_write_i2c_data(dev, dev_addr, register_address, 2, 1751 tmp, 4); 1752 } 1753 1754 return status; 1755 } 1756 1757 int cx231xx_read_modify_write_i2c_dword(struct cx231xx *dev, u8 dev_addr, 1758 u16 saddr, u32 mask, u32 value) 1759 { 1760 u32 temp; 1761 int status = 0; 1762 1763 status = cx231xx_read_i2c_data(dev, dev_addr, saddr, 2, &temp, 4); 1764 1765 if (status < 0) 1766 return status; 1767 1768 temp &= ~mask; 1769 temp |= value; 1770 1771 status = cx231xx_write_i2c_data(dev, dev_addr, saddr, 2, temp, 4); 1772 1773 return status; 1774 } 1775 1776 u32 cx231xx_set_field(u32 field_mask, u32 data) 1777 { 1778 u32 temp; 1779 1780 for (temp = field_mask; (temp & 1) == 0; temp >>= 1) 1781 data <<= 1; 1782 1783 return data; 1784 } 1785