[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / media / radio / radio-mr800.c

/*
 * A driver for the AverMedia MR 800 USB FM radio. This device plugs
 * into both the USB and an analog audio input, so this thing
 * only deals with initialization and frequency setting, the
 * audio data has to be handled by a sound driver.
 *
 * Copyright (c) 2008 Alexey Klimov <klimov.linux@gmail.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 */

/*
 * Big thanks to authors of dsbr100.c and radio-si470x.c
 *
 * When work was looked pretty good, i discover this:
 * http://av-usbradio.sourceforge.net/index.php
 * http://sourceforge.net/projects/av-usbradio/
 * Latest release of theirs project was in 2005.
 * Probably, this driver could be improved trough using their
 * achievements (specifications given).
 * So, we have smth to begin with.
 *
 * History:
 * Version 0.01:	First working version.
 * 			It's required to blacklist AverMedia USB Radio
 * 			in usbhid/hid-quirks.c
 *
 * Many things to do:
 * 	- Correct power managment of device (suspend & resume)
 * 	- Make x86 independance (little-endian and big-endian stuff)
 * 	- Add code for scanning and smooth tuning
 * 	- Checked and add stereo&mono stuff
 * 	- Add code for sensitivity value
 * 	- Correct mistakes
 * 	- In Japan another FREQ_MIN and FREQ_MAX
 */

/* kernel includes */
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/input.h>
#include <linux/videodev2.h>
#include <media/v4l2-common.h>
#include <media/v4l2-ioctl.h>
#include <linux/usb.h>
#include <linux/version.h>	/* for KERNEL_VERSION MACRO */

/* driver and module definitions */
#define DRIVER_AUTHOR "Alexey Klimov <klimov.linux@gmail.com>"
#define DRIVER_DESC "AverMedia MR 800 USB FM radio driver"
#define DRIVER_VERSION "0.01"
#define RADIO_VERSION KERNEL_VERSION(0, 0, 1)

MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");

#define USB_AMRADIO_VENDOR 0x07ca
#define USB_AMRADIO_PRODUCT 0xb800

/* dev_warn macro with driver name */
#define MR800_DRIVER_NAME "radio-mr800"
#define amradio_dev_warn(dev, fmt, arg...)				\
		dev_warn(dev, MR800_DRIVER_NAME " - " fmt, ##arg)

/* Probably USB_TIMEOUT should be modified in module parameter */
#define BUFFER_LENGTH 8
#define USB_TIMEOUT 500

/* Frequency limits in MHz -- these are European values.  For Japanese
devices, that would be 76 and 91.  */
#define FREQ_MIN  87.5
#define FREQ_MAX 108.0
#define FREQ_MUL 16000

/* module parameter */
static int radio_nr = -1;
module_param(radio_nr, int, 0);
MODULE_PARM_DESC(radio_nr, "Radio Nr");

static struct v4l2_queryctrl radio_qctrl[] = {
	{
		.id            = V4L2_CID_AUDIO_MUTE,
		.name          = "Mute",
		.minimum       = 0,
		.maximum       = 1,
		.step	       = 1,
		.default_value = 1,
		.type          = V4L2_CTRL_TYPE_BOOLEAN,
	},
/* HINT: the disabled controls are only here to satify kradio and such apps */
	{	.id		= V4L2_CID_AUDIO_VOLUME,
		.flags		= V4L2_CTRL_FLAG_DISABLED,
	},
	{
		.id		= V4L2_CID_AUDIO_BALANCE,
		.flags		= V4L2_CTRL_FLAG_DISABLED,
	},
	{
		.id		= V4L2_CID_AUDIO_BASS,
		.flags		= V4L2_CTRL_FLAG_DISABLED,
	},
	{
		.id		= V4L2_CID_AUDIO_TREBLE,
		.flags		= V4L2_CTRL_FLAG_DISABLED,
	},
	{
		.id		= V4L2_CID_AUDIO_LOUDNESS,
		.flags		= V4L2_CTRL_FLAG_DISABLED,
	},
};

static int usb_amradio_probe(struct usb_interface *intf,
			     const struct usb_device_id *id);
static void usb_amradio_disconnect(struct usb_interface *intf);
static int usb_amradio_open(struct file *file);
static int usb_amradio_close(struct file *file);
static int usb_amradio_suspend(struct usb_interface *intf,
				pm_message_t message);
static int usb_amradio_resume(struct usb_interface *intf);

/* Data for one (physical) device */
struct amradio_device {
	/* reference to USB and video device */
	struct usb_device *usbdev;
	struct video_device *videodev;

	unsigned char *buffer;
	struct mutex lock;	/* buffer locking */
	int curfreq;
	int stereo;
	int users;
	int removed;
	int muted;
};

/* USB Device ID List */
static struct usb_device_id usb_amradio_device_table[] = {
	{USB_DEVICE_AND_INTERFACE_INFO(USB_AMRADIO_VENDOR, USB_AMRADIO_PRODUCT,
							USB_CLASS_HID, 0, 0) },
	{ }						/* Terminating entry */
};

MODULE_DEVICE_TABLE(usb, usb_amradio_device_table);

/* USB subsystem interface */
static struct usb_driver usb_amradio_driver = {
	.name			= MR800_DRIVER_NAME,
	.probe			= usb_amradio_probe,
	.disconnect		= usb_amradio_disconnect,
	.suspend		= usb_amradio_suspend,
	.resume			= usb_amradio_resume,
	.reset_resume		= usb_amradio_resume,
	.id_table		= usb_amradio_device_table,
	.supports_autosuspend	= 0,
};

/* switch on radio. Send 8 bytes to device. */
static int amradio_start(struct amradio_device *radio)
{
	int retval;
	int size;

	mutex_lock(&radio->lock);

	radio->buffer[0] = 0x00;
	radio->buffer[1] = 0x55;
	radio->buffer[2] = 0xaa;
	radio->buffer[3] = 0x00;
	radio->buffer[4] = 0xab;
	radio->buffer[5] = 0x00;
	radio->buffer[6] = 0x00;
	radio->buffer[7] = 0x00;

	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
		(void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);

	if (retval) {
		mutex_unlock(&radio->lock);
		return retval;
	}

	mutex_unlock(&radio->lock);

	radio->muted = 0;

	return retval;
}

/* switch off radio */
static int amradio_stop(struct amradio_device *radio)
{
	int retval;
	int size;

	/* safety check */
	if (radio->removed)
		return -EIO;

	mutex_lock(&radio->lock);

	radio->buffer[0] = 0x00;
	radio->buffer[1] = 0x55;
	radio->buffer[2] = 0xaa;
	radio->buffer[3] = 0x00;
	radio->buffer[4] = 0xab;
	radio->buffer[5] = 0x01;
	radio->buffer[6] = 0x00;
	radio->buffer[7] = 0x00;

	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
		(void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);

	if (retval) {
		mutex_unlock(&radio->lock);
		return retval;
	}

	mutex_unlock(&radio->lock);

	radio->muted = 1;

	return retval;
}

/* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */
static int amradio_setfreq(struct amradio_device *radio, int freq)
{
	int retval;
	int size;
	unsigned short freq_send = 0x13 + (freq >> 3) / 25;

	/* safety check */
	if (radio->removed)
		return -EIO;

	mutex_lock(&radio->lock);

	radio->buffer[0] = 0x00;
	radio->buffer[1] = 0x55;
	radio->buffer[2] = 0xaa;
	radio->buffer[3] = 0x03;
	radio->buffer[4] = 0xa4;
	radio->buffer[5] = 0x00;
	radio->buffer[6] = 0x00;
	radio->buffer[7] = 0x08;

	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
		(void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);

	if (retval) {
		mutex_unlock(&radio->lock);
		return retval;
	}

	/* frequency is calculated from freq_send and placed in first 2 bytes */
	radio->buffer[0] = (freq_send >> 8) & 0xff;
	radio->buffer[1] = freq_send & 0xff;
	radio->buffer[2] = 0x01;
	radio->buffer[3] = 0x00;
	radio->buffer[4] = 0x00;
	/* 5 and 6 bytes of buffer already = 0x00 */
	radio->buffer[7] = 0x00;

	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
		(void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);

	if (retval) {
		mutex_unlock(&radio->lock);
		return retval;
	}

	mutex_unlock(&radio->lock);

	radio->stereo = 0;

	return retval;
}

/* USB subsystem interface begins here */

/* handle unplugging of the device, release data structures
if nothing keeps us from doing it.  If something is still
keeping us busy, the release callback of v4l will take care
of releasing it. */
static void usb_amradio_disconnect(struct usb_interface *intf)
{
	struct amradio_device *radio = usb_get_intfdata(intf);

	mutex_lock(&radio->lock);
	radio->removed = 1;
	mutex_unlock(&radio->lock);

	usb_set_intfdata(intf, NULL);
	video_unregister_device(radio->videodev);
}

/* vidioc_querycap - query device capabilities */
static int vidioc_querycap(struct file *file, void *priv,
					struct v4l2_capability *v)
{
	strlcpy(v->driver, "radio-mr800", sizeof(v->driver));
	strlcpy(v->card, "AverMedia MR 800 USB FM Radio", sizeof(v->card));
	sprintf(v->bus_info, "USB");
	v->version = RADIO_VERSION;
	v->capabilities = V4L2_CAP_TUNER;
	return 0;
}

/* vidioc_g_tuner - get tuner attributes */
static int vidioc_g_tuner(struct file *file, void *priv,
				struct v4l2_tuner *v)
{
	struct amradio_device *radio = video_get_drvdata(video_devdata(file));

	/* safety check */
	if (radio->removed)
		return -EIO;

	if (v->index > 0)
		return -EINVAL;

/* TODO: Add function which look is signal stereo or not
 * 	amradio_getstat(radio);
 */
	radio->stereo = -1;
	strcpy(v->name, "FM");
	v->type = V4L2_TUNER_RADIO;
	v->rangelow = FREQ_MIN * FREQ_MUL;
	v->rangehigh = FREQ_MAX * FREQ_MUL;
	v->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
	v->capability = V4L2_TUNER_CAP_LOW;
	if (radio->stereo)
		v->audmode = V4L2_TUNER_MODE_STEREO;
	else
		v->audmode = V4L2_TUNER_MODE_MONO;
	v->signal = 0xffff;     /* Can't get the signal strength, sad.. */
	v->afc = 0; /* Don't know what is this */
	return 0;
}

/* vidioc_s_tuner - set tuner attributes */
static int vidioc_s_tuner(struct file *file, void *priv,
				struct v4l2_tuner *v)
{
	struct amradio_device *radio = video_get_drvdata(video_devdata(file));

	/* safety check */
	if (radio->removed)
		return -EIO;

	if (v->index > 0)
		return -EINVAL;
	return 0;
}

/* vidioc_s_frequency - set tuner radio frequency */
static int vidioc_s_frequency(struct file *file, void *priv,
				struct v4l2_frequency *f)
{
	struct amradio_device *radio = video_get_drvdata(video_devdata(file));

	/* safety check */
	if (radio->removed)
		return -EIO;

	radio->curfreq = f->frequency;
	if (amradio_setfreq(radio, radio->curfreq) < 0)
		amradio_dev_warn(&radio->videodev->dev,
			"set frequency failed\n");
	return 0;
}

/* vidioc_g_frequency - get tuner radio frequency */
static int vidioc_g_frequency(struct file *file, void *priv,
				struct v4l2_frequency *f)
{
	struct amradio_device *radio = video_get_drvdata(video_devdata(file));

	/* safety check */
	if (radio->removed)
		return -EIO;

	f->type = V4L2_TUNER_RADIO;
	f->frequency = radio->curfreq;
	return 0;
}

/* vidioc_queryctrl - enumerate control items */
static int vidioc_queryctrl(struct file *file, void *priv,
				struct v4l2_queryctrl *qc)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) {
		if (qc->id && qc->id == radio_qctrl[i].id) {
			memcpy(qc, &(radio_qctrl[i]), sizeof(*qc));
			return 0;
		}
	}
	return -EINVAL;
}

