SAFE public projects git trees. - safe/jmp/linux-2.6/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 /* Probably USB_TIMEOUT should be modified in module parameter */
  89 #define BUFFER_LENGTH 8
  90 #define USB_TIMEOUT 500
  91
  92 /* Frequency limits in MHz -- these are European values.  For Japanese
  93 devices, that would be 76 and 91.  */
  94 #define FREQ_MIN  87.5
  95 #define FREQ_MAX 108.0
  96 #define FREQ_MUL 16000
  97
  98 /*
  99  * Commands that device should understand
 100  * List isnt full and will be updated with implementation of new functions
 101  */
 102 #define AMRADIO_SET_FREQ        0xa4
 103 #define AMRADIO_SET_MUTE        0xab
 104 #define AMRADIO_SET_MONO        0xae
 105
 106 /* Comfortable defines for amradio_set_mute */
 107 #define AMRADIO_START           0x00
 108 #define AMRADIO_STOP            0x01
 109
 110 /* Comfortable defines for amradio_set_stereo */
 111 #define WANT_STEREO             0x00
 112 #define WANT_MONO               0x01
 113
 114 /* module parameter */
 115 static int radio_nr = -1;
 116 module_param(radio_nr, int, 0);
 117 MODULE_PARM_DESC(radio_nr, "Radio Nr");
 118
 119 static int usb_amradio_probe(struct usb_interface *intf,
 120                              const struct usb_device_id *id);
 121 static void usb_amradio_disconnect(struct usb_interface *intf);
 122 static int usb_amradio_open(struct file *file);
 123 static int usb_amradio_close(struct file *file);
 124 static int usb_amradio_suspend(struct usb_interface *intf,
 125                                 pm_message_t message);
 126 static int usb_amradio_resume(struct usb_interface *intf);
 127
 128 /* Data for one (physical) device */
 129 struct amradio_device {
 130         /* reference to USB and video device */
 131         struct usb_device *usbdev;
 132         struct video_device videodev;
 133         struct v4l2_device v4l2_dev;
 134
 135         unsigned char *buffer;
 136         struct mutex lock;      /* buffer locking */
 137         int curfreq;
 138         int stereo;
 139         int users;
 140         int removed;
 141         int muted;
 142 };
 143
 144 #define vdev_to_amradio(r) container_of(r, struct amradio_device, videodev)
 145
 146 /* USB Device ID List */
 147 static struct usb_device_id usb_amradio_device_table[] = {
 148         {USB_DEVICE_AND_INTERFACE_INFO(USB_AMRADIO_VENDOR, USB_AMRADIO_PRODUCT,
 149                                                         USB_CLASS_HID, 0, 0) },
 150         { }                                             /* Terminating entry */
 151 };
 152
 153 MODULE_DEVICE_TABLE(usb, usb_amradio_device_table);
 154
 155 /* USB subsystem interface */
 156 static struct usb_driver usb_amradio_driver = {
 157         .name                   = MR800_DRIVER_NAME,
 158         .probe                  = usb_amradio_probe,
 159         .disconnect             = usb_amradio_disconnect,
 160         .suspend                = usb_amradio_suspend,
 161         .resume                 = usb_amradio_resume,
 162         .reset_resume           = usb_amradio_resume,
 163         .id_table               = usb_amradio_device_table,
 164         .supports_autosuspend   = 0,
 165 };
 166
 167 /* switch on/off the radio. Send 8 bytes to device */
 168 static int amradio_set_mute(struct amradio_device *radio, char argument)
 169 {
 170         int retval;
 171         int size;
 172
 173         BUG_ON(!mutex_is_locked(&radio->lock));
 174
 175         radio->buffer[0] = 0x00;
 176         radio->buffer[1] = 0x55;
 177         radio->buffer[2] = 0xaa;
 178         radio->buffer[3] = 0x00;
 179         radio->buffer[4] = AMRADIO_SET_MUTE;
 180         radio->buffer[5] = argument;
 181         radio->buffer[6] = 0x00;
 182         radio->buffer[7] = 0x00;
 183
 184         retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
 185                 (void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
 186
 187         if (retval < 0 || size != BUFFER_LENGTH)
 188                 return retval;
 189
 190         radio->muted = argument;
 191
 192         return retval;
 193 }
 194
 195 /* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */
 196 static int amradio_setfreq(struct amradio_device *radio, int freq)
 197 {
 198         int retval;
 199         int size;
 200         unsigned short freq_send = 0x10 + (freq >> 3) / 25;
 201
 202         BUG_ON(!mutex_is_locked(&radio->lock));
 203
 204         radio->buffer[0] = 0x00;
 205         radio->buffer[1] = 0x55;
 206         radio->buffer[2] = 0xaa;
 207         radio->buffer[3] = 0x03;
 208         radio->buffer[4] = AMRADIO_SET_FREQ;
 209         radio->buffer[5] = 0x00;
 210         radio->buffer[6] = 0x00;
 211         radio->buffer[7] = 0x08;
 212
 213         retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
 214                 (void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
 215
 216         if (retval < 0 || size != BUFFER_LENGTH)
 217                 return retval;
 218
 219         /* frequency is calculated from freq_send and placed in first 2 bytes */
 220         radio->buffer[0] = (freq_send >> 8) & 0xff;
 221         radio->buffer[1] = freq_send & 0xff;
 222         radio->buffer[2] = 0x01;
 223         radio->buffer[3] = 0x00;
 224         radio->buffer[4] = 0x00;
 225         /* 5 and 6 bytes of buffer already = 0x00 */
 226         radio->buffer[7] = 0x00;
 227
 228         retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
 229                 (void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
 230
 231         return retval;
 232 }
 233
 234 static int amradio_set_stereo(struct amradio_device *radio, char argument)
 235 {
 236         int retval;
 237         int size;
 238
 239         BUG_ON(!mutex_is_locked(&radio->lock));
 240
 241         radio->buffer[0] = 0x00;
 242         radio->buffer[1] = 0x55;
 243         radio->buffer[2] = 0xaa;
 244         radio->buffer[3] = 0x00;
 245         radio->buffer[4] = AMRADIO_SET_MONO;
 246         radio->buffer[5] = argument;
 247         radio->buffer[6] = 0x00;
 248         radio->buffer[7] = 0x00;
 249
 250         retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
 251                 (void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
 252
 253         if (retval < 0 || size != BUFFER_LENGTH) {
 254                 radio->stereo = -1;
 255                 return retval;
 256         }
 257
 258         radio->stereo = 1;
 259
 260         return retval;
 261 }
 262
 263 /* Handle unplugging the device.
 264  * We call video_unregister_device in any case.
 265  * The last function called in this procedure is
 266  * usb_amradio_device_release.
 267  */
 268 static void usb_amradio_disconnect(struct usb_interface *intf)
 269 {
 270         struct amradio_device *radio = usb_get_intfdata(intf);
 271
 272         mutex_lock(&radio->lock);
 273         radio->removed = 1;
 274         mutex_unlock(&radio->lock);
 275
 276         usb_set_intfdata(intf, NULL);
 277         video_unregister_device(&radio->videodev);
 278         v4l2_device_disconnect(&radio->v4l2_dev);
 279 }
 280
 281 /* vidioc_querycap - query device capabilities */
 282 static int vidioc_querycap(struct file *file, void *priv,
 283                                         struct v4l2_capability *v)
 284 {
 285         struct amradio_device *radio = file->private_data;
 286
 287         strlcpy(v->driver, "radio-mr800", sizeof(v->driver));
 288         strlcpy(v->card, "AverMedia MR 800 USB FM Radio", sizeof(v->card));
 289         usb_make_path(radio->usbdev, v->bus_info, sizeof(v->bus_info));
 290         v->version = RADIO_VERSION;
 291         v->capabilities = V4L2_CAP_TUNER;
 292         return 0;
 293 }
 294
 295 /* vidioc_g_tuner - get tuner attributes */
 296 static int vidioc_g_tuner(struct file *file, void *priv,
 297                                 struct v4l2_tuner *v)
 298 {
 299         struct amradio_device *radio = file->private_data;
 300         int retval;
 301
 302         mutex_lock(&radio->lock);
 303
 304         /* safety check */
 305         if (radio->removed) {
 306                 retval = -EIO;
 307                 goto unlock;
 308         }
 309
 310         if (v->index > 0) {
 311                 retval = -EINVAL;
 312                 goto unlock;
 313         }
 314
 315 /* TODO: Add function which look is signal stereo or not
 316  *      amradio_getstat(radio);
 317  */
 318
 319 /* we call amradio_set_stereo to set radio->stereo
 320  * Honestly, amradio_getstat should cover this in future and
 321  * amradio_set_stereo shouldn't be here
 322  */
 323         retval = amradio_set_stereo(radio, WANT_STEREO);
 324         if (retval < 0)
 325                 amradio_dev_warn(&radio->videodev.dev,
 326                         "set stereo failed\n");
 327
 328         strcpy(v->name, "FM");
 329         v->type = V4L2_TUNER_RADIO;
 330         v->rangelow = FREQ_MIN * FREQ_MUL;
 331         v->rangehigh = FREQ_MAX * FREQ_MUL;
 332         v->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
 333         v->capability = V4L2_TUNER_CAP_LOW;
 334         if (radio->stereo)
 335                 v->audmode = V4L2_TUNER_MODE_STEREO;
 336         else
 337                 v->audmode = V4L2_TUNER_MODE_MONO;
 338         v->signal = 0xffff;     /* Can't get the signal strength, sad.. */
 339         v->afc = 0; /* Don't know what is this */
 340
 341 unlock:
 342         mutex_unlock(&radio->lock);
 343         return retval;
 344 }
 345
 346 /* vidioc_s_tuner - set tuner attributes */
 347 static int vidioc_s_tuner(struct file *file, void *priv,
 348                                 struct v4l2_tuner *v)
 349 {
 350         struct amradio_device *radio = file->private_data;
 351         int retval;
 352
 353         mutex_lock(&radio->lock);
 354
 355         /* safety check */
 356         if (radio->removed) {
 357                 retval = -EIO;
 358                 goto unlock;
 359         }
 360
 361         if (v->index > 0) {
 362                 retval = -EINVAL;
 363                 goto unlock;
 364         }
 365
 366         /* mono/stereo selector */
 367         switch (v->audmode) {
 368         case V4L2_TUNER_MODE_MONO:
 369                 retval = amradio_set_stereo(radio, WANT_MONO);
 370                 if (retval < 0)
 371                         amradio_dev_warn(&radio->videodev.dev,
 372                                 "set mono failed\n");
 373                 break;
 374         case V4L2_TUNER_MODE_STEREO:
 375                 retval = amradio_set_stereo(radio, WANT_STEREO);
 376                 if (retval < 0)
 377                         amradio_dev_warn(&radio->videodev.dev,
 378                                 "set stereo failed\n");
 379                 break;
 380         default:
 381                 retval = -EINVAL;
 382         }
 383
 384 unlock:
 385         mutex_unlock(&radio->lock);
 386         return retval;
 387 }
 388
 389 /* vidioc_s_frequency - set tuner radio frequency */
 390 static int vidioc_s_frequency(struct file *file, void *priv,
 391                                 struct v4l2_frequency *f)
 392 {
 393         struct amradio_device *radio = file->private_data;
 394         int retval;
 395
 396         mutex_lock(&radio->lock);
 397
 398         /* safety check */
 399         if (radio->removed) {
 400                 retval = -EIO;
 401                 goto unlock;
 402         }
 403
 404         radio->curfreq = f->frequency;
 405
 406         retval = amradio_setfreq(radio, radio->curfreq);
 407         if (retval < 0)
 408                 amradio_dev_warn(&radio->videodev.dev,
 409                         "set frequency failed\n");
 410
 411 unlock:
 412         mutex_unlock(&radio->lock);
 413         return retval;
 414 }
 415
 416 /* vidioc_g_frequency - get tuner radio frequency */
 417 static int vidioc_g_frequency(struct file *file, void *priv,
 418                                 struct v4l2_frequency *f)
 419 {
 420         struct amradio_device *radio = file->private_data;
 421         int retval = 0;
 422
 423         mutex_lock(&radio->lock);
 424
 425         /* safety check */
 426         if (radio->removed) {
 427                 retval = -EIO;
 428                 goto unlock;
 429         }
 430
 431         f->type = V4L2_TUNER_RADIO;
 432         f->frequency = radio->curfreq;
 433
 434 unlock:
 435         mutex_unlock(&radio->lock);
 436         return retval;
 437 }
 438
 439 /* vidioc_queryctrl - enumerate control items */
 440 static int vidioc_queryctrl(struct file *file, void *priv,
 441                                 struct v4l2_queryctrl *qc)
 442 {
 443         switch (qc->id) {
 444         case V4L2_CID_AUDIO_MUTE:
 445                 return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
 446         }
 447
 448         return -EINVAL;
 449 }
 450
 451 /* vidioc_g_ctrl - get the value of a control */
 452 static int vidioc_g_ctrl(struct file *file, void *priv,
 453                                 struct v4l2_control *ctrl)
 454 {
 455         struct amradio_device *radio = file->private_data;
 456         int retval = -EINVAL;
 457
 458         mutex_lock(&radio->lock);
 459
 460         /* safety check */
 461         if (radio->removed) {
 462                 retval = -EIO;
 463                 goto unlock;
 464         }
 465
 466         switch (ctrl->id) {
 467         case V4L2_CID_AUDIO_MUTE:
 468                 ctrl->value = radio->muted;
 469                 retval = 0;
 470                 break;
 471         }
 472
 473 unlock:
 474         mutex_unlock(&radio->lock);
 475         return retval;
 476 }
 477
 478 /* vidioc_s_ctrl - set the value of a control */
 479 static int vidioc_s_ctrl(struct file *file, void *priv,
 480                                 struct v4l2_control *ctrl)
 481 {
 482         struct amradio_device *radio = file->private_data;
 483         int retval = -EINVAL;
 484
 485         mutex_lock(&radio->lock);
 486
 487         /* safety check */
 488         if (radio->removed) {
 489                 retval = -EIO;
 490                 goto unlock;
 491         }
 492
 493         switch (ctrl->id) {
 494         case V4L2_CID_AUDIO_MUTE:
 495                 if (ctrl->value) {
 496                         retval = amradio_set_mute(radio, AMRADIO_STOP);
 497                         if (retval < 0) {
 498                                 amradio_dev_warn(&radio->videodev.dev,
 499                                         "amradio_stop failed\n");
 500                         }
 501                 } else {
 502                         retval = amradio_set_mute(radio, AMRADIO_START);
 503                         if (retval < 0) {
 504                                 amradio_dev_warn(&radio->videodev.dev,
 505                                         "amradio_start failed\n");
 506                         }
 507                 }
 508                 break;
 509         }
 510
 511 unlock:
 512         mutex_unlock(&radio->lock);
 513         return retval;
 514 }
 515
 516 /* vidioc_g_audio - get audio attributes */
 517 static int vidioc_g_audio(struct file *file, void *priv,
 518                                 struct v4l2_audio *a)
 519 {
 520         if (a->index > 1)
 521                 return -EINVAL;
 522
 523         strcpy(a->name, "Radio");
 524         a->capability = V4L2_AUDCAP_STEREO;
 525         return 0;
 526 }
 527
 528 /* vidioc_s_audio - set audio attributes  */
 529 static int vidioc_s_audio(struct file *file, void *priv,
 530                                         struct v4l2_audio *a)
 531 {
 532         if (a->index != 0)
 533                 return -EINVAL;
 534         return 0;
 535 }
 536
 537 /* vidioc_g_input - get input */
 538 static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i)
 539 {
 540         *i = 0;
 541         return 0;
 542 }
 543
 544 /* vidioc_s_input - set input */
 545 static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
 546 {
 547         if (i != 0)
 548                 return -EINVAL;
 549         return 0;
 550 }
 551
 552 /* open device - amradio_start() and amradio_setfreq() */
 553 static int usb_amradio_open(struct file *file)
 554 {
 555         struct amradio_device *radio = vdev_to_amradio(video_devdata(file));
 556         int retval = 0;
 557
 558         mutex_lock(&radio->lock);
 559
 560         if (radio->removed) {
 561                 retval = -EIO;
 562                 goto unlock;
 563         }
 564
 565         file->private_data = radio;
 566         radio->users = 1;
 567         radio->muted = 1;
 568
 569         retval = amradio_set_mute(radio, AMRADIO_START);
 570         if (retval < 0) {
 571                 amradio_dev_warn(&radio->videodev.dev,
 572                         "radio did not start up properly\n");
 573                 radio->users = 0;
 574                 goto unlock;
 575         }
 576
 577         retval = amradio_set_stereo(radio, WANT_STEREO);
 578         if (retval < 0)
 579                 amradio_dev_warn(&radio->videodev.dev,
 580                         "set stereo failed\n");
 581
 582         retval = amradio_setfreq(radio, radio->curfreq);
 583         if (retval < 0)
 584                 amradio_dev_warn(&radio->videodev.dev,
 585                         "set frequency failed\n");
 586
 587 unlock:
 588         mutex_unlock(&radio->lock);
 589         return retval;
 590 }
 591
 592 /*close device */
 593 static int usb_amradio_close(struct file *file)
 594 {
 595         struct amradio_device *radio = file->private_data;
 596         int retval = 0;
 597
 598         mutex_lock(&radio->lock);
 599
 600         if (radio->removed) {
 601                 retval = -EIO;
 602                 goto unlock;
 603         }
 604
 605         radio->users = 0;
 606
 607         if (!radio->removed) {
 608                 retval = amradio_set_mute(radio, AMRADIO_STOP);
 609                 if (retval < 0)
 610                         amradio_dev_warn(&radio->videodev.dev,
 611                                 "amradio_stop failed\n");
 612         }
 613
 614 unlock:
 615         mutex_unlock(&radio->lock);
 616         return retval;
 617 }
 618
 619 /* Suspend device - stop device. Need to be checked and fixed */
 620 static int usb_amradio_suspend(struct usb_interface *intf, pm_message_t message)
 621 {
 622         struct amradio_device *radio = usb_get_intfdata(intf);
 623         int retval;
 624
 625         mutex_lock(&radio->lock);
 626
 627         retval = amradio_set_mute(radio, AMRADIO_STOP);
 628         if (retval < 0)
 629                 dev_warn(&intf->dev, "amradio_stop failed\n");
 630
 631         dev_info(&intf->dev, "going into suspend..\n");
 632
 633         mutex_unlock(&radio->lock);
 634         return 0;
 635 }
 636
 637 /* Resume device - start device. Need to be checked and fixed */
 638 static int usb_amradio_resume(struct usb_interface *intf)
 639 {
 640         struct amradio_device *radio = usb_get_intfdata(intf);
 641         int retval;
 642
 643         mutex_lock(&radio->lock);
 644
 645         retval = amradio_set_mute(radio, AMRADIO_START);
 646         if (retval < 0)
 647                 dev_warn(&intf->dev, "amradio_start failed\n");
 648
 649         dev_info(&intf->dev, "coming out of suspend..\n");
 650
 651         mutex_unlock(&radio->lock);
 652         return 0;
 653 }
 654
 655 /* File system interface */
 656 static const struct v4l2_file_operations usb_amradio_fops = {
 657         .owner          = THIS_MODULE,
 658         .open           = usb_amradio_open,
 659         .release        = usb_amradio_close,
 660         .ioctl          = video_ioctl2,
 661 };
 662
 663 static const struct v4l2_ioctl_ops usb_amradio_ioctl_ops = {
 664         .vidioc_querycap    = vidioc_querycap,
 665         .vidioc_g_tuner     = vidioc_g_tuner,
 666         .vidioc_s_tuner     = vidioc_s_tuner,
 667         .vidioc_g_frequency = vidioc_g_frequency,
 668         .vidioc_s_frequency = vidioc_s_frequency,
 669         .vidioc_queryctrl   = vidioc_queryctrl,
 670         .vidioc_g_ctrl      = vidioc_g_ctrl,
 671         .vidioc_s_ctrl      = vidioc_s_ctrl,
 672         .vidioc_g_audio     = vidioc_g_audio,
 673         .vidioc_s_audio     = vidioc_s_audio,
 674         .vidioc_g_input     = vidioc_g_input,
 675         .vidioc_s_input     = vidioc_s_input,
 676 };
 677
 678 static void usb_amradio_video_device_release(struct video_device *videodev)
 679 {
 680         struct amradio_device *radio = vdev_to_amradio(videodev);
 681
 682         v4l2_device_unregister(&radio->v4l2_dev);
 683
 684         /* free rest memory */
 685         kfree(radio->buffer);
 686         kfree(radio);
 687 }
 688
 689 /* check if the device is present and register with v4l and usb if it is */
 690 static int usb_amradio_probe(struct usb_interface *intf,
 691                                 const struct usb_device_id *id)
 692 {
 693         struct amradio_device *radio;
 694         int retval = 0;
 695
 696         radio = kzalloc(sizeof(struct amradio_device), GFP_KERNEL);
 697
 698         if (!radio) {
 699                 dev_err(&intf->dev, "kmalloc for amradio_device failed\n");
 700                 retval = -ENOMEM;
 701                 goto err;
 702         }
 703
 704         radio->buffer = kmalloc(BUFFER_LENGTH, GFP_KERNEL);
 705
 706         if (!radio->buffer) {
 707                 dev_err(&intf->dev, "kmalloc for radio->buffer failed\n");
 708                 retval = -ENOMEM;
 709                 goto err_nobuf;
 710         }
 711
 712         retval = v4l2_device_register(&intf->dev, &radio->v4l2_dev);
 713         if (retval < 0) {
 714                 dev_err(&intf->dev, "couldn't register v4l2_device\n");
 715                 goto err_v4l2;
 716         }
 717
 718         strlcpy(radio->videodev.name, radio->v4l2_dev.name,
 719                 sizeof(radio->videodev.name));
 720         radio->videodev.v4l2_dev = &radio->v4l2_dev;
 721         radio->videodev.fops = &usb_amradio_fops;
 722         radio->videodev.ioctl_ops = &usb_amradio_ioctl_ops;
 723         radio->videodev.release = usb_amradio_video_device_release;
 724
 725         radio->removed = 0;
 726         radio->users = 0;
 727         radio->usbdev = interface_to_usbdev(intf);
 728         radio->curfreq = 95.16 * FREQ_MUL;
 729         radio->stereo = -1;
 730
 731         mutex_init(&radio->lock);
 732
 733         video_set_drvdata(&radio->videodev, radio);
 734
 735         retval = video_register_device(&radio->videodev, VFL_TYPE_RADIO,
 736                                         radio_nr);
 737         if (retval < 0) {
 738                 dev_err(&intf->dev, "could not register video device\n");
 739                 goto err_vdev;
 740         }
 741
 742         usb_set_intfdata(intf, radio);
 743         return 0;
 744
 745 err_vdev:
 746         v4l2_device_unregister(&radio->v4l2_dev);
 747 err_v4l2:
 748         kfree(radio->buffer);
 749 err_nobuf:
 750         kfree(radio);
 751 err:
 752         return retval;
 753 }
 754
 755 static int __init amradio_init(void)
 756 {
 757         int retval = usb_register(&usb_amradio_driver);
 758
 759         pr_info(KBUILD_MODNAME
 760                 ": version " DRIVER_VERSION " " DRIVER_DESC "\n");
 761
 762         if (retval)
 763                 pr_err(KBUILD_MODNAME
 764                         ": usb_register failed. Error number %d\n", retval);
 765
 766         return retval;
 767 }
 768
 769 static void __exit amradio_exit(void)
 770 {
 771         usb_deregister(&usb_amradio_driver);
 772 }
 773
 774 module_init(amradio_init);
 775 module_exit(amradio_exit);
 776