14834f4d1SAlexey Klimov /* 24834f4d1SAlexey Klimov * Driver for the MasterKit MA901 USB FM radio. This device plugs 34834f4d1SAlexey Klimov * into the USB port and an analog audio input or headphones, so this thing 44834f4d1SAlexey Klimov * only deals with initialization, frequency setting, volume. 54834f4d1SAlexey Klimov * 64834f4d1SAlexey Klimov * Copyright (c) 2012 Alexey Klimov <klimov.linux@gmail.com> 74834f4d1SAlexey Klimov * 84834f4d1SAlexey Klimov * This program is free software; you can redistribute it and/or modify 94834f4d1SAlexey Klimov * it under the terms of the GNU General Public License as published by 104834f4d1SAlexey Klimov * the Free Software Foundation; either version 2 of the License, or 114834f4d1SAlexey Klimov * (at your option) any later version. 124834f4d1SAlexey Klimov * 134834f4d1SAlexey Klimov * This program is distributed in the hope that it will be useful, 144834f4d1SAlexey Klimov * but WITHOUT ANY WARRANTY; without even the implied warranty of 154834f4d1SAlexey Klimov * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 164834f4d1SAlexey Klimov * GNU General Public License for more details. 174834f4d1SAlexey Klimov * 184834f4d1SAlexey Klimov * You should have received a copy of the GNU General Public License 194834f4d1SAlexey Klimov * along with this program; if not, write to the Free Software 204834f4d1SAlexey Klimov * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 214834f4d1SAlexey Klimov */ 224834f4d1SAlexey Klimov 234834f4d1SAlexey Klimov #include <linux/kernel.h> 244834f4d1SAlexey Klimov #include <linux/module.h> 254834f4d1SAlexey Klimov #include <linux/init.h> 264834f4d1SAlexey Klimov #include <linux/slab.h> 274834f4d1SAlexey Klimov #include <linux/input.h> 284834f4d1SAlexey Klimov #include <linux/videodev2.h> 294834f4d1SAlexey Klimov #include <media/v4l2-device.h> 304834f4d1SAlexey Klimov #include <media/v4l2-ioctl.h> 314834f4d1SAlexey Klimov #include <media/v4l2-ctrls.h> 324834f4d1SAlexey Klimov #include <media/v4l2-event.h> 334834f4d1SAlexey Klimov #include <linux/usb.h> 344834f4d1SAlexey Klimov #include <linux/mutex.h> 354834f4d1SAlexey Klimov 364834f4d1SAlexey Klimov #define DRIVER_AUTHOR "Alexey Klimov <klimov.linux@gmail.com>" 374834f4d1SAlexey Klimov #define DRIVER_DESC "Masterkit MA901 USB FM radio driver" 384834f4d1SAlexey Klimov #define DRIVER_VERSION "0.0.1" 394834f4d1SAlexey Klimov 404834f4d1SAlexey Klimov MODULE_AUTHOR(DRIVER_AUTHOR); 414834f4d1SAlexey Klimov MODULE_DESCRIPTION(DRIVER_DESC); 424834f4d1SAlexey Klimov MODULE_LICENSE("GPL"); 434834f4d1SAlexey Klimov MODULE_VERSION(DRIVER_VERSION); 444834f4d1SAlexey Klimov 454834f4d1SAlexey Klimov #define USB_MA901_VENDOR 0x16c0 464834f4d1SAlexey Klimov #define USB_MA901_PRODUCT 0x05df 474834f4d1SAlexey Klimov 484834f4d1SAlexey Klimov /* dev_warn macro with driver name */ 494834f4d1SAlexey Klimov #define MA901_DRIVER_NAME "radio-ma901" 504834f4d1SAlexey Klimov #define ma901radio_dev_warn(dev, fmt, arg...) \ 514834f4d1SAlexey Klimov dev_warn(dev, MA901_DRIVER_NAME " - " fmt, ##arg) 524834f4d1SAlexey Klimov 534834f4d1SAlexey Klimov #define ma901radio_dev_err(dev, fmt, arg...) \ 544834f4d1SAlexey Klimov dev_err(dev, MA901_DRIVER_NAME " - " fmt, ##arg) 554834f4d1SAlexey Klimov 564834f4d1SAlexey Klimov /* Probably USB_TIMEOUT should be modified in module parameter */ 574834f4d1SAlexey Klimov #define BUFFER_LENGTH 8 584834f4d1SAlexey Klimov #define USB_TIMEOUT 500 594834f4d1SAlexey Klimov 604834f4d1SAlexey Klimov #define FREQ_MIN 87.5 614834f4d1SAlexey Klimov #define FREQ_MAX 108.0 624834f4d1SAlexey Klimov #define FREQ_MUL 16000 634834f4d1SAlexey Klimov 644834f4d1SAlexey Klimov #define MA901_VOLUME_MAX 16 654834f4d1SAlexey Klimov #define MA901_VOLUME_MIN 0 664834f4d1SAlexey Klimov 674834f4d1SAlexey Klimov /* Commands that device should understand 684834f4d1SAlexey Klimov * List isn't full and will be updated with implementation of new functions 694834f4d1SAlexey Klimov */ 704834f4d1SAlexey Klimov #define MA901_RADIO_SET_FREQ 0x03 714834f4d1SAlexey Klimov #define MA901_RADIO_SET_VOLUME 0x04 724834f4d1SAlexey Klimov #define MA901_RADIO_SET_MONO_STEREO 0x05 734834f4d1SAlexey Klimov 744834f4d1SAlexey Klimov /* Comfortable defines for ma901radio_set_stereo */ 754834f4d1SAlexey Klimov #define MA901_WANT_STEREO 0x50 764834f4d1SAlexey Klimov #define MA901_WANT_MONO 0xd0 774834f4d1SAlexey Klimov 784834f4d1SAlexey Klimov /* module parameter */ 794834f4d1SAlexey Klimov static int radio_nr = -1; 804834f4d1SAlexey Klimov module_param(radio_nr, int, 0); 814834f4d1SAlexey Klimov MODULE_PARM_DESC(radio_nr, "Radio file number"); 824834f4d1SAlexey Klimov 834834f4d1SAlexey Klimov /* Data for one (physical) device */ 844834f4d1SAlexey Klimov struct ma901radio_device { 854834f4d1SAlexey Klimov /* reference to USB and video device */ 864834f4d1SAlexey Klimov struct usb_device *usbdev; 874834f4d1SAlexey Klimov struct usb_interface *intf; 884834f4d1SAlexey Klimov struct video_device vdev; 894834f4d1SAlexey Klimov struct v4l2_device v4l2_dev; 904834f4d1SAlexey Klimov struct v4l2_ctrl_handler hdl; 914834f4d1SAlexey Klimov 924834f4d1SAlexey Klimov u8 *buffer; 934834f4d1SAlexey Klimov struct mutex lock; /* buffer locking */ 944834f4d1SAlexey Klimov int curfreq; 954834f4d1SAlexey Klimov u16 volume; 964834f4d1SAlexey Klimov int stereo; 974834f4d1SAlexey Klimov bool muted; 984834f4d1SAlexey Klimov }; 994834f4d1SAlexey Klimov 1004834f4d1SAlexey Klimov static inline struct ma901radio_device *to_ma901radio_dev(struct v4l2_device *v4l2_dev) 1014834f4d1SAlexey Klimov { 1024834f4d1SAlexey Klimov return container_of(v4l2_dev, struct ma901radio_device, v4l2_dev); 1034834f4d1SAlexey Klimov } 1044834f4d1SAlexey Klimov 1054834f4d1SAlexey Klimov /* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */ 1064834f4d1SAlexey Klimov static int ma901radio_set_freq(struct ma901radio_device *radio, int freq) 1074834f4d1SAlexey Klimov { 1084834f4d1SAlexey Klimov unsigned int freq_send = 0x300 + (freq >> 5) / 25; 1094834f4d1SAlexey Klimov int retval; 1104834f4d1SAlexey Klimov 1114834f4d1SAlexey Klimov radio->buffer[0] = 0x0a; 1124834f4d1SAlexey Klimov radio->buffer[1] = MA901_RADIO_SET_FREQ; 1134834f4d1SAlexey Klimov radio->buffer[2] = ((freq_send >> 8) & 0xff) + 0x80; 1144834f4d1SAlexey Klimov radio->buffer[3] = freq_send & 0xff; 1154834f4d1SAlexey Klimov radio->buffer[4] = 0x00; 1164834f4d1SAlexey Klimov radio->buffer[5] = 0x00; 1174834f4d1SAlexey Klimov radio->buffer[6] = 0x00; 1184834f4d1SAlexey Klimov radio->buffer[7] = 0x00; 1194834f4d1SAlexey Klimov 1204834f4d1SAlexey Klimov retval = usb_control_msg(radio->usbdev, usb_sndctrlpipe(radio->usbdev, 0), 1214834f4d1SAlexey Klimov 9, 0x21, 0x0300, 0, 1224834f4d1SAlexey Klimov radio->buffer, BUFFER_LENGTH, USB_TIMEOUT); 1234834f4d1SAlexey Klimov if (retval < 0) 1244834f4d1SAlexey Klimov return retval; 1254834f4d1SAlexey Klimov 1264834f4d1SAlexey Klimov radio->curfreq = freq; 1274834f4d1SAlexey Klimov return 0; 1284834f4d1SAlexey Klimov } 1294834f4d1SAlexey Klimov 1304834f4d1SAlexey Klimov static int ma901radio_set_volume(struct ma901radio_device *radio, u16 vol_to_set) 1314834f4d1SAlexey Klimov { 1324834f4d1SAlexey Klimov int retval; 1334834f4d1SAlexey Klimov 1344834f4d1SAlexey Klimov radio->buffer[0] = 0x0a; 1354834f4d1SAlexey Klimov radio->buffer[1] = MA901_RADIO_SET_VOLUME; 1364834f4d1SAlexey Klimov radio->buffer[2] = 0xc2; 1374834f4d1SAlexey Klimov radio->buffer[3] = vol_to_set + 0x20; 1384834f4d1SAlexey Klimov radio->buffer[4] = 0x00; 1394834f4d1SAlexey Klimov radio->buffer[5] = 0x00; 1404834f4d1SAlexey Klimov radio->buffer[6] = 0x00; 1414834f4d1SAlexey Klimov radio->buffer[7] = 0x00; 1424834f4d1SAlexey Klimov 1434834f4d1SAlexey Klimov retval = usb_control_msg(radio->usbdev, usb_sndctrlpipe(radio->usbdev, 0), 1444834f4d1SAlexey Klimov 9, 0x21, 0x0300, 0, 1454834f4d1SAlexey Klimov radio->buffer, BUFFER_LENGTH, USB_TIMEOUT); 1464834f4d1SAlexey Klimov if (retval < 0) 1474834f4d1SAlexey Klimov return retval; 1484834f4d1SAlexey Klimov 1494834f4d1SAlexey Klimov radio->volume = vol_to_set; 1504834f4d1SAlexey Klimov return retval; 1514834f4d1SAlexey Klimov } 1524834f4d1SAlexey Klimov 1534834f4d1SAlexey Klimov static int ma901_set_stereo(struct ma901radio_device *radio, u8 stereo) 1544834f4d1SAlexey Klimov { 1554834f4d1SAlexey Klimov int retval; 1564834f4d1SAlexey Klimov 1574834f4d1SAlexey Klimov radio->buffer[0] = 0x0a; 1584834f4d1SAlexey Klimov radio->buffer[1] = MA901_RADIO_SET_MONO_STEREO; 1594834f4d1SAlexey Klimov radio->buffer[2] = stereo; 1604834f4d1SAlexey Klimov radio->buffer[3] = 0x00; 1614834f4d1SAlexey Klimov radio->buffer[4] = 0x00; 1624834f4d1SAlexey Klimov radio->buffer[5] = 0x00; 1634834f4d1SAlexey Klimov radio->buffer[6] = 0x00; 1644834f4d1SAlexey Klimov radio->buffer[7] = 0x00; 1654834f4d1SAlexey Klimov 1664834f4d1SAlexey Klimov retval = usb_control_msg(radio->usbdev, usb_sndctrlpipe(radio->usbdev, 0), 1674834f4d1SAlexey Klimov 9, 0x21, 0x0300, 0, 1684834f4d1SAlexey Klimov radio->buffer, BUFFER_LENGTH, USB_TIMEOUT); 1694834f4d1SAlexey Klimov 1704834f4d1SAlexey Klimov if (retval < 0) 1714834f4d1SAlexey Klimov return retval; 1724834f4d1SAlexey Klimov 1734834f4d1SAlexey Klimov if (stereo == MA901_WANT_STEREO) 1744834f4d1SAlexey Klimov radio->stereo = V4L2_TUNER_MODE_STEREO; 1754834f4d1SAlexey Klimov else 1764834f4d1SAlexey Klimov radio->stereo = V4L2_TUNER_MODE_MONO; 1774834f4d1SAlexey Klimov 1784834f4d1SAlexey Klimov return retval; 1794834f4d1SAlexey Klimov } 1804834f4d1SAlexey Klimov 1814834f4d1SAlexey Klimov /* Handle unplugging the device. 1824834f4d1SAlexey Klimov * We call video_unregister_device in any case. 1834834f4d1SAlexey Klimov * The last function called in this procedure is 1844834f4d1SAlexey Klimov * usb_ma901radio_device_release. 1854834f4d1SAlexey Klimov */ 1864834f4d1SAlexey Klimov static void usb_ma901radio_disconnect(struct usb_interface *intf) 1874834f4d1SAlexey Klimov { 1884834f4d1SAlexey Klimov struct ma901radio_device *radio = to_ma901radio_dev(usb_get_intfdata(intf)); 1894834f4d1SAlexey Klimov 1904834f4d1SAlexey Klimov mutex_lock(&radio->lock); 1914834f4d1SAlexey Klimov video_unregister_device(&radio->vdev); 1924834f4d1SAlexey Klimov usb_set_intfdata(intf, NULL); 1934834f4d1SAlexey Klimov v4l2_device_disconnect(&radio->v4l2_dev); 1944834f4d1SAlexey Klimov mutex_unlock(&radio->lock); 1954834f4d1SAlexey Klimov v4l2_device_put(&radio->v4l2_dev); 1964834f4d1SAlexey Klimov } 1974834f4d1SAlexey Klimov 1984834f4d1SAlexey Klimov /* vidioc_querycap - query device capabilities */ 1994834f4d1SAlexey Klimov static int vidioc_querycap(struct file *file, void *priv, 2004834f4d1SAlexey Klimov struct v4l2_capability *v) 2014834f4d1SAlexey Klimov { 2024834f4d1SAlexey Klimov struct ma901radio_device *radio = video_drvdata(file); 2034834f4d1SAlexey Klimov 2044834f4d1SAlexey Klimov strlcpy(v->driver, "radio-ma901", sizeof(v->driver)); 2054834f4d1SAlexey Klimov strlcpy(v->card, "Masterkit MA901 USB FM Radio", sizeof(v->card)); 2064834f4d1SAlexey Klimov usb_make_path(radio->usbdev, v->bus_info, sizeof(v->bus_info)); 2074834f4d1SAlexey Klimov v->device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER; 2084834f4d1SAlexey Klimov v->capabilities = v->device_caps | V4L2_CAP_DEVICE_CAPS; 2094834f4d1SAlexey Klimov return 0; 2104834f4d1SAlexey Klimov } 2114834f4d1SAlexey Klimov 2124834f4d1SAlexey Klimov /* vidioc_g_tuner - get tuner attributes */ 2134834f4d1SAlexey Klimov static int vidioc_g_tuner(struct file *file, void *priv, 2144834f4d1SAlexey Klimov struct v4l2_tuner *v) 2154834f4d1SAlexey Klimov { 2164834f4d1SAlexey Klimov struct ma901radio_device *radio = video_drvdata(file); 2174834f4d1SAlexey Klimov 2184834f4d1SAlexey Klimov if (v->index > 0) 2194834f4d1SAlexey Klimov return -EINVAL; 2204834f4d1SAlexey Klimov 2214834f4d1SAlexey Klimov v->signal = 0; 2224834f4d1SAlexey Klimov 2234834f4d1SAlexey Klimov /* TODO: the same words like in _probe() goes here. 2244834f4d1SAlexey Klimov * When receiving of stats will be implemented then we can call 2254834f4d1SAlexey Klimov * ma901radio_get_stat(). 2264834f4d1SAlexey Klimov * retval = ma901radio_get_stat(radio, &is_stereo, &v->signal); 2274834f4d1SAlexey Klimov */ 2284834f4d1SAlexey Klimov 2294834f4d1SAlexey Klimov strcpy(v->name, "FM"); 2304834f4d1SAlexey Klimov v->type = V4L2_TUNER_RADIO; 2314834f4d1SAlexey Klimov v->rangelow = FREQ_MIN * FREQ_MUL; 2324834f4d1SAlexey Klimov v->rangehigh = FREQ_MAX * FREQ_MUL; 2334834f4d1SAlexey Klimov v->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO; 2344834f4d1SAlexey Klimov /* v->rxsubchans = is_stereo ? V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO; */ 2354834f4d1SAlexey Klimov v->audmode = radio->stereo ? 2364834f4d1SAlexey Klimov V4L2_TUNER_MODE_STEREO : V4L2_TUNER_MODE_MONO; 2374834f4d1SAlexey Klimov return 0; 2384834f4d1SAlexey Klimov } 2394834f4d1SAlexey Klimov 2404834f4d1SAlexey Klimov /* vidioc_s_tuner - set tuner attributes */ 2414834f4d1SAlexey Klimov static int vidioc_s_tuner(struct file *file, void *priv, 2422f73c7c5SHans Verkuil const struct v4l2_tuner *v) 2434834f4d1SAlexey Klimov { 2444834f4d1SAlexey Klimov struct ma901radio_device *radio = video_drvdata(file); 2454834f4d1SAlexey Klimov 2464834f4d1SAlexey Klimov if (v->index > 0) 2474834f4d1SAlexey Klimov return -EINVAL; 2484834f4d1SAlexey Klimov 2494834f4d1SAlexey Klimov /* mono/stereo selector */ 2504834f4d1SAlexey Klimov switch (v->audmode) { 2514834f4d1SAlexey Klimov case V4L2_TUNER_MODE_MONO: 2524834f4d1SAlexey Klimov return ma901_set_stereo(radio, MA901_WANT_MONO); 2534834f4d1SAlexey Klimov default: 2544834f4d1SAlexey Klimov return ma901_set_stereo(radio, MA901_WANT_STEREO); 2554834f4d1SAlexey Klimov } 2564834f4d1SAlexey Klimov } 2574834f4d1SAlexey Klimov 2584834f4d1SAlexey Klimov /* vidioc_s_frequency - set tuner radio frequency */ 2594834f4d1SAlexey Klimov static int vidioc_s_frequency(struct file *file, void *priv, 260b530a447SHans Verkuil const struct v4l2_frequency *f) 2614834f4d1SAlexey Klimov { 2624834f4d1SAlexey Klimov struct ma901radio_device *radio = video_drvdata(file); 2634834f4d1SAlexey Klimov 2644834f4d1SAlexey Klimov if (f->tuner != 0) 2654834f4d1SAlexey Klimov return -EINVAL; 2664834f4d1SAlexey Klimov 2674834f4d1SAlexey Klimov return ma901radio_set_freq(radio, clamp_t(unsigned, f->frequency, 2684834f4d1SAlexey Klimov FREQ_MIN * FREQ_MUL, FREQ_MAX * FREQ_MUL)); 2694834f4d1SAlexey Klimov } 2704834f4d1SAlexey Klimov 2714834f4d1SAlexey Klimov /* vidioc_g_frequency - get tuner radio frequency */ 2724834f4d1SAlexey Klimov static int vidioc_g_frequency(struct file *file, void *priv, 2734834f4d1SAlexey Klimov struct v4l2_frequency *f) 2744834f4d1SAlexey Klimov { 2754834f4d1SAlexey Klimov struct ma901radio_device *radio = video_drvdata(file); 2764834f4d1SAlexey Klimov 2774834f4d1SAlexey Klimov if (f->tuner != 0) 2784834f4d1SAlexey Klimov return -EINVAL; 2794834f4d1SAlexey Klimov f->frequency = radio->curfreq; 2804834f4d1SAlexey Klimov 2814834f4d1SAlexey Klimov return 0; 2824834f4d1SAlexey Klimov } 2834834f4d1SAlexey Klimov 2844834f4d1SAlexey Klimov static int usb_ma901radio_s_ctrl(struct v4l2_ctrl *ctrl) 2854834f4d1SAlexey Klimov { 2864834f4d1SAlexey Klimov struct ma901radio_device *radio = 2874834f4d1SAlexey Klimov container_of(ctrl->handler, struct ma901radio_device, hdl); 2884834f4d1SAlexey Klimov 2894834f4d1SAlexey Klimov switch (ctrl->id) { 2904834f4d1SAlexey Klimov case V4L2_CID_AUDIO_VOLUME: /* set volume */ 2914834f4d1SAlexey Klimov return ma901radio_set_volume(radio, (u16)ctrl->val); 2924834f4d1SAlexey Klimov } 2934834f4d1SAlexey Klimov 2944834f4d1SAlexey Klimov return -EINVAL; 2954834f4d1SAlexey Klimov } 2964834f4d1SAlexey Klimov 2974834f4d1SAlexey Klimov /* TODO: Should we really need to implement suspend and resume functions? 2984834f4d1SAlexey Klimov * Radio has it's own memory and will continue playing if power is present 2994834f4d1SAlexey Klimov * on usb port and on resume it will start to play again based on freq, volume 3004834f4d1SAlexey Klimov * values in device memory. 3014834f4d1SAlexey Klimov */ 3024834f4d1SAlexey Klimov static int usb_ma901radio_suspend(struct usb_interface *intf, pm_message_t message) 3034834f4d1SAlexey Klimov { 3044834f4d1SAlexey Klimov return 0; 3054834f4d1SAlexey Klimov } 3064834f4d1SAlexey Klimov 3074834f4d1SAlexey Klimov static int usb_ma901radio_resume(struct usb_interface *intf) 3084834f4d1SAlexey Klimov { 3094834f4d1SAlexey Klimov return 0; 3104834f4d1SAlexey Klimov } 3114834f4d1SAlexey Klimov 3124834f4d1SAlexey Klimov static const struct v4l2_ctrl_ops usb_ma901radio_ctrl_ops = { 3134834f4d1SAlexey Klimov .s_ctrl = usb_ma901radio_s_ctrl, 3144834f4d1SAlexey Klimov }; 3154834f4d1SAlexey Klimov 3164834f4d1SAlexey Klimov /* File system interface */ 3174834f4d1SAlexey Klimov static const struct v4l2_file_operations usb_ma901radio_fops = { 3184834f4d1SAlexey Klimov .owner = THIS_MODULE, 3194834f4d1SAlexey Klimov .open = v4l2_fh_open, 3204834f4d1SAlexey Klimov .release = v4l2_fh_release, 3214834f4d1SAlexey Klimov .poll = v4l2_ctrl_poll, 3224834f4d1SAlexey Klimov .unlocked_ioctl = video_ioctl2, 3234834f4d1SAlexey Klimov }; 3244834f4d1SAlexey Klimov 3254834f4d1SAlexey Klimov static const struct v4l2_ioctl_ops usb_ma901radio_ioctl_ops = { 3264834f4d1SAlexey Klimov .vidioc_querycap = vidioc_querycap, 3274834f4d1SAlexey Klimov .vidioc_g_tuner = vidioc_g_tuner, 3284834f4d1SAlexey Klimov .vidioc_s_tuner = vidioc_s_tuner, 3294834f4d1SAlexey Klimov .vidioc_g_frequency = vidioc_g_frequency, 3304834f4d1SAlexey Klimov .vidioc_s_frequency = vidioc_s_frequency, 3314834f4d1SAlexey Klimov .vidioc_log_status = v4l2_ctrl_log_status, 3324834f4d1SAlexey Klimov .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 3334834f4d1SAlexey Klimov .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 3344834f4d1SAlexey Klimov }; 3354834f4d1SAlexey Klimov 3364834f4d1SAlexey Klimov static void usb_ma901radio_release(struct v4l2_device *v4l2_dev) 3374834f4d1SAlexey Klimov { 3384834f4d1SAlexey Klimov struct ma901radio_device *radio = to_ma901radio_dev(v4l2_dev); 3394834f4d1SAlexey Klimov 3404834f4d1SAlexey Klimov v4l2_ctrl_handler_free(&radio->hdl); 3414834f4d1SAlexey Klimov v4l2_device_unregister(&radio->v4l2_dev); 3424834f4d1SAlexey Klimov kfree(radio->buffer); 3434834f4d1SAlexey Klimov kfree(radio); 3444834f4d1SAlexey Klimov } 3454834f4d1SAlexey Klimov 3464834f4d1SAlexey Klimov /* check if the device is present and register with v4l and usb if it is */ 3474834f4d1SAlexey Klimov static int usb_ma901radio_probe(struct usb_interface *intf, 3484834f4d1SAlexey Klimov const struct usb_device_id *id) 3494834f4d1SAlexey Klimov { 3504834f4d1SAlexey Klimov struct ma901radio_device *radio; 3514834f4d1SAlexey Klimov int retval = 0; 3524834f4d1SAlexey Klimov 3534834f4d1SAlexey Klimov radio = kzalloc(sizeof(struct ma901radio_device), GFP_KERNEL); 3544834f4d1SAlexey Klimov if (!radio) { 3554834f4d1SAlexey Klimov dev_err(&intf->dev, "kzalloc for ma901radio_device failed\n"); 3564834f4d1SAlexey Klimov retval = -ENOMEM; 3574834f4d1SAlexey Klimov goto err; 3584834f4d1SAlexey Klimov } 3594834f4d1SAlexey Klimov 3604834f4d1SAlexey Klimov radio->buffer = kmalloc(BUFFER_LENGTH, GFP_KERNEL); 3614834f4d1SAlexey Klimov if (!radio->buffer) { 3624834f4d1SAlexey Klimov dev_err(&intf->dev, "kmalloc for radio->buffer failed\n"); 3634834f4d1SAlexey Klimov retval = -ENOMEM; 3644834f4d1SAlexey Klimov goto err_nobuf; 3654834f4d1SAlexey Klimov } 3664834f4d1SAlexey Klimov 3674834f4d1SAlexey Klimov retval = v4l2_device_register(&intf->dev, &radio->v4l2_dev); 3684834f4d1SAlexey Klimov if (retval < 0) { 3694834f4d1SAlexey Klimov dev_err(&intf->dev, "couldn't register v4l2_device\n"); 3704834f4d1SAlexey Klimov goto err_v4l2; 3714834f4d1SAlexey Klimov } 3724834f4d1SAlexey Klimov 3734834f4d1SAlexey Klimov v4l2_ctrl_handler_init(&radio->hdl, 1); 3744834f4d1SAlexey Klimov 3754834f4d1SAlexey Klimov /* TODO:It looks like this radio doesn't have mute/unmute control 3764834f4d1SAlexey Klimov * and windows program just emulate it using volume control. 3774834f4d1SAlexey Klimov * Let's plan to do the same in this driver. 3784834f4d1SAlexey Klimov * 3794834f4d1SAlexey Klimov * v4l2_ctrl_new_std(&radio->hdl, &usb_ma901radio_ctrl_ops, 3804834f4d1SAlexey Klimov * V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 3814834f4d1SAlexey Klimov */ 3824834f4d1SAlexey Klimov 3834834f4d1SAlexey Klimov v4l2_ctrl_new_std(&radio->hdl, &usb_ma901radio_ctrl_ops, 3844834f4d1SAlexey Klimov V4L2_CID_AUDIO_VOLUME, MA901_VOLUME_MIN, 3854834f4d1SAlexey Klimov MA901_VOLUME_MAX, 1, MA901_VOLUME_MAX); 3864834f4d1SAlexey Klimov 3874834f4d1SAlexey Klimov if (radio->hdl.error) { 3884834f4d1SAlexey Klimov retval = radio->hdl.error; 3894834f4d1SAlexey Klimov dev_err(&intf->dev, "couldn't register control\n"); 3904834f4d1SAlexey Klimov goto err_ctrl; 3914834f4d1SAlexey Klimov } 3924834f4d1SAlexey Klimov mutex_init(&radio->lock); 3934834f4d1SAlexey Klimov 3944834f4d1SAlexey Klimov radio->v4l2_dev.ctrl_handler = &radio->hdl; 3954834f4d1SAlexey Klimov radio->v4l2_dev.release = usb_ma901radio_release; 3964834f4d1SAlexey Klimov strlcpy(radio->vdev.name, radio->v4l2_dev.name, 3974834f4d1SAlexey Klimov sizeof(radio->vdev.name)); 3984834f4d1SAlexey Klimov radio->vdev.v4l2_dev = &radio->v4l2_dev; 3994834f4d1SAlexey Klimov radio->vdev.fops = &usb_ma901radio_fops; 4004834f4d1SAlexey Klimov radio->vdev.ioctl_ops = &usb_ma901radio_ioctl_ops; 4014834f4d1SAlexey Klimov radio->vdev.release = video_device_release_empty; 4024834f4d1SAlexey Klimov radio->vdev.lock = &radio->lock; 4034834f4d1SAlexey Klimov set_bit(V4L2_FL_USE_FH_PRIO, &radio->vdev.flags); 4044834f4d1SAlexey Klimov 4054834f4d1SAlexey Klimov radio->usbdev = interface_to_usbdev(intf); 4064834f4d1SAlexey Klimov radio->intf = intf; 4074834f4d1SAlexey Klimov usb_set_intfdata(intf, &radio->v4l2_dev); 4084834f4d1SAlexey Klimov radio->curfreq = 95.21 * FREQ_MUL; 4094834f4d1SAlexey Klimov 4104834f4d1SAlexey Klimov video_set_drvdata(&radio->vdev, radio); 4114834f4d1SAlexey Klimov 4124834f4d1SAlexey Klimov /* TODO: we can get some statistics (freq, volume) from device 4134834f4d1SAlexey Klimov * but it's not implemented yet. After insertion in usb-port radio 4144834f4d1SAlexey Klimov * setups frequency and starts playing without any initialization. 4154834f4d1SAlexey Klimov * So we don't call usb_ma901radio_init/get_stat() here. 4164834f4d1SAlexey Klimov * retval = usb_ma901radio_init(radio); 4174834f4d1SAlexey Klimov */ 4184834f4d1SAlexey Klimov 4194834f4d1SAlexey Klimov retval = video_register_device(&radio->vdev, VFL_TYPE_RADIO, 4204834f4d1SAlexey Klimov radio_nr); 4214834f4d1SAlexey Klimov if (retval < 0) { 4224834f4d1SAlexey Klimov dev_err(&intf->dev, "could not register video device\n"); 4234834f4d1SAlexey Klimov goto err_vdev; 4244834f4d1SAlexey Klimov } 4254834f4d1SAlexey Klimov 4264834f4d1SAlexey Klimov return 0; 4274834f4d1SAlexey Klimov 4284834f4d1SAlexey Klimov err_vdev: 4294834f4d1SAlexey Klimov v4l2_ctrl_handler_free(&radio->hdl); 4304834f4d1SAlexey Klimov err_ctrl: 4314834f4d1SAlexey Klimov v4l2_device_unregister(&radio->v4l2_dev); 4324834f4d1SAlexey Klimov err_v4l2: 4334834f4d1SAlexey Klimov kfree(radio->buffer); 4344834f4d1SAlexey Klimov err_nobuf: 4354834f4d1SAlexey Klimov kfree(radio); 4364834f4d1SAlexey Klimov err: 4374834f4d1SAlexey Klimov return retval; 4384834f4d1SAlexey Klimov } 4394834f4d1SAlexey Klimov 4404834f4d1SAlexey Klimov /* USB Device ID List */ 4414834f4d1SAlexey Klimov static struct usb_device_id usb_ma901radio_device_table[] = { 4424834f4d1SAlexey Klimov { USB_DEVICE_AND_INTERFACE_INFO(USB_MA901_VENDOR, USB_MA901_PRODUCT, 4434834f4d1SAlexey Klimov USB_CLASS_HID, 0, 0) }, 4444834f4d1SAlexey Klimov { } /* Terminating entry */ 4454834f4d1SAlexey Klimov }; 4464834f4d1SAlexey Klimov 4474834f4d1SAlexey Klimov MODULE_DEVICE_TABLE(usb, usb_ma901radio_device_table); 4484834f4d1SAlexey Klimov 4494834f4d1SAlexey Klimov /* USB subsystem interface */ 4504834f4d1SAlexey Klimov static struct usb_driver usb_ma901radio_driver = { 4514834f4d1SAlexey Klimov .name = MA901_DRIVER_NAME, 4524834f4d1SAlexey Klimov .probe = usb_ma901radio_probe, 4534834f4d1SAlexey Klimov .disconnect = usb_ma901radio_disconnect, 4544834f4d1SAlexey Klimov .suspend = usb_ma901radio_suspend, 4554834f4d1SAlexey Klimov .resume = usb_ma901radio_resume, 4564834f4d1SAlexey Klimov .reset_resume = usb_ma901radio_resume, 4574834f4d1SAlexey Klimov .id_table = usb_ma901radio_device_table, 4584834f4d1SAlexey Klimov }; 4594834f4d1SAlexey Klimov 4604834f4d1SAlexey Klimov module_usb_driver(usb_ma901radio_driver); 461