/* vidioc_g_ctrl - get the value of a control */
static int vidioc_g_ctrl(struct file *file, void *priv,
				struct v4l2_control *ctrl)
{
	struct amradio_device *radio = video_get_drvdata(video_devdata(file));

	/* safety check */
	if (radio->removed)
		return -EIO;

	switch (ctrl->id) {
	case V4L2_CID_AUDIO_MUTE:
		ctrl->value = radio->muted;
		return 0;
	}
	return -EINVAL;
}

/* vidioc_s_ctrl - set the value of a control */
static int vidioc_s_ctrl(struct file *file, void *priv,
				struct v4l2_control *ctrl)
{
	struct amradio_device *radio = video_get_drvdata(video_devdata(file));

	/* safety check */
	if (radio->removed)
		return -EIO;

	switch (ctrl->id) {
	case V4L2_CID_AUDIO_MUTE:
		if (ctrl->value) {
			if (amradio_stop(radio) < 0) {
				amradio_dev_warn(&radio->videodev->dev,
					"amradio_stop failed\n");
				return -1;
			}
		} else {
			if (amradio_start(radio) < 0) {
				amradio_dev_warn(&radio->videodev->dev,
					"amradio_start failed\n");
				return -1;
			}
		}
		return 0;
	}
	return -EINVAL;
}

