Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^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);