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)  * A driver for the AverMedia MR 800 USB FM radio. This device plugs
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * into both the USB and an analog audio input, so this thing
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * only deals with initialization and frequency setting, the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * audio data has to be handled by a sound driver.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  * Copyright (c) 2008 Alexey Klimov <klimov.linux@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  * Big thanks to authors and contributors of dsbr100.c and radio-si470x.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  * When work was looked pretty good, i discover this:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15)  * http://av-usbradio.sourceforge.net/index.php
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16)  * http://sourceforge.net/projects/av-usbradio/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17)  * Latest release of theirs project was in 2005.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18)  * Probably, this driver could be improved through using their
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19)  * achievements (specifications given).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20)  * Also, Faidon Liambotis <paravoid@debian.org> wrote nice driver for this radio
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21)  * in 2007. He allowed to use his driver to improve current mr800 radio driver.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22)  * http://www.spinics.net/lists/linux-usb-devel/msg10109.html
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24)  * Version 0.01:	First working version.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25)  *			It's required to blacklist AverMedia USB Radio
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26)  *			in usbhid/hid-quirks.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27)  * Version 0.10:	A lot of cleanups and fixes: unpluging the device,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28)  *			few mutex locks were added, codinstyle issues, etc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29)  *			Added stereo support. Thanks to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30)  *			Douglas Schilling Landgraf <dougsland@gmail.com> and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31)  *			David Ellingsworth <david@identd.dyndns.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32)  *			for discussion, help and support.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33)  * Version 0.11:	Converted to v4l2_device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35)  * Many things to do:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36)  *	- Correct power management of device (suspend & resume)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37)  *	- Add code for scanning and smooth tuning
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38)  *	- Add code for sensitivity value
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39)  *	- Correct mistakes
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40)  *	- In Japan another FREQ_MIN and FREQ_MAX
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) /* kernel includes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) #include <linux/videodev2.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) #include <media/v4l2-device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) #include <media/v4l2-ioctl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) #include <media/v4l2-ctrls.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) #include <media/v4l2-event.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) #include <linux/usb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) /* driver and module definitions */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) #define DRIVER_AUTHOR "Alexey Klimov <klimov.linux@gmail.com>"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) #define DRIVER_DESC "AverMedia MR 800 USB FM radio driver"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) #define DRIVER_VERSION "0.1.2"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) MODULE_AUTHOR(DRIVER_AUTHOR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) MODULE_DESCRIPTION(DRIVER_DESC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) MODULE_VERSION(DRIVER_VERSION);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) #define USB_AMRADIO_VENDOR 0x07ca
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) #define USB_AMRADIO_PRODUCT 0xb800
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) /* dev_warn macro with driver name */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) #define MR800_DRIVER_NAME "radio-mr800"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) #define amradio_dev_warn(dev, fmt, arg...)				\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 		dev_warn(dev, MR800_DRIVER_NAME " - " fmt, ##arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) #define amradio_dev_err(dev, fmt, arg...) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 		dev_err(dev, MR800_DRIVER_NAME " - " fmt, ##arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) /* Probably USB_TIMEOUT should be modified in module parameter */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) #define BUFFER_LENGTH 8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) #define USB_TIMEOUT 500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) /* Frequency limits in MHz -- these are European values.  For Japanese
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) devices, that would be 76 and 91.  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) #define FREQ_MIN  87.5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) #define FREQ_MAX 108.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) #define FREQ_MUL 16000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89)  * Commands that device should understand
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90)  * List isn't full and will be updated with implementation of new functions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) #define AMRADIO_SET_FREQ	0xa4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) #define AMRADIO_GET_READY_FLAG	0xa5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) #define AMRADIO_GET_SIGNAL	0xa7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) #define AMRADIO_GET_FREQ	0xa8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) #define AMRADIO_SET_SEARCH_UP	0xa9
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) #define AMRADIO_SET_SEARCH_DOWN	0xaa
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) #define AMRADIO_SET_MUTE	0xab
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) #define AMRADIO_SET_RIGHT_MUTE	0xac
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) #define AMRADIO_SET_LEFT_MUTE	0xad
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) #define AMRADIO_SET_MONO	0xae
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) #define AMRADIO_SET_SEARCH_LVL	0xb0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) #define AMRADIO_STOP_SEARCH	0xb1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) /* Comfortable defines for amradio_set_stereo */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) #define WANT_STEREO		0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) #define WANT_MONO		0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) /* module parameter */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) static int radio_nr = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) module_param(radio_nr, int, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) MODULE_PARM_DESC(radio_nr, "Radio Nr");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) /* Data for one (physical) device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) struct amradio_device {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	/* reference to USB and video device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	struct usb_device *usbdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	struct usb_interface *intf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 	struct video_device vdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	struct v4l2_device v4l2_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	struct v4l2_ctrl_handler hdl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	u8 *buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	struct mutex lock;	/* buffer locking */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	int curfreq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	int stereo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	int muted;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) static inline struct amradio_device *to_amradio_dev(struct v4l2_device *v4l2_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	return container_of(v4l2_dev, struct amradio_device, v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) static int amradio_send_cmd(struct amradio_device *radio, u8 cmd, u8 arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 		u8 *extra, u8 extralen, bool reply)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	int size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	radio->buffer[0] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	radio->buffer[1] = 0x55;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	radio->buffer[2] = 0xaa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	radio->buffer[3] = extralen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	radio->buffer[4] = cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	radio->buffer[5] = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	radio->buffer[6] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	radio->buffer[7] = extra || reply ? 8 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 		radio->buffer, BUFFER_LENGTH, &size, USB_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	if (retval < 0 || size != BUFFER_LENGTH) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 		if (video_is_registered(&radio->vdev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 			amradio_dev_warn(&radio->vdev.dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 					"cmd %02x failed\n", cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 		return retval ? retval : -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	if (!extra && !reply)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	if (extra) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		memcpy(radio->buffer, extra, extralen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 		memset(radio->buffer + extralen, 0, 8 - extralen);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 		retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 			radio->buffer, BUFFER_LENGTH, &size, USB_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 		memset(radio->buffer, 0, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 		retval = usb_bulk_msg(radio->usbdev, usb_rcvbulkpipe(radio->usbdev, 0x81),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 			radio->buffer, BUFFER_LENGTH, &size, USB_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	if (retval == 0 && size == BUFFER_LENGTH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	if (video_is_registered(&radio->vdev) && cmd != AMRADIO_GET_READY_FLAG)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		amradio_dev_warn(&radio->vdev.dev, "follow-up to cmd %02x failed\n", cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	return retval ? retval : -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) /* switch on/off the radio. Send 8 bytes to device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) static int amradio_set_mute(struct amradio_device *radio, bool mute)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	int ret = amradio_send_cmd(radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 			AMRADIO_SET_MUTE, mute, NULL, 0, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 	if (!ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 		radio->muted = mute;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) /* 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 191) static int amradio_set_freq(struct amradio_device *radio, int freq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	unsigned short freq_send;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	u8 buf[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	/* we need to be sure that frequency isn't out of range */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	freq = clamp_t(unsigned, freq, FREQ_MIN * FREQ_MUL, FREQ_MAX * FREQ_MUL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	freq_send = 0x10 + (freq >> 3) / 25;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	/* frequency is calculated from freq_send and placed in first 2 bytes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	buf[0] = (freq_send >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	buf[1] = freq_send & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	buf[2] = 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	retval = amradio_send_cmd(radio, AMRADIO_SET_FREQ, 0, buf, 3, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 		return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	radio->curfreq = freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	msleep(40);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	return 0;
^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) static int amradio_set_stereo(struct amradio_device *radio, bool stereo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 	int ret = amradio_send_cmd(radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 			AMRADIO_SET_MONO, !stereo, NULL, 0, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	if (!ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 		radio->stereo = stereo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) static int amradio_get_stat(struct amradio_device *radio, bool *is_stereo, u32 *signal)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	int ret = amradio_send_cmd(radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 			AMRADIO_GET_SIGNAL, 0, NULL, 0, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	*is_stereo = radio->buffer[2] >> 7;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	*signal = (radio->buffer[3] & 0xf0) << 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) /* Handle unplugging the device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237)  * We call video_unregister_device in any case.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)  * The last function called in this procedure is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)  * usb_amradio_device_release.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) static void usb_amradio_disconnect(struct usb_interface *intf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 	struct amradio_device *radio = to_amradio_dev(usb_get_intfdata(intf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	mutex_lock(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	video_unregister_device(&radio->vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	amradio_set_mute(radio, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	usb_set_intfdata(intf, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	v4l2_device_disconnect(&radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	mutex_unlock(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	v4l2_device_put(&radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) /* vidioc_querycap - query device capabilities */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) static int vidioc_querycap(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 					struct v4l2_capability *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	struct amradio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	strscpy(v->driver, "radio-mr800", sizeof(v->driver));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 	strscpy(v->card, "AverMedia MR 800 USB FM Radio", sizeof(v->card));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	usb_make_path(radio->usbdev, v->bus_info, sizeof(v->bus_info));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) /* vidioc_g_tuner - get tuner attributes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) static int vidioc_g_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 				struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	struct amradio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	bool is_stereo = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	if (v->index > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	v->signal = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	retval = amradio_get_stat(radio, &is_stereo, &v->signal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 		return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	strscpy(v->name, "FM", sizeof(v->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 	v->type = V4L2_TUNER_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	v->rangelow = FREQ_MIN * FREQ_MUL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	v->rangehigh = FREQ_MAX * FREQ_MUL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	v->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		V4L2_TUNER_CAP_HWSEEK_WRAP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	v->rxsubchans = is_stereo ? V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 	v->audmode = radio->stereo ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 		V4L2_TUNER_MODE_STEREO : V4L2_TUNER_MODE_MONO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) /* vidioc_s_tuner - set tuner attributes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) static int vidioc_s_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 				const struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 	struct amradio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 	if (v->index > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	/* mono/stereo selector */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	switch (v->audmode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 	case V4L2_TUNER_MODE_MONO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 		return amradio_set_stereo(radio, WANT_MONO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 		return amradio_set_stereo(radio, WANT_STEREO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) /* vidioc_s_frequency - set tuner radio frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) static int vidioc_s_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 				const struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	struct amradio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	if (f->tuner != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	return amradio_set_freq(radio, f->frequency);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) /* vidioc_g_frequency - get tuner radio frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) static int vidioc_g_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 				struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	struct amradio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	f->type = V4L2_TUNER_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 	f->frequency = radio->curfreq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) static int vidioc_s_hw_freq_seek(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 		const struct v4l2_hw_freq_seek *seek)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	static u8 buf[8] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 		0x3d, 0x32, 0x0f, 0x08, 0x3d, 0x32, 0x0f, 0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 	};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	struct amradio_device *radio = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	unsigned long timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 	int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 	if (seek->tuner != 0 || !seek->wrap_around)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	if (file->f_flags & O_NONBLOCK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 		return -EWOULDBLOCK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	retval = amradio_send_cmd(radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 			AMRADIO_SET_SEARCH_LVL, 0, buf, 8, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 		return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	amradio_set_freq(radio, radio->curfreq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	retval = amradio_send_cmd(radio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 		seek->seek_upward ? AMRADIO_SET_SEARCH_UP : AMRADIO_SET_SEARCH_DOWN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 		0, NULL, 0, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 		return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 	timeout = jiffies + msecs_to_jiffies(30000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 	for (;;) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 		if (time_after(jiffies, timeout)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 			retval = -ENODATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 		if (schedule_timeout_interruptible(msecs_to_jiffies(10))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 			retval = -ERESTARTSYS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 		retval = amradio_send_cmd(radio, AMRADIO_GET_READY_FLAG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 				0, NULL, 0, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 		if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 		amradio_send_cmd(radio, AMRADIO_GET_FREQ, 0, NULL, 0, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 		if (radio->buffer[1] || radio->buffer[2]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 			/* To check: sometimes radio->curfreq is set to out of range value */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 			radio->curfreq = (radio->buffer[1] << 8) | radio->buffer[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 			radio->curfreq = (radio->curfreq - 0x10) * 200;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 			amradio_send_cmd(radio, AMRADIO_STOP_SEARCH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 					0, NULL, 0, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 			amradio_set_freq(radio, radio->curfreq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 			retval = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 	amradio_send_cmd(radio, AMRADIO_STOP_SEARCH, 0, NULL, 0, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 	amradio_set_freq(radio, radio->curfreq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 	return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) static int usb_amradio_s_ctrl(struct v4l2_ctrl *ctrl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 	struct amradio_device *radio =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 		container_of(ctrl->handler, struct amradio_device, hdl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 	switch (ctrl->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	case V4L2_CID_AUDIO_MUTE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 		return amradio_set_mute(radio, ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 	return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) static int usb_amradio_init(struct amradio_device *radio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 	int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 	retval = amradio_set_mute(radio, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 		goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 	retval = amradio_set_stereo(radio, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) 	if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 		goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 	retval = amradio_set_freq(radio, radio->curfreq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) 	if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 		goto out_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) out_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 	amradio_dev_err(&radio->vdev.dev, "initialization failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 	return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) /* Suspend device - stop device. Need to be checked and fixed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) static int usb_amradio_suspend(struct usb_interface *intf, pm_message_t message)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 	struct amradio_device *radio = to_amradio_dev(usb_get_intfdata(intf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 	mutex_lock(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 	if (!radio->muted) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 		amradio_set_mute(radio, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 		radio->muted = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 	mutex_unlock(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 	dev_info(&intf->dev, "going into suspend..\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 	return 0;
^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) /* Resume device - start device. Need to be checked and fixed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) static int usb_amradio_resume(struct usb_interface *intf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 	struct amradio_device *radio = to_amradio_dev(usb_get_intfdata(intf));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 	mutex_lock(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 	amradio_set_stereo(radio, radio->stereo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 	amradio_set_freq(radio, radio->curfreq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 	if (!radio->muted)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 		amradio_set_mute(radio, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) 	mutex_unlock(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 	dev_info(&intf->dev, "coming out of suspend..\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) static const struct v4l2_ctrl_ops usb_amradio_ctrl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) 	.s_ctrl = usb_amradio_s_ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) /* File system interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) static const struct v4l2_file_operations usb_amradio_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) 	.owner		= THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) 	.open		= v4l2_fh_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) 	.release	= v4l2_fh_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) 	.poll		= v4l2_ctrl_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) 	.unlocked_ioctl	= video_ioctl2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) static const struct v4l2_ioctl_ops usb_amradio_ioctl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) 	.vidioc_querycap    = vidioc_querycap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) 	.vidioc_g_tuner     = vidioc_g_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) 	.vidioc_s_tuner     = vidioc_s_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) 	.vidioc_g_frequency = vidioc_g_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) 	.vidioc_s_frequency = vidioc_s_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) 	.vidioc_s_hw_freq_seek = vidioc_s_hw_freq_seek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) 	.vidioc_log_status  = v4l2_ctrl_log_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) 	.vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) 	.vidioc_unsubscribe_event = v4l2_event_unsubscribe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) static void usb_amradio_release(struct v4l2_device *v4l2_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) 	struct amradio_device *radio = to_amradio_dev(v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) 	/* free rest memory */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) 	v4l2_ctrl_handler_free(&radio->hdl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) 	v4l2_device_unregister(&radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) 	kfree(radio->buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) 	kfree(radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) /* check if the device is present and register with v4l and usb if it is */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) static int usb_amradio_probe(struct usb_interface *intf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) 				const struct usb_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) 	struct amradio_device *radio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) 	int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) 	radio = kzalloc(sizeof(struct amradio_device), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) 	if (!radio) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) 		dev_err(&intf->dev, "kmalloc for amradio_device failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) 		retval = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) 		goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) 	radio->buffer = kmalloc(BUFFER_LENGTH, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) 	if (!radio->buffer) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) 		dev_err(&intf->dev, "kmalloc for radio->buffer failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) 		retval = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) 		goto err_nobuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) 	retval = v4l2_device_register(&intf->dev, &radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) 	if (retval < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) 		dev_err(&intf->dev, "couldn't register v4l2_device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) 		goto err_v4l2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) 	v4l2_ctrl_handler_init(&radio->hdl, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) 	v4l2_ctrl_new_std(&radio->hdl, &usb_amradio_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) 			  V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) 	if (radio->hdl.error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) 		retval = radio->hdl.error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) 		dev_err(&intf->dev, "couldn't register control\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) 		goto err_ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) 	mutex_init(&radio->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) 	radio->v4l2_dev.ctrl_handler = &radio->hdl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) 	radio->v4l2_dev.release = usb_amradio_release;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) 	strscpy(radio->vdev.name, radio->v4l2_dev.name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) 		sizeof(radio->vdev.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) 	radio->vdev.v4l2_dev = &radio->v4l2_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) 	radio->vdev.fops = &usb_amradio_fops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) 	radio->vdev.ioctl_ops = &usb_amradio_ioctl_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) 	radio->vdev.release = video_device_release_empty;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) 	radio->vdev.lock = &radio->lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) 	radio->vdev.device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) 				  V4L2_CAP_HW_FREQ_SEEK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) 	radio->usbdev = interface_to_usbdev(intf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) 	radio->intf = intf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) 	usb_set_intfdata(intf, &radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) 	radio->curfreq = 95.16 * FREQ_MUL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) 	video_set_drvdata(&radio->vdev, radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) 	retval = usb_amradio_init(radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) 	if (retval)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) 		goto err_vdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) 	retval = video_register_device(&radio->vdev, VFL_TYPE_RADIO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) 					radio_nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) 	if (retval < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) 		dev_err(&intf->dev, "could not register video device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) 		goto err_vdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) err_vdev:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) 	v4l2_ctrl_handler_free(&radio->hdl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) err_ctrl:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) 	v4l2_device_unregister(&radio->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) err_v4l2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) 	kfree(radio->buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) err_nobuf:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) 	kfree(radio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) 	return retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) /* USB Device ID List */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) static const struct usb_device_id usb_amradio_device_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) 	{ USB_DEVICE_AND_INTERFACE_INFO(USB_AMRADIO_VENDOR, USB_AMRADIO_PRODUCT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) 							USB_CLASS_HID, 0, 0) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) 	{ }						/* Terminating entry */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) MODULE_DEVICE_TABLE(usb, usb_amradio_device_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) /* USB subsystem interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) static struct usb_driver usb_amradio_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) 	.name			= MR800_DRIVER_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) 	.probe			= usb_amradio_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) 	.disconnect		= usb_amradio_disconnect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) 	.suspend		= usb_amradio_suspend,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) 	.resume			= usb_amradio_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) 	.reset_resume		= usb_amradio_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) 	.id_table		= usb_amradio_device_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) module_usb_driver(usb_amradio_driver);