/* vidioc_g_audio - get audio attributes */
static int vidioc_g_audio(struct file *file, void *priv,
				struct v4l2_audio *a)
{
	if (a->index > 1)
		return -EINVAL;

	strcpy(a->name, "Radio");
	a->capability = V4L2_AUDCAP_STEREO;
	return 0;
}

/* vidioc_s_audio - set audio attributes  */
static int vidioc_s_audio(struct file *file, void *priv,
					struct v4l2_audio *a)
{
	if (a->index != 0)
		return -EINVAL;
	return 0;
}

/* vidioc_g_input - get input */
static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i)
{
	*i = 0;
	return 0;
}

/* vidioc_s_input - set input */
static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
{
	if (i != 0)
		return -EINVAL;
	return 0;
}

/* open device - amradio_start() and amradio_setfreq() */
static int usb_amradio_open(struct file *file)
{
	struct amradio_device *radio = video_get_drvdata(video_devdata(file));

	lock_kernel();

	radio->users = 1;
	radio->muted = 1;

	if (amradio_start(radio) < 0) {
		amradio_dev_warn(&radio->videodev->dev,
			"radio did not start up properly\n");
		radio->users = 0;
		unlock_kernel();
		return -EIO;
	}
	if (amradio_setfreq(radio, radio->curfreq) < 0)
		amradio_dev_warn(&radio->videodev->dev,
			"set frequency failed\n");

	unlock_kernel();
	return 0;
}

/*close device */
static int usb_amradio_close(struct file *file)
{
	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
	int retval;

	if (!radio)
		return -ENODEV;

	radio->users = 0;

	if (!radio->removed) {
		retval = amradio_stop(radio);
		if (retval < 0)
			amradio_dev_warn(&radio->videodev->dev,
				"amradio_stop failed\n");
	}

	return 0;
}

/* Suspend device - stop device. Need to be checked and fixed */
static int usb_amradio_suspend(struct usb_interface *intf, pm_message_t message)
{
	struct amradio_device *radio = usb_get_intfdata(intf);

	if (amradio_stop(radio) < 0)
		dev_warn(&intf->dev, "amradio_stop failed\n");

	dev_info(&intf->dev, "going into suspend..\n");

	return 0;
}

/* Resume device - start device. Need to be checked and fixed */
static int usb_amradio_resume(struct usb_interface *intf)
{
	struct amradio_device *radio = usb_get_intfdata(intf);

	if (amradio_start(radio) < 0)
		dev_warn(&intf->dev, "amradio_start failed\n");

	dev_info(&intf->dev, "coming out of suspend..\n");

	return 0;
}

/* File system interface */
static const struct v4l2_file_operations usb_amradio_fops = {
	.owner		= THIS_MODULE,
	.open		= usb_amradio_open,
	.release	= usb_amradio_close,
	.ioctl		= video_ioctl2,
};

static const struct v4l2_ioctl_ops usb_amradio_ioctl_ops = {
	.vidioc_querycap    = vidioc_querycap,
	.vidioc_g_tuner     = vidioc_g_tuner,
	.vidioc_s_tuner     = vidioc_s_tuner,
	.vidioc_g_frequency = vidioc_g_frequency,
	.vidioc_s_frequency = vidioc_s_frequency,
	.vidioc_queryctrl   = vidioc_queryctrl,
	.vidioc_g_ctrl      = vidioc_g_ctrl,
	.vidioc_s_ctrl      = vidioc_s_ctrl,
	.vidioc_g_audio     = vidioc_g_audio,
	.vidioc_s_audio     = vidioc_s_audio,
	.vidioc_g_input     = vidioc_g_input,
	.vidioc_s_input     = vidioc_s_input,
};

