drivers/media/dvb/siano/smsusb.c

   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
  28 #include "smscoreapi.h"
  29 #include "sms-cards.h"
  30 #include "smsendian.h"
  31
  32 static int sms_dbg;
  33 module_param_named(debug, sms_dbg, int, 0644);
  34 MODULE_PARM_DESC(debug, "set debug level (info=1, adv=2 (or-able))");
  35
  36 #define USB1_BUFFER_SIZE                0x1000
  37 #define USB2_BUFFER_SIZE                0x4000
  38
  39 #define MAX_BUFFERS             50
  40 #define MAX_URBS                10
  41
  42 struct smsusb_device_t;
  43
  44 struct smsusb_urb_t {
  45         struct smscore_buffer_t *cb;
  46         struct smsusb_device_t  *dev;
  47
  48         struct urb urb;
  49 };
  50
  51 struct smsusb_device_t {
  52         struct usb_device *udev;
  53         struct smscore_device_t *coredev;
  54
  55         struct smsusb_urb_t     surbs[MAX_URBS];
  56
  57         int             response_alignment;
  58         int             buffer_size;
  59 };
  60
  61 static int smsusb_submit_urb(struct smsusb_device_t *dev,
  62                              struct smsusb_urb_t *surb);
  63
  64 static void smsusb_onresponse(struct urb *urb)
  65 {
  66         struct smsusb_urb_t *surb = (struct smsusb_urb_t *) urb->context;
  67         struct smsusb_device_t *dev = surb->dev;
  68
  69         if (urb->status == -ESHUTDOWN) {
  70                 sms_err("error, urb status %d (-ESHUTDOWN), %d bytes",
  71                         urb->status, urb->actual_length);
  72                 return;
  73         }
  74
  75         if ((urb->actual_length > 0) && (urb->status == 0)) {
  76                 struct SmsMsgHdr_ST *phdr = (struct SmsMsgHdr_ST *)surb->cb->p;
  77
  78                 smsendian_handle_message_header(phdr);
  79                 if (urb->actual_length >= phdr->msgLength) {
  80                         surb->cb->size = phdr->msgLength;
  81
  82                         if (dev->response_alignment &&
  83                             (phdr->msgFlags & MSG_HDR_FLAG_SPLIT_MSG)) {
  84
  85                                 surb->cb->offset =
  86                                         dev->response_alignment +
  87                                         ((phdr->msgFlags >> 8) & 3);
  88
  89                                 /* sanity check */
  90                                 if (((int) phdr->msgLength +
  91                                      surb->cb->offset) > urb->actual_length) {
  92                                         sms_err("invalid response "
  93                                                 "msglen %d offset %d "
  94                                                 "size %d",
  95                                                 phdr->msgLength,
  96                                                 surb->cb->offset,
  97                                                 urb->actual_length);
  98                                         goto exit_and_resubmit;
  99                                 }
 100
 101                                 /* move buffer pointer and
 102                                  * copy header to its new location */
 103                                 memcpy((char *) phdr + surb->cb->offset,
 104                                        phdr, sizeof(struct SmsMsgHdr_ST));
 105                         } else
 106                                 surb->cb->offset = 0;
 107
 108                         smscore_onresponse(dev->coredev, surb->cb);
 109                         surb->cb = NULL;
 110                 } else {
 111                         sms_err("invalid response "
 112                                 "msglen %d actual %d",
 113                                 phdr->msgLength, urb->actual_length);
 114                 }
 115         } else
 116                 sms_err("error, urb status %d, %d bytes",
 117                         urb->status, urb->actual_length);
 118
 119
 120 exit_and_resubmit:
 121         smsusb_submit_urb(dev, surb);
 122 }
 123
 124 static int smsusb_submit_urb(struct smsusb_device_t *dev,
 125                              struct smsusb_urb_t *surb)
 126 {
 127         if (!surb->cb) {
 128                 surb->cb = smscore_getbuffer(dev->coredev);
 129                 if (!surb->cb) {
 130                         sms_err("smscore_getbuffer(...) returned NULL");
 131                         return -ENOMEM;
 132                 }
 133         }
 134
 135         usb_fill_bulk_urb(
 136                 &surb->urb,
 137                 dev->udev,
 138                 usb_rcvbulkpipe(dev->udev, 0x81),
 139                 surb->cb->p,
 140                 dev->buffer_size,
 141                 smsusb_onresponse,
 142                 surb
 143         );
 144         surb->urb.transfer_dma = surb->cb->phys;
 145         surb->urb.transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
 146
 147         return usb_submit_urb(&surb->urb, GFP_ATOMIC);
 148 }
 149
 150 static void smsusb_stop_streaming(struct smsusb_device_t *dev)
 151 {
 152         int i;
 153
 154         for (i = 0; i < MAX_URBS; i++) {
 155                 usb_kill_urb(&dev->surbs[i].urb);
 156
 157                 if (dev->surbs[i].cb) {
 158                         smscore_putbuffer(dev->coredev, dev->surbs[i].cb);
 159                         dev->surbs[i].cb = NULL;
 160                 }
 161         }
 162 }
 163
 164 static int smsusb_start_streaming(struct smsusb_device_t *dev)
 165 {
 166         int i, rc;
 167
 168         for (i = 0; i < MAX_URBS; i++) {
 169                 rc = smsusb_submit_urb(dev, &dev->surbs[i]);
 170                 if (rc < 0) {
 171                         sms_err("smsusb_submit_urb(...) failed");
 172                         smsusb_stop_streaming(dev);
 173                         break;
 174                 }
 175         }
 176
 177         return rc;
 178 }
 179
 180 static int smsusb_sendrequest(void *context, void *buffer, size_t size)
 181 {
 182         struct smsusb_device_t *dev = (struct smsusb_device_t *) context;
 183         int dummy;
 184
 185         smsendian_handle_message_header((struct SmsMsgHdr_ST *)buffer);
 186         return usb_bulk_msg(dev->udev, usb_sndbulkpipe(dev->udev, 2),
 187                             buffer, size, &dummy, 1000);
 188 }
 189
 190 static char *smsusb1_fw_lkup[] = {
 191         "dvbt_stellar_usb.inp",
 192         "dvbh_stellar_usb.inp",
 193         "tdmb_stellar_usb.inp",
 194         "none",
 195         "dvbt_bda_stellar_usb.inp",
 196 };
 197
 198 static inline char *sms_get_fw_name(int mode, int board_id)
 199 {
 200         char **fw = sms_get_board(board_id)->fw;
 201         return (fw && fw[mode]) ? fw[mode] : smsusb1_fw_lkup[mode];
 202 }
 203
 204 static int smsusb1_load_firmware(struct usb_device *udev, int id, int board_id)
 205 {
 206         const struct firmware *fw;
 207         u8 *fw_buffer;
 208         int rc, dummy;
 209         char *fw_filename;
 210
 211         if (id < DEVICE_MODE_DVBT || id > DEVICE_MODE_DVBT_BDA) {
 212                 sms_err("invalid firmware id specified %d", id);
 213                 return -EINVAL;
 214         }
 215
 216         fw_filename = sms_get_fw_name(id, board_id);
 217
 218         rc = request_firmware(&fw, fw_filename, &udev->dev);
 219         if (rc < 0) {
 220                 sms_warn("failed to open \"%s\" mode %d, "
 221                          "trying again with default firmware", fw_filename, id);
 222
 223                 fw_filename = smsusb1_fw_lkup[id];
 224                 rc = request_firmware(&fw, fw_filename, &udev->dev);
 225                 if (rc < 0) {
 226                         sms_warn("failed to open \"%s\" mode %d",
 227                                  fw_filename, id);
 228
 229                         return rc;
 230                 }
 231         }
 232
 233         fw_buffer = kmalloc(fw->size, GFP_KERNEL);
 234         if (fw_buffer) {
 235                 memcpy(fw_buffer, fw->data, fw->size);
 236
 237                 rc = usb_bulk_msg(udev, usb_sndbulkpipe(udev, 2),
 238                                   fw_buffer, fw->size, &dummy, 1000);
 239
 240                 sms_info("sent %zd(%d) bytes, rc %d", fw->size, dummy, rc);
 241
 242                 kfree(fw_buffer);
 243         } else {
 244                 sms_err("failed to allocate firmware buffer");
 245                 rc = -ENOMEM;
 246         }
 247         sms_info("read FW %s, size=%zd", fw_filename, fw->size);
 248
 249         release_firmware(fw);
 250
 251         return rc;
 252 }
 253
 254 static void smsusb1_detectmode(void *context, int *mode)
 255 {
 256         char *product_string =
 257                 ((struct smsusb_device_t *) context)->udev->product;
 258
 259         *mode = DEVICE_MODE_NONE;
 260
 261         if (!product_string) {
 262                 product_string = "none";
 263                 sms_err("product string not found");
 264         } else if (strstr(product_string, "DVBH"))
 265                 *mode = 1;
 266         else if (strstr(product_string, "BDA"))
 267                 *mode = 4;
 268         else if (strstr(product_string, "DVBT"))
 269                 *mode = 0;
 270         else if (strstr(product_string, "TDMB"))
 271                 *mode = 2;
 272
 273         sms_info("%d \"%s\"", *mode, product_string);
 274 }
 275
 276 static int smsusb1_setmode(void *context, int mode)
 277 {
 278         struct SmsMsgHdr_ST Msg = { MSG_SW_RELOAD_REQ, 0, HIF_TASK,
 279                              sizeof(struct SmsMsgHdr_ST), 0 };
 280
 281         if (mode < DEVICE_MODE_DVBT || mode > DEVICE_MODE_DVBT_BDA) {
 282                 sms_err("invalid firmware id specified %d", mode);
 283                 return -EINVAL;
 284         }
 285
 286         return smsusb_sendrequest(context, &Msg, sizeof(Msg));
 287 }
 288
 289 static void smsusb_term_device(struct usb_interface *intf)
 290 {
 291         struct smsusb_device_t *dev = usb_get_intfdata(intf);
 292
 293         if (dev) {
 294                 smsusb_stop_streaming(dev);
 295
 296                 /* unregister from smscore */
 297                 if (dev->coredev)
 298                         smscore_unregister_device(dev->coredev);
 299
 300                 kfree(dev);
 301
 302                 sms_info("device %p destroyed", 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(&params, 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(&params, &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[] __devinitconst = {
 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         { } /* Terminating entry */
 546         };
 547
 548 MODULE_DEVICE_TABLE(usb, smsusb_id_table);
 549
 550 static struct usb_driver smsusb_driver = {
 551         .name                   = "smsusb",
 552         .probe                  = smsusb_probe,
 553         .disconnect             = smsusb_disconnect,
 554         .id_table               = smsusb_id_table,
 555
 556         .suspend                = smsusb_suspend,
 557         .resume                 = smsusb_resume,
 558 };
 559
 560 static int __init smsusb_module_init(void)
 561 {
 562         int rc = usb_register(&smsusb_driver);
 563         if (rc)
 564                 sms_err("usb_register failed. Error number %d", rc);
 565
 566         sms_debug("");
 567
 568         return rc;
 569 }
 570
 571 static void __exit smsusb_module_exit(void)
 572 {
 573         /* Regular USB Cleanup */
 574         usb_deregister(&smsusb_driver);
 575         sms_info("end");
 576 }
 577
 578 module_init(smsusb_module_init);
 579 module_exit(smsusb_module_exit);
 580
 581 MODULE_DESCRIPTION("Driver for the Siano SMS1xxx USB dongle");
 582 MODULE_AUTHOR("Siano Mobile Silicon, INC. (uris@siano-ms.com)");
 583 MODULE_LICENSE("GPL");