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