static void usb_amradio_device_release(struct video_device *videodev)
{
	struct amradio_device *radio = video_get_drvdata(videodev);

	/* we call v4l to free radio->videodev */
	video_device_release(videodev);

	/* free rest memory */
	kfree(radio->buffer);
	kfree(radio);
}

/* V4L2 interface */
static struct video_device amradio_videodev_template = {
	.name		= "AverMedia MR 800 USB FM Radio",
	.fops		= &usb_amradio_fops,
	.ioctl_ops 	= &usb_amradio_ioctl_ops,
	.release	= usb_amradio_device_release,
};

/* check if the device is present and register with v4l and
usb if it is */
static int usb_amradio_probe(struct usb_interface *intf,
				const struct usb_device_id *id)
{
	struct amradio_device *radio;

	radio = kmalloc(sizeof(struct amradio_device), GFP_KERNEL);

	if (!(radio))
		return -ENOMEM;

	radio->buffer = kmalloc(BUFFER_LENGTH, GFP_KERNEL);

	if (!(radio->buffer)) {
		kfree(radio);
		return -ENOMEM;
	}

	radio->videodev = video_device_alloc();

	if (!(radio->videodev)) {
		kfree(radio->buffer);
		kfree(radio);
		return -ENOMEM;
	}

	memcpy(radio->videodev, &amradio_videodev_template,
		sizeof(amradio_videodev_template));

	radio->removed = 0;
	radio->users = 0;
	radio->usbdev = interface_to_usbdev(intf);
	radio->curfreq = 95.16 * FREQ_MUL;

	mutex_init(&radio->lock);

	video_set_drvdata(radio->videodev, radio);
	if (video_register_device(radio->videodev, VFL_TYPE_RADIO, radio_nr)) {
		dev_warn(&intf->dev, "could not register video device\n");
		video_device_release(radio->videodev);
		kfree(radio->buffer);
		kfree(radio);
		return -EIO;
	}

	usb_set_intfdata(intf, radio);
	return 0;
}

static int __init amradio_init(void)
{
	int retval = usb_register(&usb_amradio_driver);

	pr_info(KBUILD_MODNAME
		": version " DRIVER_VERSION " " DRIVER_DESC "\n");

	if (retval)
		pr_err(KBUILD_MODNAME
			": usb_register failed. Error number %d\n", retval);

	return retval;
}

static void __exit amradio_exit(void)
{
	usb_deregister(&usb_amradio_driver);
}

module_init(amradio_init);
module_exit(amradio_exit);
Commit	Line	Data
2aa72f3b AK	1	/*
	2	* A driver for the AverMedia MR 800 USB FM radio. This device plugs
	3	* into both the USB and an analog audio input, so this thing
	4	* only deals with initialization and frequency setting, the
	5	* audio data has to be handled by a sound driver.
	6	*
	7	* Copyright (c) 2008 Alexey Klimov <klimov.linux@gmail.com>
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License as published by
	11	* the Free Software Foundation; either version 2 of the License, or
	12	* (at your option) any later version.
	13	*
	14	* This program is distributed in the hope that it will be useful,
	15	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	17	* GNU General Public License for more details.
	18	*
	19	* You should have received a copy of the GNU General Public License
	20	* along with this program; if not, write to the Free Software
	21	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	22	*/
	23
	24	/*
	25	* Big thanks to authors of dsbr100.c and radio-si470x.c
	26	*
	27	* When work was looked pretty good, i discover this:
	28	* http://av-usbradio.sourceforge.net/index.php
	29	* http://sourceforge.net/projects/av-usbradio/
	30	* Latest release of theirs project was in 2005.
	31	* Probably, this driver could be improved trough using their
	32	* achievements (specifications given).
	33	* So, we have smth to begin with.
	34	*
	35	* History:
	36	* Version 0.01: First working version.
	37	* It's required to blacklist AverMedia USB Radio
	38	* in usbhid/hid-quirks.c
	39	*
	40	* Many things to do:
	41	* - Correct power managment of device (suspend & resume)
	42	* - Make x86 independance (little-endian and big-endian stuff)
	43	* - Add code for scanning and smooth tuning
	44	* - Checked and add stereo&mono stuff
	45	* - Add code for sensitivity value
	46	* - Correct mistakes
	47	* - In Japan another FREQ_MIN and FREQ_MAX
	48	*/
	49
	50	/* kernel includes */
	51	#include <linux/kernel.h>
	52	#include <linux/module.h>
	53	#include <linux/init.h>
	54	#include <linux/slab.h>
	55	#include <linux/input.h>
	56	#include <linux/videodev2.h>
	57	#include <media/v4l2-common.h>
	58	#include <media/v4l2-ioctl.h>
	59	#include <linux/usb.h>
	60	#include <linux/version.h> /* for KERNEL_VERSION MACRO */
	61
	62	/* driver and module definitions */
	63	#define DRIVER_AUTHOR "Alexey Klimov <klimov.linux@gmail.com>"
	64	#define DRIVER_DESC "AverMedia MR 800 USB FM radio driver"
