^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Driver for the MasterKit MA901 USB FM radio. This device plugs
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * into the USB port and an analog audio input or headphones, so this thing
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * only deals with initialization, frequency setting, volume.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Copyright (c) 2012 Alexey Klimov <klimov.linux@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/videodev2.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <media/v4l2-device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <media/v4l2-ioctl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <media/v4l2-ctrls.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <media/v4l2-event.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/usb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #define DRIVER_AUTHOR "Alexey Klimov <klimov.linux@gmail.com>"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define DRIVER_DESC "Masterkit MA901 USB FM radio driver"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define DRIVER_VERSION "0.0.1"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) MODULE_AUTHOR(DRIVER_AUTHOR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) MODULE_DESCRIPTION(DRIVER_DESC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) MODULE_VERSION(DRIVER_VERSION);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define USB_MA901_VENDOR 0x16c0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define USB_MA901_PRODUCT 0x05df
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) /* dev_warn macro with driver name */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define MA901_DRIVER_NAME "radio-ma901"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define ma901radio_dev_warn(dev, fmt, arg...) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) dev_warn(dev, MA901_DRIVER_NAME " - " fmt, ##arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define ma901radio_dev_err(dev, fmt, arg...) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) dev_err(dev, MA901_DRIVER_NAME " - " fmt, ##arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) /* Probably USB_TIMEOUT should be modified in module parameter */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define BUFFER_LENGTH 8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define USB_TIMEOUT 500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define FREQ_MIN 87.5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) #define FREQ_MAX 108.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define FREQ_MUL 16000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define MA901_VOLUME_MAX 16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define MA901_VOLUME_MIN 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) /* Commands that device should understand
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) * List isn't full and will be updated with implementation of new functions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) #define MA901_RADIO_SET_FREQ 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) #define MA901_RADIO_SET_VOLUME 0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) #define MA901_RADIO_SET_MONO_STEREO 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) /* Comfortable defines for ma901radio_set_stereo */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) #define MA901_WANT_STEREO 0x50
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) #define MA901_WANT_MONO 0xd0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) /* module parameter */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) static int radio_nr = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) module_param(radio_nr, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) MODULE_PARM_DESC(radio_nr, "Radio file number");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) /* Data for one (physical) device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) struct ma901radio_device {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) /* reference to USB and video device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) struct usb_device *usbdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) struct usb_interface *intf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) struct video_device vdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) struct v4l2_device v4l2_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) struct v4l2_ctrl_handler hdl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) u8 *buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) struct mutex lock; /* buffer locking */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) int curfreq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) u16 volume;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) int stereo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) bool muted;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) static inline struct ma901radio_device *to_ma901radio_dev(struct v4l2_device *v4l2_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) return container_of(v4l2_dev, struct ma901radio_device, v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) /* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) static int ma901radio_set_freq(struct ma901radio_device *radio, int freq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) unsigned int freq_send = 0x300 + (freq >> 5) / 25;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) radio->buffer[0] = 0x0a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) radio->buffer[1] = MA901_RADIO_SET_FREQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) radio->buffer[2] = ((freq_send >> 8) & 0xff) + 0x80;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) radio->buffer[3] = freq_send & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) radio->buffer[4] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) radio->buffer[5] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) radio->buffer[6] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) radio->buffer[7] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) retval = usb_control_msg(radio->usbdev, usb_sndctrlpipe(radio->usbdev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 9, 0x21, 0x0300, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) radio->buffer, BUFFER_LENGTH, USB_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) radio->curfreq = freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) static int ma901radio_set_volume(struct ma901radio_device *radio, u16 vol_to_set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) radio->buffer[0] = 0x0a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) radio->buffer[1] = MA901_RADIO_SET_VOLUME;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) radio->buffer[2] = 0xc2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) radio->buffer[3] = vol_to_set + 0x20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) radio->buffer[4] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) radio->buffer[5] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) radio->buffer[6] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) radio->buffer[7] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) retval = usb_control_msg(radio->usbdev, usb_sndctrlpipe(radio->usbdev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 9, 0x21, 0x0300, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) radio->buffer, BUFFER_LENGTH, USB_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) radio->volume = vol_to_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) static int ma901_set_stereo(struct ma901radio_device *radio, u8 stereo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) radio->buffer[0] = 0x0a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) radio->buffer[1] = MA901_RADIO_SET_MONO_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) radio->buffer[2] = stereo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) radio->buffer[3] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) radio->buffer[4] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) radio->buffer[5] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) radio->buffer[6] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) radio->buffer[7] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) retval = usb_control_msg(radio->usbdev, usb_sndctrlpipe(radio->usbdev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 9, 0x21, 0x0300, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) radio->buffer, BUFFER_LENGTH, USB_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) if (retval < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) if (stereo == MA901_WANT_STEREO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) radio->stereo = V4L2_TUNER_MODE_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) radio->stereo = V4L2_TUNER_MODE_MONO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) /* Handle unplugging the device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) * We call video_unregister_device in any case.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) * The last function called in this procedure is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) * usb_ma901radio_device_release.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) static void usb_ma901radio_disconnect(struct usb_interface *intf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) struct ma901radio_device *radio = to_ma901radio_dev(usb_get_intfdata(intf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) mutex_lock(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) video_unregister_device(&radio->vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) usb_set_intfdata(intf, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) v4l2_device_disconnect(&radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) mutex_unlock(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) v4l2_device_put(&radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) /* vidioc_querycap - query device capabilities */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) static int vidioc_querycap(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) struct v4l2_capability *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) struct ma901radio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) strscpy(v->driver, "radio-ma901", sizeof(v->driver));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) strscpy(v->card, "Masterkit MA901 USB FM Radio", sizeof(v->card));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) usb_make_path(radio->usbdev, v->bus_info, sizeof(v->bus_info));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) /* vidioc_g_tuner - get tuner attributes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) static int vidioc_g_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) struct ma901radio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) if (v->index > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) v->signal = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) /* TODO: the same words like in _probe() goes here.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) * When receiving of stats will be implemented then we can call
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) * ma901radio_get_stat().
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) * retval = ma901radio_get_stat(radio, &is_stereo, &v->signal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) strscpy(v->name, "FM", sizeof(v->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) v->type = V4L2_TUNER_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) v->rangelow = FREQ_MIN * FREQ_MUL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) v->rangehigh = FREQ_MAX * FREQ_MUL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) v->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) /* v->rxsubchans = is_stereo ? V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO; */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) v->audmode = radio->stereo ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) V4L2_TUNER_MODE_STEREO : V4L2_TUNER_MODE_MONO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) /* vidioc_s_tuner - set tuner attributes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) static int vidioc_s_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) const struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) struct ma901radio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) if (v->index > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) /* mono/stereo selector */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) switch (v->audmode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) case V4L2_TUNER_MODE_MONO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) return ma901_set_stereo(radio, MA901_WANT_MONO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) return ma901_set_stereo(radio, MA901_WANT_STEREO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) /* vidioc_s_frequency - set tuner radio frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) static int vidioc_s_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) const struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) struct ma901radio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) if (f->tuner != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) return ma901radio_set_freq(radio, clamp_t(unsigned, f->frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) FREQ_MIN * FREQ_MUL, FREQ_MAX * FREQ_MUL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) /* vidioc_g_frequency - get tuner radio frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) static int vidioc_g_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) struct ma901radio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) if (f->tuner != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) f->frequency = radio->curfreq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) static int usb_ma901radio_s_ctrl(struct v4l2_ctrl *ctrl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) struct ma901radio_device *radio =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) container_of(ctrl->handler, struct ma901radio_device, hdl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) switch (ctrl->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) case V4L2_CID_AUDIO_VOLUME: /* set volume */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) return ma901radio_set_volume(radio, (u16)ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) /* TODO: Should we really need to implement suspend and resume functions?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) * Radio has it's own memory and will continue playing if power is present
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) * on usb port and on resume it will start to play again based on freq, volume
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) * values in device memory.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) static int usb_ma901radio_suspend(struct usb_interface *intf, pm_message_t message)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) static int usb_ma901radio_resume(struct usb_interface *intf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static const struct v4l2_ctrl_ops usb_ma901radio_ctrl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) .s_ctrl = usb_ma901radio_s_ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) /* File system interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) static const struct v4l2_file_operations usb_ma901radio_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) .open = v4l2_fh_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) .release = v4l2_fh_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) .poll = v4l2_ctrl_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) .unlocked_ioctl = video_ioctl2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) static const struct v4l2_ioctl_ops usb_ma901radio_ioctl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) .vidioc_querycap = vidioc_querycap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) .vidioc_g_tuner = vidioc_g_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) .vidioc_s_tuner = vidioc_s_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) .vidioc_g_frequency = vidioc_g_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) .vidioc_s_frequency = vidioc_s_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) .vidioc_log_status = v4l2_ctrl_log_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) static void usb_ma901radio_release(struct v4l2_device *v4l2_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) struct ma901radio_device *radio = to_ma901radio_dev(v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) v4l2_ctrl_handler_free(&radio->hdl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) v4l2_device_unregister(&radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) kfree(radio->buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) kfree(radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) /* check if the device is present and register with v4l and usb if it is */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) static int usb_ma901radio_probe(struct usb_interface *intf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) const struct usb_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) struct usb_device *dev = interface_to_usbdev(intf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) struct ma901radio_device *radio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) int retval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) /* Masterkit MA901 usb radio has the same USB ID as many others
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) * Atmel V-USB devices. Let's make additional checks to be sure
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) * that this is our device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) if (dev->product && dev->manufacturer &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) (strncmp(dev->product, "MA901", 5) != 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) || strncmp(dev->manufacturer, "www.masterkit.ru", 16) != 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) radio = kzalloc(sizeof(struct ma901radio_device), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) if (!radio) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) dev_err(&intf->dev, "kzalloc for ma901radio_device failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) retval = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) radio->buffer = kmalloc(BUFFER_LENGTH, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) if (!radio->buffer) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) dev_err(&intf->dev, "kmalloc for radio->buffer failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) retval = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) goto err_nobuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) retval = v4l2_device_register(&intf->dev, &radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) if (retval < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) dev_err(&intf->dev, "couldn't register v4l2_device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) goto err_v4l2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) v4l2_ctrl_handler_init(&radio->hdl, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) /* TODO:It looks like this radio doesn't have mute/unmute control
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) * and windows program just emulate it using volume control.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) * Let's plan to do the same in this driver.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) * v4l2_ctrl_new_std(&radio->hdl, &usb_ma901radio_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) * V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) v4l2_ctrl_new_std(&radio->hdl, &usb_ma901radio_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) V4L2_CID_AUDIO_VOLUME, MA901_VOLUME_MIN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) MA901_VOLUME_MAX, 1, MA901_VOLUME_MAX);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) if (radio->hdl.error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) retval = radio->hdl.error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) dev_err(&intf->dev, "couldn't register control\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) goto err_ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) mutex_init(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) radio->v4l2_dev.ctrl_handler = &radio->hdl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) radio->v4l2_dev.release = usb_ma901radio_release;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) strscpy(radio->vdev.name, radio->v4l2_dev.name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) sizeof(radio->vdev.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) radio->vdev.v4l2_dev = &radio->v4l2_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) radio->vdev.fops = &usb_ma901radio_fops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) radio->vdev.ioctl_ops = &usb_ma901radio_ioctl_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) radio->vdev.release = video_device_release_empty;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) radio->vdev.lock = &radio->lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) radio->vdev.device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) radio->usbdev = interface_to_usbdev(intf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) radio->intf = intf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) usb_set_intfdata(intf, &radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) radio->curfreq = 95.21 * FREQ_MUL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) video_set_drvdata(&radio->vdev, radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) /* TODO: we can get some statistics (freq, volume) from device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) * but it's not implemented yet. After insertion in usb-port radio
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) * setups frequency and starts playing without any initialization.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) * So we don't call usb_ma901radio_init/get_stat() here.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) * retval = usb_ma901radio_init(radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) retval = video_register_device(&radio->vdev, VFL_TYPE_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) radio_nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) if (retval < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) dev_err(&intf->dev, "could not register video device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) goto err_vdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) err_vdev:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) v4l2_ctrl_handler_free(&radio->hdl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) err_ctrl:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) v4l2_device_unregister(&radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) err_v4l2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) kfree(radio->buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) err_nobuf:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) kfree(radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) /* USB Device ID List */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) static const struct usb_device_id usb_ma901radio_device_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) { USB_DEVICE_AND_INTERFACE_INFO(USB_MA901_VENDOR, USB_MA901_PRODUCT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) USB_CLASS_HID, 0, 0) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) { } /* Terminating entry */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) MODULE_DEVICE_TABLE(usb, usb_ma901radio_device_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) /* USB subsystem interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) static struct usb_driver usb_ma901radio_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) .name = MA901_DRIVER_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) .probe = usb_ma901radio_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) .disconnect = usb_ma901radio_disconnect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) .suspend = usb_ma901radio_suspend,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) .resume = usb_ma901radio_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) .reset_resume = usb_ma901radio_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) .id_table = usb_ma901radio_device_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) module_usb_driver(usb_ma901radio_driver);