Pileus Git - ~andy/linux/blob - drivers/media/radio/radio-mr800.c

   1 /*
   2  * A driver for the AverMedia MR 800 USB FM radio. This device plugs
   3  * into both the USB and an analog audio input, so this thing
   4  * only deals with initialization and frequency setting, the
   5  * audio data has to be handled by a sound driver.
   6  *
   7  * Copyright (c) 2008 Alexey Klimov <klimov.linux@gmail.com>
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  22  */
  23
  24 /*
  25  * Big thanks to authors and contributors of dsbr100.c and radio-si470x.c
  26  *
  27  * When work was looked pretty good, i discover this:
  28  * http://av-usbradio.sourceforge.net/index.php
  29  * http://sourceforge.net/projects/av-usbradio/
  30  * Latest release of theirs project was in 2005.
  31  * Probably, this driver could be improved trough using their
  32  * achievements (specifications given).
  33  * Also, Faidon Liambotis <paravoid@debian.org> wrote nice driver for this radio
  34  * in 2007. He allowed to use his driver to improve current mr800 radio driver.
  35  * http://kerneltrap.org/mailarchive/linux-usb-devel/2007/10/11/342492
  36  *
  37  * Version 0.01:        First working version.
  38  *                      It's required to blacklist AverMedia USB Radio
  39  *                      in usbhid/hid-quirks.c
  40  * Version 0.10:        A lot of cleanups and fixes: unpluging the device,
  41  *                      few mutex locks were added, codinstyle issues, etc.
  42  *                      Added stereo support. Thanks to
  43  *                      Douglas Schilling Landgraf <dougsland@gmail.com> and
  44  *                      David Ellingsworth <david@identd.dyndns.org>
  45  *                      for discussion, help and support.
  46  * Version 0.11:        Converted to v4l2_device.
  47  *
  48  * Many things to do:
  49  *      - Correct power management of device (suspend & resume)
  50  *      - Add code for scanning and smooth tuning
  51  *      - Add code for sensitivity value
  52  *      - Correct mistakes
  53  *      - In Japan another FREQ_MIN and FREQ_MAX
  54  */
  55
  56 /* kernel includes */
  57 #include <linux/kernel.h>
  58 #include <linux/module.h>
  59 #include <linux/init.h>
  60 #include <linux/slab.h>
  61 #include <linux/smp_lock.h>
  62 #include <linux/input.h>
  63 #include <linux/videodev2.h>
  64 #include <media/v4l2-device.h>
  65 #include <media/v4l2-ioctl.h>
  66 #include <linux/usb.h>
  67 #include <linux/version.h>      /* for KERNEL_VERSION MACRO */
  68 #include <linux/mutex.h>
  69
  70 /* driver and module definitions */
  71 #define DRIVER_AUTHOR "Alexey Klimov <klimov.linux@gmail.com>"
  72 #define DRIVER_DESC "AverMedia MR 800 USB FM radio driver"
  73 #define DRIVER_VERSION "0.11"
  74 #define RADIO_VERSION KERNEL_VERSION(0, 1, 1)
  75
  76 MODULE_AUTHOR(DRIVER_AUTHOR);
  77 MODULE_DESCRIPTION(DRIVER_DESC);
  78 MODULE_LICENSE("GPL");
  79
  80 #define USB_AMRADIO_VENDOR 0x07ca
  81 #define USB_AMRADIO_PRODUCT 0xb800
  82
  83 /* dev_warn macro with driver name */
  84 #define MR800_DRIVER_NAME "radio-mr800"
  85 #define amradio_dev_warn(dev, fmt, arg...)                              \
  86                 dev_warn(dev, MR800_DRIVER_NAME " - " fmt, ##arg)
  87
  88 #define amradio_dev_err(dev, fmt, arg...) \
  89                 dev_err(dev, MR800_DRIVER_NAME " - " fmt, ##arg)
  90
  91 /* Probably USB_TIMEOUT should be modified in module parameter */
  92 #define BUFFER_LENGTH 8
  93 #define USB_TIMEOUT 500
  94
  95 /* Frequency limits in MHz -- these are European values.  For Japanese
  96 devices, that would be 76 and 91.  */
  97 #define FREQ_MIN  87.5
  98 #define FREQ_MAX 108.0
  99 #define FREQ_MUL 16000
 100
 101 /*
 102  * Commands that device should understand
 103  * List isnt full and will be updated with implementation of new functions
 104  */
 105 #define AMRADIO_SET_FREQ        0xa4
 106 #define AMRADIO_SET_MUTE        0xab
 107 #define AMRADIO_SET_MONO        0xae
 108
 109 /* Comfortable defines for amradio_set_mute */
 110 #define AMRADIO_START           0x00
 111 #define AMRADIO_STOP            0x01
 112
 113 /* Comfortable defines for amradio_set_stereo */
 114 #define WANT_STEREO             0x00
 115 #define WANT_MONO               0x01
 116
 117 /* module parameter */
 118 static int radio_nr = -1;
 119 module_param(radio_nr, int, 0);
 120 MODULE_PARM_DESC(radio_nr, "Radio Nr");
 121
 122 static int usb_amradio_probe(struct usb_interface *intf,
 123                              const struct usb_device_id *id);
 124 static void usb_amradio_disconnect(struct usb_interface *intf);
 125 static int usb_amradio_open(struct file *file);
 126 static int usb_amradio_close(struct file *file);
 127 static int usb_amradio_suspend(struct usb_interface *intf,
 128                                 pm_message_t message);
 129 static int usb_amradio_resume(struct usb_interface *intf);
 130
 131 /* Data for one (physical) device */
 132 struct amradio_device {
 133         /* reference to USB and video device */
 134         struct usb_device *usbdev;
 135         struct video_device videodev;
 136         struct v4l2_device v4l2_dev;
 137
 138         unsigned char *buffer;
 139         struct mutex lock;      /* buffer locking */
 140         int curfreq;
 141         int stereo;
 142         int muted;
 143         int initialized;
 144 };
 145
 146 #define vdev_to_amradio(r) container_of(r, struct amradio_device, videodev)
 147
 148 /* USB Device ID List */
 149 static struct usb_device_id usb_amradio_device_table[] = {
 150         {USB_DEVICE_AND_INTERFACE_INFO(USB_AMRADIO_VENDOR, USB_AMRADIO_PRODUCT,
 151                                                         USB_CLASS_HID, 0, 0) },
 152         { }                                             /* Terminating entry */
 153 };
 154
 155 MODULE_DEVICE_TABLE(usb, usb_amradio_device_table);
 156
 157 /* USB subsystem interface */
 158 static struct usb_driver usb_amradio_driver = {
 159         .name                   = MR800_DRIVER_NAME,
 160         .probe                  = usb_amradio_probe,
 161         .disconnect             = usb_amradio_disconnect,
 162         .suspend                = usb_amradio_suspend,
 163         .resume                 = usb_amradio_resume,
 164         .reset_resume           = usb_amradio_resume,
 165         .id_table               = usb_amradio_device_table,
 166         .supports_autosuspend   = 0,
 167 };
 168
 169 /* switch on/off the radio. Send 8 bytes to device */
 170 static int amradio_set_mute(struct amradio_device *radio, char argument)
 171 {
 172         int retval;
 173         int size;
 174
 175         BUG_ON(!mutex_is_locked(&radio->lock));
 176
 177         radio->buffer[0] = 0x00;
 178         radio->buffer[1] = 0x55;
 179         radio->buffer[2] = 0xaa;
 180         radio->buffer[3] = 0x00;
 181         radio->buffer[4] = AMRADIO_SET_MUTE;
 182         radio->buffer[5] = argument;
 183         radio->buffer[6] = 0x00;
 184         radio->buffer[7] = 0x00;
 185
 186         retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
 187                 (void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
 188
 189         if (retval < 0 || size != BUFFER_LENGTH)
 190                 return retval;
 191
 192         radio->muted = argument;
 193
 194         return retval;
 195 }
 196
 197 /* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */
 198 static int amradio_setfreq(struct amradio_device *radio, int freq)
 199 {
 200         int retval;
 201         int size;
 202         unsigned short freq_send = 0x10 + (freq >> 3) / 25;
 203
 204         BUG_ON(!mutex_is_locked(&radio->lock));
 205
 206         radio->buffer[0] = 0x00;
 207         radio->buffer[1] = 0x55;
 208         radio->buffer[2] = 0xaa;
 209         radio->buffer[3] = 0x03;
 210         radio->buffer[4] = AMRADIO_SET_FREQ;
 211         radio->buffer[5] = 0x00;
 212         radio->buffer[6] = 0x00;
 213         radio->buffer[7] = 0x08;
 214
 215         retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
 216                 (void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
 217
 218         if (retval < 0 || size != BUFFER_LENGTH)
 219                 return retval;
 220
 221         /* frequency is calculated from freq_send and placed in first 2 bytes */
 222         radio->buffer[0] = (freq_send >> 8) & 0xff;
 223         radio->buffer[1] = freq_send & 0xff;
 224         radio->buffer[2] = 0x01;
 225         radio->buffer[3] = 0x00;
 226         radio->buffer[4] = 0x00;
 227         /* 5 and 6 bytes of buffer already = 0x00 */
 228         radio->buffer[7] = 0x00;
 229
 230         retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
 231                 (void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
 232
 233         return retval;
 234 }
 235
 236 static int amradio_set_stereo(struct amradio_device *radio, char argument)
 237 {
 238         int retval;
 239         int size;
 240
 241         BUG_ON(!mutex_is_locked(&radio->lock));
 242
 243         radio->buffer[0] = 0x00;
 244         radio->buffer[1] = 0x55;
 245         radio->buffer[2] = 0xaa;
 246         radio->buffer[3] = 0x00;
 247         radio->buffer[4] = AMRADIO_SET_MONO;
 248         radio->buffer[5] = argument;
 249         radio->buffer[6] = 0x00;
 250         radio->buffer[7] = 0x00;
 251
 252         retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
 253                 (void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
 254
 255         if (retval < 0 || size != BUFFER_LENGTH)
 256                 return retval;
 257
 258         if (argument == WANT_STEREO)
 259                 radio->stereo = 1;
 260         else
 261                 radio->stereo = 0;
 262
 263         return retval;
 264 }
 265
 266 /* Handle unplugging the device.
 267  * We call video_unregister_device in any case.
 268  * The last function called in this procedure is
 269  * usb_amradio_device_release.
 270  */
 271 static void usb_amradio_disconnect(struct usb_interface *intf)
 272 {
 273         struct amradio_device *radio = usb_get_intfdata(intf);
 274
 275         mutex_lock(&radio->lock);
 276         radio->usbdev = NULL;
 277         mutex_unlock(&radio->lock);
 278
 279         usb_set_intfdata(intf, NULL);
 280         v4l2_device_disconnect(&radio->v4l2_dev);
 281         video_unregister_device(&radio->videodev);
 282 }
 283
 284 /* vidioc_querycap - query device capabilities */
 285 static int vidioc_querycap(struct file *file, void *priv,
 286                                         struct v4l2_capability *v)
 287 {
 288         struct amradio_device *radio = file->private_data;
 289
 290         strlcpy(v->driver, "radio-mr800", sizeof(v->driver));
 291         strlcpy(v->card, "AverMedia MR 800 USB FM Radio", sizeof(v->card));
 292         usb_make_path(radio->usbdev, v->bus_info, sizeof(v->bus_info));
 293         v->version = RADIO_VERSION;
 294         v->capabilities = V4L2_CAP_TUNER;
 295         return 0;
 296 }
 297
 298 /* vidioc_g_tuner - get tuner attributes */
 299 static int vidioc_g_tuner(struct file *file, void *priv,
 300                                 struct v4l2_tuner *v)
 301 {
 302         struct amradio_device *radio = file->private_data;
 303         int retval;
 304
 305         if (v->index > 0)
 306                 return -EINVAL;
 307
 308 /* TODO: Add function which look is signal stereo or not
 309  *      amradio_getstat(radio);
 310  */
 311
 312 /* we call amradio_set_stereo to set radio->stereo
 313  * Honestly, amradio_getstat should cover this in future and
 314  * amradio_set_stereo shouldn't be here
 315  */
 316         retval = amradio_set_stereo(radio, WANT_STEREO);
 317         if (retval < 0)
 318                 amradio_dev_warn(&radio->videodev.dev,
 319                         "set stereo failed\n");
 320
 321         strcpy(v->name, "FM");
 322         v->type = V4L2_TUNER_RADIO;
 323         v->rangelow = FREQ_MIN * FREQ_MUL;
 324         v->rangehigh = FREQ_MAX * FREQ_MUL;
 325         v->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
 326         v->capability = V4L2_TUNER_CAP_LOW;
 327         if (radio->stereo)
 328                 v->audmode = V4L2_TUNER_MODE_STEREO;
 329         else
 330                 v->audmode = V4L2_TUNER_MODE_MONO;
 331         v->signal = 0xffff;     /* Can't get the signal strength, sad.. */
 332         v->afc = 0; /* Don't know what is this */
 333
 334         return retval;
 335 }
 336
 337 /* vidioc_s_tuner - set tuner attributes */
 338 static int vidioc_s_tuner(struct file *file, void *priv,
 339                                 struct v4l2_tuner *v)
 340 {
 341         struct amradio_device *radio = file->private_data;
 342         int retval = -EINVAL;
 343
 344         if (v->index > 0)
 345                 return -EINVAL;
 346
 347         /* mono/stereo selector */
 348         switch (v->audmode) {
 349         case V4L2_TUNER_MODE_MONO:
 350                 retval = amradio_set_stereo(radio, WANT_MONO);
 351                 if (retval < 0)
 352                         amradio_dev_warn(&radio->videodev.dev,
 353                                 "set mono failed\n");
 354                 break;
 355         case V4L2_TUNER_MODE_STEREO:
 356                 retval = amradio_set_stereo(radio, WANT_STEREO);
 357                 if (retval < 0)
 358                         amradio_dev_warn(&radio->videodev.dev,
 359                                 "set stereo failed\n");
 360                 break;
 361         }
 362
 363         return retval;
 364 }
 365
 366 /* vidioc_s_frequency - set tuner radio frequency */
 367 static int vidioc_s_frequency(struct file *file, void *priv,
 368                                 struct v4l2_frequency *f)
 369 {
 370         struct amradio_device *radio = file->private_data;
 371         int retval = 0;
 372
 373         radio->curfreq = f->frequency;
 374
 375         retval = amradio_setfreq(radio, radio->curfreq);
 376         if (retval < 0)
 377                 amradio_dev_warn(&radio->videodev.dev,
 378                         "set frequency failed\n");
 379
 380         return retval;
 381 }
 382
 383 /* vidioc_g_frequency - get tuner radio frequency */
 384 static int vidioc_g_frequency(struct file *file, void *priv,
 385                                 struct v4l2_frequency *f)
 386 {
 387         struct amradio_device *radio = file->private_data;
 388
 389         f->type = V4L2_TUNER_RADIO;
 390         f->frequency = radio->curfreq;
 391
 392         return 0;
 393 }
 394
 395 /* vidioc_queryctrl - enumerate control items */
 396 static int vidioc_queryctrl(struct file *file, void *priv,
 397                                 struct v4l2_queryctrl *qc)
 398 {
 399         switch (qc->id) {
 400         case V4L2_CID_AUDIO_MUTE:
 401                 return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
 402         }
 403
 404         return -EINVAL;
 405 }
 406
 407 /* vidioc_g_ctrl - get the value of a control */
 408 static int vidioc_g_ctrl(struct file *file, void *priv,
 409                                 struct v4l2_control *ctrl)
 410 {
 411         struct amradio_device *radio = file->private_data;
 412
 413         switch (ctrl->id) {
 414         case V4L2_CID_AUDIO_MUTE:
 415                 ctrl->value = radio->muted;
 416                 return 0;
 417         }
 418
 419         return -EINVAL;
 420 }
 421
 422 /* vidioc_s_ctrl - set the value of a control */
 423 static int vidioc_s_ctrl(struct file *file, void *priv,
 424                                 struct v4l2_control *ctrl)
 425 {
 426         struct amradio_device *radio = file->private_data;
 427         int retval = -EINVAL;
 428
 429         switch (ctrl->id) {
 430         case V4L2_CID_AUDIO_MUTE:
 431                 if (ctrl->value) {
 432                         retval = amradio_set_mute(radio, AMRADIO_STOP);
 433                         if (retval < 0) {
 434                                 amradio_dev_warn(&radio->videodev.dev,
 435                                         "amradio_stop failed\n");
 436                         }
 437                 } else {
 438                         retval = amradio_set_mute(radio, AMRADIO_START);
 439                         if (retval < 0) {
 440                                 amradio_dev_warn(&radio->videodev.dev,
 441                                         "amradio_start failed\n");
 442                         }
 443                 }
 444                 break;
 445         }
 446
 447         return retval;
 448 }
 449
 450 /* vidioc_g_audio - get audio attributes */
 451 static int vidioc_g_audio(struct file *file, void *priv,
 452                                 struct v4l2_audio *a)
 453 {
 454         if (a->index > 1)
 455                 return -EINVAL;
 456
 457         strcpy(a->name, "Radio");
 458         a->capability = V4L2_AUDCAP_STEREO;
 459         return 0;
 460 }
 461
 462 /* vidioc_s_audio - set audio attributes  */
 463 static int vidioc_s_audio(struct file *file, void *priv,
 464                                         struct v4l2_audio *a)
 465 {
 466         if (a->index != 0)
 467                 return -EINVAL;
 468         return 0;
 469 }
 470
 471 /* vidioc_g_input - get input */
 472 static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i)
 473 {
 474         *i = 0;
 475         return 0;
 476 }
 477
 478 /* vidioc_s_input - set input */
 479 static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
 480 {
 481         if (i != 0)
 482                 return -EINVAL;
 483         return 0;
 484 }
 485
 486 static int usb_amradio_init(struct amradio_device *radio)
 487 {
 488         int retval;
 489
 490         retval = amradio_set_mute(radio, AMRADIO_STOP);
 491         if (retval < 0) {
 492                 amradio_dev_warn(&radio->videodev.dev, "amradio_stop failed\n");
 493                 goto out_err;
 494         }
 495
 496         retval = amradio_set_stereo(radio, WANT_STEREO);
 497         if (retval < 0) {
 498                 amradio_dev_warn(&radio->videodev.dev, "set stereo failed\n");
 499                 goto out_err;
 500         }
 501
 502         radio->initialized = 1;
 503         goto out;
 504
 505 out_err:
 506         amradio_dev_err(&radio->videodev.dev, "initialization failed\n");
 507 out:
 508         return retval;
 509 }
 510
 511 /* open device - amradio_start() and amradio_setfreq() */
 512 static int usb_amradio_open(struct file *file)
 513 {
 514         struct amradio_device *radio = vdev_to_amradio(video_devdata(file));
 515         int retval = 0;
 516
 517         mutex_lock(&radio->lock);
 518
 519         if (!radio->usbdev) {
 520                 retval = -EIO;
 521                 goto unlock;
 522         }
 523
 524         file->private_data = radio;
 525
 526         if (unlikely(!radio->initialized))
 527                 retval = usb_amradio_init(radio);
 528
 529 unlock:
 530         mutex_unlock(&radio->lock);
 531         return retval;
 532 }
 533
 534 /*close device */
 535 static int usb_amradio_close(struct file *file)
 536 {
 537         struct amradio_device *radio = file->private_data;
 538         int retval = 0;
 539
 540         mutex_lock(&radio->lock);
 541
 542         if (!radio->usbdev)
 543                 retval = -EIO;
 544
 545         mutex_unlock(&radio->lock);
 546         return retval;
 547 }
 548
 549 static long usb_amradio_ioctl(struct file *file, unsigned int cmd,
 550                                 unsigned long arg)
 551 {
 552         struct amradio_device *radio = file->private_data;
 553         long retval = 0;
 554
 555         mutex_lock(&radio->lock);
 556
 557         if (!radio->usbdev) {
 558                 retval = -EIO;
 559                 goto unlock;
 560         }
 561
 562         retval = video_ioctl2(file, cmd, arg);
 563
 564 unlock:
 565         mutex_unlock(&radio->lock);
 566         return retval;
 567 }
 568
 569 /* Suspend device - stop device. Need to be checked and fixed */
 570 static int usb_amradio_suspend(struct usb_interface *intf, pm_message_t message)
 571 {
 572         struct amradio_device *radio = usb_get_intfdata(intf);
 573         int retval;
 574
 575         mutex_lock(&radio->lock);
 576
 577         retval = amradio_set_mute(radio, AMRADIO_STOP);
 578         if (retval < 0)
 579                 dev_warn(&intf->dev, "amradio_stop failed\n");
 580
 581         dev_info(&intf->dev, "going into suspend..\n");
 582
 583         mutex_unlock(&radio->lock);
 584         return 0;
 585 }
 586
 587 /* Resume device - start device. Need to be checked and fixed */
 588 static int usb_amradio_resume(struct usb_interface *intf)
 589 {
 590         struct amradio_device *radio = usb_get_intfdata(intf);
 591         int retval;
 592
 593         mutex_lock(&radio->lock);
 594
 595         retval = amradio_set_mute(radio, AMRADIO_START);
 596         if (retval < 0)
 597                 dev_warn(&intf->dev, "amradio_start failed\n");
 598
 599         dev_info(&intf->dev, "coming out of suspend..\n");
 600
 601         mutex_unlock(&radio->lock);
 602         return 0;
 603 }
 604
 605 /* File system interface */
 606 static const struct v4l2_file_operations usb_amradio_fops = {
 607         .owner          = THIS_MODULE,
 608         .open           = usb_amradio_open,
 609         .release        = usb_amradio_close,
 610         .ioctl          = usb_amradio_ioctl,
 611 };
 612
 613 static const struct v4l2_ioctl_ops usb_amradio_ioctl_ops = {
 614         .vidioc_querycap    = vidioc_querycap,
 615         .vidioc_g_tuner     = vidioc_g_tuner,
 616         .vidioc_s_tuner     = vidioc_s_tuner,
 617         .vidioc_g_frequency = vidioc_g_frequency,
 618         .vidioc_s_frequency = vidioc_s_frequency,
 619         .vidioc_queryctrl   = vidioc_queryctrl,
 620         .vidioc_g_ctrl      = vidioc_g_ctrl,
 621         .vidioc_s_ctrl      = vidioc_s_ctrl,
 622         .vidioc_g_audio     = vidioc_g_audio,
 623         .vidioc_s_audio     = vidioc_s_audio,
 624         .vidioc_g_input     = vidioc_g_input,
 625         .vidioc_s_input     = vidioc_s_input,
 626 };
 627
 628 static void usb_amradio_video_device_release(struct video_device *videodev)
 629 {
 630         struct amradio_device *radio = vdev_to_amradio(videodev);
 631
 632         v4l2_device_unregister(&radio->v4l2_dev);
 633
 634         /* free rest memory */
 635         kfree(radio->buffer);
 636         kfree(radio);
 637 }
 638
 639 /* check if the device is present and register with v4l and usb if it is */
 640 static int usb_amradio_probe(struct usb_interface *intf,
 641                                 const struct usb_device_id *id)
 642 {
 643         struct amradio_device *radio;
 644         int retval = 0;
 645
 646         radio = kzalloc(sizeof(struct amradio_device), GFP_KERNEL);
 647
 648         if (!radio) {
 649                 dev_err(&intf->dev, "kmalloc for amradio_device failed\n");
 650                 retval = -ENOMEM;
 651                 goto err;
 652         }
 653
 654         radio->buffer = kmalloc(BUFFER_LENGTH, GFP_KERNEL);
 655
 656         if (!radio->buffer) {
 657                 dev_err(&intf->dev, "kmalloc for radio->buffer failed\n");
 658                 retval = -ENOMEM;
 659                 goto err_nobuf;
 660         }
 661
 662         retval = v4l2_device_register(&intf->dev, &radio->v4l2_dev);
 663         if (retval < 0) {
 664                 dev_err(&intf->dev, "couldn't register v4l2_device\n");
 665                 goto err_v4l2;
 666         }
 667
 668         strlcpy(radio->videodev.name, radio->v4l2_dev.name,
 669                 sizeof(radio->videodev.name));
 670         radio->videodev.v4l2_dev = &radio->v4l2_dev;
 671         radio->videodev.fops = &usb_amradio_fops;
 672         radio->videodev.ioctl_ops = &usb_amradio_ioctl_ops;
 673         radio->videodev.release = usb_amradio_video_device_release;
 674
 675         radio->usbdev = interface_to_usbdev(intf);
 676         radio->curfreq = 95.16 * FREQ_MUL;
 677
 678         mutex_init(&radio->lock);
 679
 680         video_set_drvdata(&radio->videodev, radio);
 681
 682         retval = video_register_device(&radio->videodev, VFL_TYPE_RADIO,
 683                                         radio_nr);
 684         if (retval < 0) {
 685                 dev_err(&intf->dev, "could not register video device\n");
 686                 goto err_vdev;
 687         }
 688
 689         usb_set_intfdata(intf, radio);
 690         return 0;
 691
 692 err_vdev:
 693         v4l2_device_unregister(&radio->v4l2_dev);
 694 err_v4l2:
 695         kfree(radio->buffer);
 696 err_nobuf:
 697         kfree(radio);
 698 err:
 699         return retval;
 700 }
 701
 702 static int __init amradio_init(void)
 703 {
 704         int retval = usb_register(&usb_amradio_driver);
 705
 706         pr_info(KBUILD_MODNAME
 707                 ": version " DRIVER_VERSION " " DRIVER_DESC "\n");
 708
 709         if (retval)
 710                 pr_err(KBUILD_MODNAME
 711                         ": usb_register failed. Error number %d\n", retval);
 712
 713         return retval;
 714 }
 715
 716 static void __exit amradio_exit(void)
 717 {
 718         usb_deregister(&usb_amradio_driver);
 719 }
 720
 721 module_init(amradio_init);
 722 module_exit(amradio_exit);
 723