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