1 /**************************************************************** 2 3 Siano Mobile Silicon, Inc. 4 MDTV receiver kernel modules. 5 Copyright (C) 2005-2009, Uri Shkolnik, Anatoly Greenblat 6 7 This program is free software: you can redistribute it and/or modify 8 it under the terms of the GNU General Public License as published by 9 the Free Software Foundation, either version 2 of the License, or 10 (at your option) any later version. 11 12 This program is distributed in the hope that it will be useful, 13 but WITHOUT ANY WARRANTY; without even the implied warranty of 14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 GNU General Public License for more details. 16 17 You should have received a copy of the GNU General Public License 18 along with this program. If not, see <http://www.gnu.org/licenses/>. 19 20 ****************************************************************/ 21 22 #include <linux/kernel.h> 23 #include <linux/init.h> 24 #include <linux/usb.h> 25 #include <linux/firmware.h> 26 #include <linux/slab.h> 27 #include <linux/module.h> 28 29 #include "smscoreapi.h" 30 #include "sms-cards.h" 31 #include "smsendian.h" 32 33 static int sms_dbg; 34 module_param_named(debug, sms_dbg, int, 0644); 35 MODULE_PARM_DESC(debug, "set debug level (info=1, adv=2 (or-able))"); 36 37 #define USB1_BUFFER_SIZE 0x1000 38 #define USB2_BUFFER_SIZE 0x4000 39 40 #define MAX_BUFFERS 50 41 #define MAX_URBS 10 42 43 struct smsusb_device_t; 44 45 struct smsusb_urb_t { 46 struct smscore_buffer_t *cb; 47 struct smsusb_device_t *dev; 48 49 struct urb urb; 50 }; 51 52 struct smsusb_device_t { 53 struct usb_device *udev; 54 struct smscore_device_t *coredev; 55 56 struct smsusb_urb_t surbs[MAX_URBS]; 57 58 int response_alignment; 59 int buffer_size; 60 }; 61 62 static int smsusb_submit_urb(struct smsusb_device_t *dev, 63 struct smsusb_urb_t *surb); 64 65 static void smsusb_onresponse(struct urb *urb) 66 { 67 struct smsusb_urb_t *surb = (struct smsusb_urb_t *) urb->context; 68 struct smsusb_device_t *dev = surb->dev; 69 70 if (urb->status == -ESHUTDOWN) { 71 sms_err("error, urb status %d (-ESHUTDOWN), %d bytes", 72 urb->status, urb->actual_length); 73 return; 74 } 75 76 if ((urb->actual_length > 0) && (urb->status == 0)) { 77 struct SmsMsgHdr_ST *phdr = (struct SmsMsgHdr_ST *)surb->cb->p; 78 79 smsendian_handle_message_header(phdr); 80 if (urb->actual_length >= phdr->msgLength) { 81 surb->cb->size = phdr->msgLength; 82 83 if (dev->response_alignment && 84 (phdr->msgFlags & MSG_HDR_FLAG_SPLIT_MSG)) { 85 86 surb->cb->offset = 87 dev->response_alignment + 88 ((phdr->msgFlags >> 8) & 3); 89 90 /* sanity check */ 91 if (((int) phdr->msgLength + 92 surb->cb->offset) > urb->actual_length) { 93 sms_err("invalid response " 94 "msglen %d offset %d " 95 "size %d", 96 phdr->msgLength, 97 surb->cb->offset, 98 urb->actual_length); 99 goto exit_and_resubmit; 100 } 101 102 /* move buffer pointer and 103 * copy header to its new location */ 104 memcpy((char *) phdr + surb->cb->offset, 105 phdr, sizeof(struct SmsMsgHdr_ST)); 106 } else 107 surb->cb->offset = 0; 108 109 smscore_onresponse(dev->coredev, surb->cb); 110 surb->cb = NULL; 111 } else { 112 sms_err("invalid response " 113 "msglen %d actual %d", 114 phdr->msgLength, urb->actual_length); 115 } 116 } else 117 sms_err("error, urb status %d, %d bytes", 118 urb->status, urb->actual_length); 119 120 121 exit_and_resubmit: 122 smsusb_submit_urb(dev, surb); 123 } 124 125 static int smsusb_submit_urb(struct smsusb_device_t *dev, 126 struct smsusb_urb_t *surb) 127 { 128 if (!surb->cb) { 129 surb->cb = smscore_getbuffer(dev->coredev); 130 if (!surb->cb) { 131 sms_err("smscore_getbuffer(...) returned NULL"); 132 return -ENOMEM; 133 } 134 } 135 136 usb_fill_bulk_urb( 137 &surb->urb, 138 dev->udev, 139 usb_rcvbulkpipe(dev->udev, 0x81), 140 surb->cb->p, 141 dev->buffer_size, 142 smsusb_onresponse, 143 surb 144 ); 145 surb->urb.transfer_dma = surb->cb->phys; 146 surb->urb.transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 147 148 return usb_submit_urb(&surb->urb, GFP_ATOMIC); 149 } 150 151 static void smsusb_stop_streaming(struct smsusb_device_t *dev) 152 { 153 int i; 154 155 for (i = 0; i < MAX_URBS; i++) { 156 usb_kill_urb(&dev->surbs[i].urb); 157 158 if (dev->surbs[i].cb) { 159 smscore_putbuffer(dev->coredev, dev->surbs[i].cb); 160 dev->surbs[i].cb = NULL; 161 } 162 } 163 } 164 165 static int smsusb_start_streaming(struct smsusb_device_t *dev) 166 { 167 int i, rc; 168 169 for (i = 0; i < MAX_URBS; i++) { 170 rc = smsusb_submit_urb(dev, &dev->surbs[i]); 171 if (rc < 0) { 172 sms_err("smsusb_submit_urb(...) failed"); 173 smsusb_stop_streaming(dev); 174 break; 175 } 176 } 177 178 return rc; 179 } 180 181 static int smsusb_sendrequest(void *context, void *buffer, size_t size) 182 { 183 struct smsusb_device_t *dev = (struct smsusb_device_t *) context; 184 int dummy; 185 186 smsendian_handle_message_header((struct SmsMsgHdr_ST *)buffer); 187 return usb_bulk_msg(dev->udev, usb_sndbulkpipe(dev->udev, 2), 188 buffer, size, &dummy, 1000); 189 } 190 191 static char *smsusb1_fw_lkup[] = { 192 "dvbt_stellar_usb.inp", 193 "dvbh_stellar_usb.inp", 194 "tdmb_stellar_usb.inp", 195 "none", 196 "dvbt_bda_stellar_usb.inp", 197 }; 198 199 static inline char *sms_get_fw_name(int mode, int board_id) 200 { 201 char **fw = sms_get_board(board_id)->fw; 202 return (fw && fw[mode]) ? fw[mode] : smsusb1_fw_lkup[mode]; 203 } 204 205 static int smsusb1_load_firmware(struct usb_device *udev, int id, int board_id) 206 { 207 const struct firmware *fw; 208 u8 *fw_buffer; 209 int rc, dummy; 210 char *fw_filename; 211 212 if (id < DEVICE_MODE_DVBT || id > DEVICE_MODE_DVBT_BDA) { 213 sms_err("invalid firmware id specified %d", id); 214 return -EINVAL; 215 } 216 217 fw_filename = sms_get_fw_name(id, board_id); 218 219 rc = request_firmware(&fw, fw_filename, &udev->dev); 220 if (rc < 0) { 221 sms_warn("failed to open \"%s\" mode %d, " 222 "trying again with default firmware", fw_filename, id); 223 224 fw_filename = smsusb1_fw_lkup[id]; 225 rc = request_firmware(&fw, fw_filename, &udev->dev); 226 if (rc < 0) { 227 sms_warn("failed to open \"%s\" mode %d", 228 fw_filename, id); 229 230 return rc; 231 } 232 } 233 234 fw_buffer = kmalloc(fw->size, GFP_KERNEL); 235 if (fw_buffer) { 236 memcpy(fw_buffer, fw->data, fw->size); 237 238 rc = usb_bulk_msg(udev, usb_sndbulkpipe(udev, 2), 239 fw_buffer, fw->size, &dummy, 1000); 240 241 sms_info("sent %zd(%d) bytes, rc %d", fw->size, dummy, rc); 242 243 kfree(fw_buffer); 244 } else { 245 sms_err("failed to allocate firmware buffer"); 246 rc = -ENOMEM; 247 } 248 sms_info("read FW %s, size=%zd", fw_filename, fw->size); 249 250 release_firmware(fw); 251 252 return rc; 253 } 254 255 static void smsusb1_detectmode(void *context, int *mode) 256 { 257 char *product_string = 258 ((struct smsusb_device_t *) context)->udev->product; 259 260 *mode = DEVICE_MODE_NONE; 261 262 if (!product_string) { 263 product_string = "none"; 264 sms_err("product string not found"); 265 } else if (strstr(product_string, "DVBH")) 266 *mode = 1; 267 else if (strstr(product_string, "BDA")) 268 *mode = 4; 269 else if (strstr(product_string, "DVBT")) 270 *mode = 0; 271 else if (strstr(product_string, "TDMB")) 272 *mode = 2; 273 274 sms_info("%d \"%s\"", *mode, product_string); 275 } 276 277 static int smsusb1_setmode(void *context, int mode) 278 { 279 struct SmsMsgHdr_ST Msg = { MSG_SW_RELOAD_REQ, 0, HIF_TASK, 280 sizeof(struct SmsMsgHdr_ST), 0 }; 281 282 if (mode < DEVICE_MODE_DVBT || mode > DEVICE_MODE_DVBT_BDA) { 283 sms_err("invalid firmware id specified %d", mode); 284 return -EINVAL; 285 } 286 287 return smsusb_sendrequest(context, &Msg, sizeof(Msg)); 288 } 289 290 static void smsusb_term_device(struct usb_interface *intf) 291 { 292 struct smsusb_device_t *dev = usb_get_intfdata(intf); 293 294 if (dev) { 295 smsusb_stop_streaming(dev); 296 297 /* unregister from smscore */ 298 if (dev->coredev) 299 smscore_unregister_device(dev->coredev); 300 301 sms_info("device %p destroyed", dev); 302 kfree(dev); 303 } 304 305 usb_set_intfdata(intf, NULL); 306 } 307 308 static int smsusb_init_device(struct usb_interface *intf, int board_id) 309 { 310 struct smsdevice_params_t params; 311 struct smsusb_device_t *dev; 312 int i, rc; 313 314 /* create device object */ 315 dev = kzalloc(sizeof(struct smsusb_device_t), GFP_KERNEL); 316 if (!dev) { 317 sms_err("kzalloc(sizeof(struct smsusb_device_t) failed"); 318 return -ENOMEM; 319 } 320 321 memset(¶ms, 0, sizeof(params)); 322 usb_set_intfdata(intf, dev); 323 dev->udev = interface_to_usbdev(intf); 324 325 params.device_type = sms_get_board(board_id)->type; 326 327 switch (params.device_type) { 328 case SMS_STELLAR: 329 dev->buffer_size = USB1_BUFFER_SIZE; 330 331 params.setmode_handler = smsusb1_setmode; 332 params.detectmode_handler = smsusb1_detectmode; 333 break; 334 default: 335 sms_err("Unspecified sms device type!"); 336 /* fall-thru */ 337 case SMS_NOVA_A0: 338 case SMS_NOVA_B0: 339 case SMS_VEGA: 340 dev->buffer_size = USB2_BUFFER_SIZE; 341 dev->response_alignment = 342 le16_to_cpu(dev->udev->ep_in[1]->desc.wMaxPacketSize) - 343 sizeof(struct SmsMsgHdr_ST); 344 345 params.flags |= SMS_DEVICE_FAMILY2; 346 break; 347 } 348 349 params.device = &dev->udev->dev; 350 params.buffer_size = dev->buffer_size; 351 params.num_buffers = MAX_BUFFERS; 352 params.sendrequest_handler = smsusb_sendrequest; 353 params.context = dev; 354 usb_make_path(dev->udev, params.devpath, sizeof(params.devpath)); 355 356 /* register in smscore */ 357 rc = smscore_register_device(¶ms, &dev->coredev); 358 if (rc < 0) { 359 sms_err("smscore_register_device(...) failed, rc %d", rc); 360 smsusb_term_device(intf); 361 return rc; 362 } 363 364 smscore_set_board_id(dev->coredev, board_id); 365 366 /* initialize urbs */ 367 for (i = 0; i < MAX_URBS; i++) { 368 dev->surbs[i].dev = dev; 369 usb_init_urb(&dev->surbs[i].urb); 370 } 371 372 sms_info("smsusb_start_streaming(...)."); 373 rc = smsusb_start_streaming(dev); 374 if (rc < 0) { 375 sms_err("smsusb_start_streaming(...) failed"); 376 smsusb_term_device(intf); 377 return rc; 378 } 379 380 rc = smscore_start_device(dev->coredev); 381 if (rc < 0) { 382 sms_err("smscore_start_device(...) failed"); 383 smsusb_term_device(intf); 384 return rc; 385 } 386 387 sms_info("device %p created", dev); 388 389 return rc; 390 } 391 392 static int __devinit smsusb_probe(struct usb_interface *intf, 393 const struct usb_device_id *id) 394 { 395 struct usb_device *udev = interface_to_usbdev(intf); 396 char devpath[32]; 397 int i, rc; 398 399 rc = usb_clear_halt(udev, usb_rcvbulkpipe(udev, 0x81)); 400 rc = usb_clear_halt(udev, usb_rcvbulkpipe(udev, 0x02)); 401 402 if (intf->num_altsetting > 0) { 403 rc = usb_set_interface( 404 udev, intf->cur_altsetting->desc.bInterfaceNumber, 0); 405 if (rc < 0) { 406 sms_err("usb_set_interface failed, rc %d", rc); 407 return rc; 408 } 409 } 410 411 sms_info("smsusb_probe %d", 412 intf->cur_altsetting->desc.bInterfaceNumber); 413 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) 414 sms_info("endpoint %d %02x %02x %d", i, 415 intf->cur_altsetting->endpoint[i].desc.bEndpointAddress, 416 intf->cur_altsetting->endpoint[i].desc.bmAttributes, 417 intf->cur_altsetting->endpoint[i].desc.wMaxPacketSize); 418 419 if ((udev->actconfig->desc.bNumInterfaces == 2) && 420 (intf->cur_altsetting->desc.bInterfaceNumber == 0)) { 421 sms_err("rom interface 0 is not used"); 422 return -ENODEV; 423 } 424 425 if (intf->cur_altsetting->desc.bInterfaceNumber == 1) { 426 snprintf(devpath, sizeof(devpath), "usb\\%d-%s", 427 udev->bus->busnum, udev->devpath); 428 sms_info("stellar device was found."); 429 return smsusb1_load_firmware( 430 udev, smscore_registry_getmode(devpath), 431 id->driver_info); 432 } 433 434 rc = smsusb_init_device(intf, id->driver_info); 435 sms_info("rc %d", rc); 436 sms_board_load_modules(id->driver_info); 437 return rc; 438 } 439 440 static void smsusb_disconnect(struct usb_interface *intf) 441 { 442 smsusb_term_device(intf); 443 } 444 445 static int smsusb_suspend(struct usb_interface *intf, pm_message_t msg) 446 { 447 struct smsusb_device_t *dev = usb_get_intfdata(intf); 448 printk(KERN_INFO "%s: Entering status %d.\n", __func__, msg.event); 449 smsusb_stop_streaming(dev); 450 return 0; 451 } 452 453 static int smsusb_resume(struct usb_interface *intf) 454 { 455 int rc, i; 456 struct smsusb_device_t *dev = usb_get_intfdata(intf); 457 struct usb_device *udev = interface_to_usbdev(intf); 458 459 printk(KERN_INFO "%s: Entering.\n", __func__); 460 usb_clear_halt(udev, usb_rcvbulkpipe(udev, 0x81)); 461 usb_clear_halt(udev, usb_rcvbulkpipe(udev, 0x02)); 462 463 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) 464 printk(KERN_INFO "endpoint %d %02x %02x %d\n", i, 465 intf->cur_altsetting->endpoint[i].desc.bEndpointAddress, 466 intf->cur_altsetting->endpoint[i].desc.bmAttributes, 467 intf->cur_altsetting->endpoint[i].desc.wMaxPacketSize); 468 469 if (intf->num_altsetting > 0) { 470 rc = usb_set_interface(udev, 471 intf->cur_altsetting->desc. 472 bInterfaceNumber, 0); 473 if (rc < 0) { 474 printk(KERN_INFO "%s usb_set_interface failed, " 475 "rc %d\n", __func__, rc); 476 return rc; 477 } 478 } 479 480 smsusb_start_streaming(dev); 481 return 0; 482 } 483 484 static const struct usb_device_id smsusb_id_table[] = { 485 { USB_DEVICE(0x187f, 0x0010), 486 .driver_info = SMS1XXX_BOARD_SIANO_STELLAR }, 487 { USB_DEVICE(0x187f, 0x0100), 488 .driver_info = SMS1XXX_BOARD_SIANO_STELLAR }, 489 { USB_DEVICE(0x187f, 0x0200), 490 .driver_info = SMS1XXX_BOARD_SIANO_NOVA_A }, 491 { USB_DEVICE(0x187f, 0x0201), 492 .driver_info = SMS1XXX_BOARD_SIANO_NOVA_B }, 493 { USB_DEVICE(0x187f, 0x0300), 494 .driver_info = SMS1XXX_BOARD_SIANO_VEGA }, 495 { USB_DEVICE(0x2040, 0x1700), 496 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_CATAMOUNT }, 497 { USB_DEVICE(0x2040, 0x1800), 498 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_OKEMO_A }, 499 { USB_DEVICE(0x2040, 0x1801), 500 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_OKEMO_B }, 501 { USB_DEVICE(0x2040, 0x2000), 502 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_TIGER_MINICARD }, 503 { USB_DEVICE(0x2040, 0x2009), 504 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_TIGER_MINICARD_R2 }, 505 { USB_DEVICE(0x2040, 0x200a), 506 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_TIGER_MINICARD }, 507 { USB_DEVICE(0x2040, 0x2010), 508 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_TIGER_MINICARD }, 509 { USB_DEVICE(0x2040, 0x2011), 510 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_TIGER_MINICARD }, 511 { USB_DEVICE(0x2040, 0x2019), 512 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_TIGER_MINICARD }, 513 { USB_DEVICE(0x2040, 0x5500), 514 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 515 { USB_DEVICE(0x2040, 0x5510), 516 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 517 { USB_DEVICE(0x2040, 0x5520), 518 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 519 { USB_DEVICE(0x2040, 0x5530), 520 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 521 { USB_DEVICE(0x2040, 0x5580), 522 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 523 { USB_DEVICE(0x2040, 0x5590), 524 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 525 { USB_DEVICE(0x187f, 0x0202), 526 .driver_info = SMS1XXX_BOARD_SIANO_NICE }, 527 { USB_DEVICE(0x187f, 0x0301), 528 .driver_info = SMS1XXX_BOARD_SIANO_VENICE }, 529 { USB_DEVICE(0x2040, 0xb900), 530 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 531 { USB_DEVICE(0x2040, 0xb910), 532 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 533 { USB_DEVICE(0x2040, 0xb980), 534 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 535 { USB_DEVICE(0x2040, 0xb990), 536 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 537 { USB_DEVICE(0x2040, 0xc000), 538 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 539 { USB_DEVICE(0x2040, 0xc010), 540 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 541 { USB_DEVICE(0x2040, 0xc080), 542 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 543 { USB_DEVICE(0x2040, 0xc090), 544 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 545 { USB_DEVICE(0x2040, 0xc0a0), 546 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 547 { USB_DEVICE(0x2040, 0xf5a0), 548 .driver_info = SMS1XXX_BOARD_HAUPPAUGE_WINDHAM }, 549 { } /* Terminating entry */ 550 }; 551 552 MODULE_DEVICE_TABLE(usb, smsusb_id_table); 553 554 static struct usb_driver smsusb_driver = { 555 .name = "smsusb", 556 .probe = smsusb_probe, 557 .disconnect = smsusb_disconnect, 558 .id_table = smsusb_id_table, 559 560 .suspend = smsusb_suspend, 561 .resume = smsusb_resume, 562 }; 563 564 module_usb_driver(smsusb_driver); 565 566 MODULE_DESCRIPTION("Driver for the Siano SMS1xxx USB dongle"); 567 MODULE_AUTHOR("Siano Mobile Silicon, INC. (uris@siano-ms.com)"); 568 MODULE_LICENSE("GPL"); 569