65	#define DRIVER_VERSION "0.01"
66	#define RADIO_VERSION KERNEL_VERSION(0, 0, 1)
67
68	MODULE_AUTHOR(DRIVER_AUTHOR);
69	MODULE_DESCRIPTION(DRIVER_DESC);
70	MODULE_LICENSE("GPL");
71
72	#define USB_AMRADIO_VENDOR 0x07ca
73	#define USB_AMRADIO_PRODUCT 0xb800
74
e60b022e AK	75	/* dev_warn macro with driver name */
	76	#define MR800_DRIVER_NAME "radio-mr800"
	77	#define amradio_dev_warn(dev, fmt, arg...) \
	78	dev_warn(dev, MR800_DRIVER_NAME " - " fmt, ##arg)
	79
2aa72f3b AK	80	/* Probably USB_TIMEOUT should be modified in module parameter */
	81	#define BUFFER_LENGTH 8
	82	#define USB_TIMEOUT 500
	83
	84	/* Frequency limits in MHz -- these are European values. For Japanese
	85	devices, that would be 76 and 91. */
	86	#define FREQ_MIN 87.5
	87	#define FREQ_MAX 108.0
	88	#define FREQ_MUL 16000
	89
	90	/* module parameter */
	91	static int radio_nr = -1;
	92	module_param(radio_nr, int, 0);
	93	MODULE_PARM_DESC(radio_nr, "Radio Nr");
	94
	95	static struct v4l2_queryctrl radio_qctrl[] = {
	96	{
	97	.id = V4L2_CID_AUDIO_MUTE,
	98	.name = "Mute",
	99	.minimum = 0,
	100	.maximum = 1,
	101	.step = 1,
	102	.default_value = 1,
	103	.type = V4L2_CTRL_TYPE_BOOLEAN,
	104	},
	105	/* HINT: the disabled controls are only here to satify kradio and such apps */
	106	{ .id = V4L2_CID_AUDIO_VOLUME,
	107	.flags = V4L2_CTRL_FLAG_DISABLED,
	108	},
	109	{
	110	.id = V4L2_CID_AUDIO_BALANCE,
	111	.flags = V4L2_CTRL_FLAG_DISABLED,
	112	},
	113	{
	114	.id = V4L2_CID_AUDIO_BASS,
	115	.flags = V4L2_CTRL_FLAG_DISABLED,
	116	},
	117	{
	118	.id = V4L2_CID_AUDIO_TREBLE,
	119	.flags = V4L2_CTRL_FLAG_DISABLED,
	120	},
	121	{
	122	.id = V4L2_CID_AUDIO_LOUDNESS,
	123	.flags = V4L2_CTRL_FLAG_DISABLED,
	124	},
	125	};
	126
	127	static int usb_amradio_probe(struct usb_interface *intf,
	128	const struct usb_device_id *id);
	129	static void usb_amradio_disconnect(struct usb_interface *intf);
bec43661 HV	130	static int usb_amradio_open(struct file *file);
bec43661 HV	131	static int usb_amradio_close(struct file *file);
2aa72f3b AK	132	static int usb_amradio_suspend(struct usb_interface *intf,
	133	pm_message_t message);
	134	static int usb_amradio_resume(struct usb_interface *intf);
	135
	136	/* Data for one (physical) device */
	137	struct amradio_device {
	138	/* reference to USB and video device */
	139	struct usb_device *usbdev;
	140	struct video_device *videodev;
	141
	142	unsigned char *buffer;
	143	struct mutex lock; /* buffer locking */
	144	int curfreq;
	145	int stereo;
	146	int users;
	147	int removed;
	148	int muted;
	149	};
	150
	151	/* USB Device ID List */
	152	static struct usb_device_id usb_amradio_device_table[] = {
	153	{USB_DEVICE_AND_INTERFACE_INFO(USB_AMRADIO_VENDOR, USB_AMRADIO_PRODUCT,
	154	USB_CLASS_HID, 0, 0) },
	155	{ } /* Terminating entry */
	156	};
	157
	158	MODULE_DEVICE_TABLE(usb, usb_amradio_device_table);
	159
	160	/* USB subsystem interface */
	161	static struct usb_driver usb_amradio_driver = {
e60b022e	162	.name = MR800_DRIVER_NAME,
2aa72f3b AK	163	.probe = usb_amradio_probe,
	164	.disconnect = usb_amradio_disconnect,
	165	.suspend = usb_amradio_suspend,
	166	.resume = usb_amradio_resume,
	167	.reset_resume = usb_amradio_resume,
	168	.id_table = usb_amradio_device_table,
f2ce9179	169	.supports_autosuspend = 0,
2aa72f3b AK	170	};
	171
	172	/* switch on radio. Send 8 bytes to device. */
	173	static int amradio_start(struct amradio_device *radio)
	174	{
	175	int retval;
	176	int size;
	177
	178	mutex_lock(&radio->lock);
	179
	180	radio->buffer[0] = 0x00;
	181	radio->buffer[1] = 0x55;
	182	radio->buffer[2] = 0xaa;
	183	radio->buffer[3] = 0x00;
	184	radio->buffer[4] = 0xab;
	185	radio->buffer[5] = 0x00;
	186	radio->buffer[6] = 0x00;
	187	radio->buffer[7] = 0x00;
	188
	189	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
	190	(void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
	191
	192	if (retval) {
	193	mutex_unlock(&radio->lock);
	194	return retval;
	195	}
	196
	197	mutex_unlock(&radio->lock);
	198
	199	radio->muted = 0;
	200
	201	return retval;
	202	}
	203
	204	/* switch off radio */
	205	static int amradio_stop(struct amradio_device *radio)
	206	{
	207	int retval;
	208	int size;
	209
3480130a AK	210	/* safety check */
	211	if (radio->removed)
	212	return -EIO;
	213
2aa72f3b AK	214	mutex_lock(&radio->lock);
	215
	216	radio->buffer[0] = 0x00;
	217	radio->buffer[1] = 0x55;
	218	radio->buffer[2] = 0xaa;
	219	radio->buffer[3] = 0x00;
	220	radio->buffer[4] = 0xab;
	221	radio->buffer[5] = 0x01;
	222	radio->buffer[6] = 0x00;
	223	radio->buffer[7] = 0x00;
	224
	225	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
	226	(void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
	227
	228	if (retval) {
	229	mutex_unlock(&radio->lock);
	230	return retval;
	231	}
	232
	233	mutex_unlock(&radio->lock);
	234
	235	radio->muted = 1;
	236
	237	return retval;
	238	}
	239
	240	/* set a frequency, freq is defined by v4l's TUNER_LOW, i.e. 1/16th kHz */
	241	static int amradio_setfreq(struct amradio_device *radio, int freq)
	242	{
	243	int retval;
	244	int size;
	245	unsigned short freq_send = 0x13 + (freq >> 3) / 25;
	246
3480130a AK	247	/* safety check */
	248	if (radio->removed)
	249	return -EIO;
	250
2aa72f3b AK	251	mutex_lock(&radio->lock);
	252
	253	radio->buffer[0] = 0x00;
	254	radio->buffer[1] = 0x55;
	255	radio->buffer[2] = 0xaa;
	256	radio->buffer[3] = 0x03;
	257	radio->buffer[4] = 0xa4;
	258	radio->buffer[5] = 0x00;
	259	radio->buffer[6] = 0x00;
	260	radio->buffer[7] = 0x08;
	261
	262	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
	263	(void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
	264
	265	if (retval) {
	266	mutex_unlock(&radio->lock);
	267	return retval;
	268	}
	269
	270	/* frequency is calculated from freq_send and placed in first 2 bytes */
	271	radio->buffer[0] = (freq_send >> 8) & 0xff;
	272	radio->buffer[1] = freq_send & 0xff;
	273	radio->buffer[2] = 0x01;
	274	radio->buffer[3] = 0x00;
	275	radio->buffer[4] = 0x00;
	276	/* 5 and 6 bytes of buffer already = 0x00 */
	277	radio->buffer[7] = 0x00;
	278
	279	retval = usb_bulk_msg(radio->usbdev, usb_sndintpipe(radio->usbdev, 2),
	280	(void *) (radio->buffer), BUFFER_LENGTH, &size, USB_TIMEOUT);
	281
	282	if (retval) {
	283	mutex_unlock(&radio->lock);
	284	return retval;
	285	}
	286
	287	mutex_unlock(&radio->lock);
	288
	289	radio->stereo = 0;
	290
	291	return retval;
	292	}
	293
	294	/* USB subsystem interface begins here */
	295
	296	/* handle unplugging of the device, release data structures
	297	if nothing keeps us from doing it. If something is still
	298	keeping us busy, the release callback of v4l will take care
	299	of releasing it. */
	300	static void usb_amradio_disconnect(struct usb_interface *intf)
	301	{
	302	struct amradio_device *radio = usb_get_intfdata(intf);
	303
f4e9043e	304	mutex_lock(&radio->lock);
3480130a	305	radio->removed = 1;
f4e9043e	306	mutex_unlock(&radio->lock);
2aa72f3b	307
f4e9043e AK	308	usb_set_intfdata(intf, NULL);
f4e9043e AK	309	video_unregister_device(radio->videodev);
2aa72f3b AK	310	}
	311
	312	/* vidioc_querycap - query device capabilities */
	313	static int vidioc_querycap(struct file file, void priv,
	314	struct v4l2_capability *v)
	315	{
	316	strlcpy(v->driver, "radio-mr800", sizeof(v->driver));
	317	strlcpy(v->card, "AverMedia MR 800 USB FM Radio", sizeof(v->card));
	318	sprintf(v->bus_info, "USB");
	319	v->version = RADIO_VERSION;
	320	v->capabilities = V4L2_CAP_TUNER;
	321	return 0;
	322	}
	323
	324	/* vidioc_g_tuner - get tuner attributes */
	325	static int vidioc_g_tuner(struct file file, void priv,
	326	struct v4l2_tuner *v)
	327	{
	328	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
	329
3480130a AK	330	/* safety check */
	331	if (radio->removed)
	332	return -EIO;
	333
2aa72f3b AK	334	if (v->index > 0)
	335	return -EINVAL;
	336
	337	/* TODO: Add function which look is signal stereo or not
	338	* amradio_getstat(radio);
	339	*/
	340	radio->stereo = -1;
	341	strcpy(v->name, "FM");
	342	v->type = V4L2_TUNER_RADIO;
	343	v->rangelow = FREQ_MIN * FREQ_MUL;
	344	v->rangehigh = FREQ_MAX * FREQ_MUL;
	345	v->rxsubchans = V4L2_TUNER_SUB_MONO \| V4L2_TUNER_SUB_STEREO;
	346	v->capability = V4L2_TUNER_CAP_LOW;
	347	if (radio->stereo)
	348	v->audmode = V4L2_TUNER_MODE_STEREO;
	349	else
	350	v->audmode = V4L2_TUNER_MODE_MONO;
	351	v->signal = 0xffff; /* Can't get the signal strength, sad.. */
	352	v->afc = 0; /* Don't know what is this */
	353	return 0;
	354	}
	355
	356	/* vidioc_s_tuner - set tuner attributes */
	357	static int vidioc_s_tuner(struct file file, void priv,
	358	struct v4l2_tuner *v)
	359	{
3480130a AK	360	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
	361
	362	/* safety check */
	363	if (radio->removed)
	364	return -EIO;
	365
2aa72f3b AK	366	if (v->index > 0)
	367	return -EINVAL;
	368	return 0;
	369	}
	370
	371	/* vidioc_s_frequency - set tuner radio frequency */
	372	static int vidioc_s_frequency(struct file file, void priv,
	373	struct v4l2_frequency *f)
	374	{
	375	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
	376
3480130a AK	377	/* safety check */
	378	if (radio->removed)
	379	return -EIO;
	380
2aa72f3b AK	381	radio->curfreq = f->frequency;
2aa72f3b AK	382	if (amradio_setfreq(radio, radio->curfreq) < 0)
e60b022e AK	383	amradio_dev_warn(&radio->videodev->dev,
e60b022e AK	384	"set frequency failed\n");
2aa72f3b AK	385	return 0;
	386	}
	387
	388	/* vidioc_g_frequency - get tuner radio frequency */
	389	static int vidioc_g_frequency(struct file file, void priv,
	390	struct v4l2_frequency *f)
	391	{
	392	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
	393
3480130a AK	394	/* safety check */
	395	if (radio->removed)
	396	return -EIO;
	397
2aa72f3b AK	398	f->type = V4L2_TUNER_RADIO;
	399	f->frequency = radio->curfreq;
	400	return 0;
	401	}
	402
	403	/* vidioc_queryctrl - enumerate control items */
	404	static int vidioc_queryctrl(struct file file, void priv,
	405	struct v4l2_queryctrl *qc)
	406	{
	407	int i;
	408
	409	for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) {
	410	if (qc->id && qc->id == radio_qctrl[i].id) {
e60b022e	411	memcpy(qc, &(radio_qctrl[i]), sizeof(*qc));
2aa72f3b AK	412	return 0;
	413	}
	414	}
	415	return -EINVAL;
	416	}
	417
	418	/* vidioc_g_ctrl - get the value of a control */
	419	static int vidioc_g_ctrl(struct file file, void priv,
	420	struct v4l2_control *ctrl)
	421	{
	422	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
	423
3480130a AK	424	/* safety check */
	425	if (radio->removed)
	426	return -EIO;
	427
2aa72f3b AK	428	switch (ctrl->id) {
	429	case V4L2_CID_AUDIO_MUTE:
	430	ctrl->value = radio->muted;
	431	return 0;
	432	}
	433	return -EINVAL;
	434	}
	435
	436	/* vidioc_s_ctrl - set the value of a control */
	437	static int vidioc_s_ctrl(struct file file, void priv,
	438	struct v4l2_control *ctrl)
	439	{
	440	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
	441
3480130a AK	442	/* safety check */
	443	if (radio->removed)
	444	return -EIO;
	445
2aa72f3b AK	446	switch (ctrl->id) {
	447	case V4L2_CID_AUDIO_MUTE:
	448	if (ctrl->value) {
	449	if (amradio_stop(radio) < 0) {
e60b022e AK	450	amradio_dev_warn(&radio->videodev->dev,
e60b022e AK	451	"amradio_stop failed\n");
2aa72f3b AK	452	return -1;
	453	}
	454	} else {
	455	if (amradio_start(radio) < 0) {
e60b022e AK	456	amradio_dev_warn(&radio->videodev->dev,
e60b022e AK	457	"amradio_start failed\n");
2aa72f3b AK	458	return -1;
	459	}
	460	}
	461	return 0;
	462	}
	463	return -EINVAL;
	464	}
	465
	466	/* vidioc_g_audio - get audio attributes */
	467	static int vidioc_g_audio(struct file file, void priv,
	468	struct v4l2_audio *a)
	469	{
	470	if (a->index > 1)
	471	return -EINVAL;
	472
	473	strcpy(a->name, "Radio");
	474	a->capability = V4L2_AUDCAP_STEREO;
	475	return 0;
	476	}
	477
	478	/* vidioc_s_audio - set audio attributes */
	479	static int vidioc_s_audio(struct file file, void priv,
	480	struct v4l2_audio *a)
	481	{
	482	if (a->index != 0)
	483	return -EINVAL;
	484	return 0;
	485	}
	486
	487	/* vidioc_g_input - get input */
	488	static int vidioc_g_input(struct file filp, void priv, unsigned int *i)
	489	{
	490	*i = 0;
	491	return 0;
	492	}
	493
	494	/* vidioc_s_input - set input */
	495	static int vidioc_s_input(struct file filp, void priv, unsigned int i)
	496	{
	497	if (i != 0)
	498	return -EINVAL;
	499	return 0;
	500	}
	501
	502	/* open device - amradio_start() and amradio_setfreq() */
bec43661	503	static int usb_amradio_open(struct file *file)
2aa72f3b AK	504	{
	505	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
	506
0fabb783 AK	507	lock_kernel();
0fabb783 AK	508
2aa72f3b AK	509	radio->users = 1;
	510	radio->muted = 1;
	511
	512	if (amradio_start(radio) < 0) {
e60b022e AK	513	amradio_dev_warn(&radio->videodev->dev,
e60b022e AK	514	"radio did not start up properly\n");
2aa72f3b	515	radio->users = 0;
0fabb783	516	unlock_kernel();
2aa72f3b AK	517	return -EIO;
	518	}
	519	if (amradio_setfreq(radio, radio->curfreq) < 0)
e60b022e AK	520	amradio_dev_warn(&radio->videodev->dev,
e60b022e AK	521	"set frequency failed\n");
0fabb783 AK	522
0fabb783 AK	523	unlock_kernel();
2aa72f3b AK	524	return 0;
	525	}
	526
f4e9043e	527	/close device /
bec43661	528	static int usb_amradio_close(struct file *file)
2aa72f3b AK	529	{
2aa72f3b AK	530	struct amradio_device *radio = video_get_drvdata(video_devdata(file));
3480130a	531	int retval;
2aa72f3b AK	532
	533	if (!radio)
	534	return -ENODEV;
3480130a	535
2aa72f3b	536	radio->users = 0;
3480130a	537
f4e9043e	538	if (!radio->removed) {
3480130a AK	539	retval = amradio_stop(radio);
	540	if (retval < 0)
	541	amradio_dev_warn(&radio->videodev->dev,
	542	"amradio_stop failed\n");
2aa72f3b	543	}
3480130a	544
2aa72f3b AK	545	return 0;
	546	}
	547
	548	/* Suspend device - stop device. Need to be checked and fixed */
	549	static int usb_amradio_suspend(struct usb_interface *intf, pm_message_t message)
	550	{
	551	struct amradio_device *radio = usb_get_intfdata(intf);
	552
	553	if (amradio_stop(radio) < 0)
e60b022e	554	dev_warn(&intf->dev, "amradio_stop failed\n");
2aa72f3b	555
e60b022e	556	dev_info(&intf->dev, "going into suspend..\n");
2aa72f3b AK	557
	558	return 0;
	559	}
	560
	561	/* Resume device - start device. Need to be checked and fixed */
	562	static int usb_amradio_resume(struct usb_interface *intf)
	563	{
	564	struct amradio_device *radio = usb_get_intfdata(intf);
	565
	566	if (amradio_start(radio) < 0)
e60b022e	567	dev_warn(&intf->dev, "amradio_start failed\n");
2aa72f3b	568
e60b022e	569	dev_info(&intf->dev, "coming out of suspend..\n");
2aa72f3b AK	570
	571	return 0;
	572	}
	573
	574	/* File system interface */
bec43661	575	static const struct v4l2_file_operations usb_amradio_fops = {
2aa72f3b AK	576	.owner = THIS_MODULE,
	577	.open = usb_amradio_open,
	578	.release = usb_amradio_close,
	579	.ioctl = video_ioctl2,
2aa72f3b AK	580	};
	581
	582	static const struct v4l2_ioctl_ops usb_amradio_ioctl_ops = {
	583	.vidioc_querycap = vidioc_querycap,
	584	.vidioc_g_tuner = vidioc_g_tuner,
	585	.vidioc_s_tuner = vidioc_s_tuner,
	586	.vidioc_g_frequency = vidioc_g_frequency,
	587	.vidioc_s_frequency = vidioc_s_frequency,
	588	.vidioc_queryctrl = vidioc_queryctrl,
	589	.vidioc_g_ctrl = vidioc_g_ctrl,
	590	.vidioc_s_ctrl = vidioc_s_ctrl,
	591	.vidioc_g_audio = vidioc_g_audio,
	592	.vidioc_s_audio = vidioc_s_audio,
	593	.vidioc_g_input = vidioc_g_input,
	594	.vidioc_s_input = vidioc_s_input,
	595	};
	596
f4e9043e AK	597	static void usb_amradio_device_release(struct video_device *videodev)
	598	{
	599	struct amradio_device *radio = video_get_drvdata(videodev);
	600
	601	/* we call v4l to free radio->videodev */
	602	video_device_release(videodev);
	603
	604	/* free rest memory */
	605	kfree(radio->buffer);
	606	kfree(radio);
	607	}
	608
2aa72f3b AK	609	/* V4L2 interface */
	610	static struct video_device amradio_videodev_template = {
	611	.name = "AverMedia MR 800 USB FM Radio",
	612	.fops = &usb_amradio_fops,
	613	.ioctl_ops = &usb_amradio_ioctl_ops,
f4e9043e	614	.release = usb_amradio_device_release,
2aa72f3b AK	615	};
	616
	617	/* check if the device is present and register with v4l and
	618	usb if it is */
	619	static int usb_amradio_probe(struct usb_interface *intf,
	620	const struct usb_device_id *id)
	621	{
	622	struct amradio_device *radio;
	623
	624	radio = kmalloc(sizeof(struct amradio_device), GFP_KERNEL);
	625
	626	if (!(radio))
	627	return -ENOMEM;
	628
	629	radio->buffer = kmalloc(BUFFER_LENGTH, GFP_KERNEL);
	630
	631	if (!(radio->buffer)) {
	632	kfree(radio);
	633	return -ENOMEM;
	634	}
	635
	636	radio->videodev = video_device_alloc();
	637
	638	if (!(radio->videodev)) {
	639	kfree(radio->buffer);
	640	kfree(radio);
	641	return -ENOMEM;
	642	}
	643
	644	memcpy(radio->videodev, &amradio_videodev_template,
	645	sizeof(amradio_videodev_template));
	646
	647	radio->removed = 0;
	648	radio->users = 0;
	649	radio->usbdev = interface_to_usbdev(intf);
	650	radio->curfreq = 95.16 * FREQ_MUL;
	651
	652	mutex_init(&radio->lock);
	653
	654	video_set_drvdata(radio->videodev, radio);
	655	if (video_register_device(radio->videodev, VFL_TYPE_RADIO, radio_nr)) {
e60b022e	656	dev_warn(&intf->dev, "could not register video device\n");
2aa72f3b AK	657	video_device_release(radio->videodev);
	658	kfree(radio->buffer);
	659	kfree(radio);
	660	return -EIO;
	661	}
	662
	663	usb_set_intfdata(intf, radio);
	664	return 0;
	665	}
	666
	667	static int __init amradio_init(void)
	668	{
	669	int retval = usb_register(&usb_amradio_driver);
	670
e60b022e AK	671	pr_info(KBUILD_MODNAME
	672	": version " DRIVER_VERSION " " DRIVER_DESC "\n");
	673
2aa72f3b	674	if (retval)
e60b022e AK	675	pr_err(KBUILD_MODNAME
	676	": usb_register failed. Error number %d\n", retval);
	677
2aa72f3b AK	678	return retval;
	679	}
	680
	681	static void __exit amradio_exit(void)
	682	{
	683	usb_deregister(&usb_amradio_driver);
	684	}
	685
	686	module_init(amradio_init);
	687	module_exit(amradio_exit);
	688