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

/* radio-trust.c - Trust FM Radio card driver for Linux 2.2
 * by Eric Lammerts <eric@scintilla.utwente.nl>
 *
 * Based on radio-aztech.c. Original notes:
 *
 * Adapted to support the Video for Linux API by
 * Russell Kroll <rkroll@exploits.org>.  Based on original tuner code by:
 *
 * Quay Ly
 * Donald Song
 * Jason Lewis      (jlewis@twilight.vtc.vsc.edu)
 * Scott McGrath    (smcgrath@twilight.vtc.vsc.edu)
 * William McGrath  (wmcgrath@twilight.vtc.vsc.edu)
 *
 * Converted to V4L2 API by Mauro Carvalho Chehab <mchehab@infradead.org>
 */

#include <stdarg.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/ioport.h>
#include <linux/version.h>      /* for KERNEL_VERSION MACRO     */
#include <linux/videodev2.h>
#include <linux/io.h>
#include <media/v4l2-device.h>
#include <media/v4l2-ioctl.h>

MODULE_AUTHOR("Eric Lammerts, Russell Kroll, Quay Lu, Donald Song, Jason Lewis, Scott McGrath, William McGrath");
MODULE_DESCRIPTION("A driver for the Trust FM Radio card.");
MODULE_LICENSE("GPL");

/* acceptable ports: 0x350 (JP3 shorted), 0x358 (JP3 open) */

#ifndef CONFIG_RADIO_TRUST_PORT
#define CONFIG_RADIO_TRUST_PORT -1
#endif

static int io = CONFIG_RADIO_TRUST_PORT;
static int radio_nr = -1;

module_param(io, int, 0);
MODULE_PARM_DESC(io, "I/O address of the Trust FM Radio card (0x350 or 0x358)");
module_param(radio_nr, int, 0);

#define RADIO_VERSION KERNEL_VERSION(0, 0, 2)

struct trust {
	struct v4l2_device v4l2_dev;
	struct video_device vdev;
	int io;
	int ioval;
	__u16 curvol;
	__u16 curbass;
	__u16 curtreble;
	int muted;
	unsigned long curfreq;
	int curstereo;
	int curmute;
	struct mutex lock;
};

static struct trust trust_card;

/* i2c addresses */
#define TDA7318_ADDR 0x88
#define TSA6060T_ADDR 0xc4

#define TR_DELAY do { inb(tr->io); inb(tr->io); inb(tr->io); } while (0)
#define TR_SET_SCL outb(tr->ioval |= 2, tr->io)
#define TR_CLR_SCL outb(tr->ioval &= 0xfd, tr->io)
#define TR_SET_SDA outb(tr->ioval |= 1, tr->io)
#define TR_CLR_SDA outb(tr->ioval &= 0xfe, tr->io)

static void write_i2c(struct trust *tr, int n, ...)
{
	unsigned char val, mask;
	va_list args;

	va_start(args, n);

	/* start condition */
	TR_SET_SDA;
	TR_SET_SCL;
	TR_DELAY;
	TR_CLR_SDA;
	TR_CLR_SCL;
	TR_DELAY;

	for(; n; n--) {
		val = va_arg(args, unsigned);
		for(mask = 0x80; mask; mask >>= 1) {
			if(val & mask)
				TR_SET_SDA;
			else
				TR_CLR_SDA;
			TR_SET_SCL;
			TR_DELAY;
			TR_CLR_SCL;
			TR_DELAY;
		}
		/* acknowledge bit */
		TR_SET_SDA;
		TR_SET_SCL;
		TR_DELAY;
		TR_CLR_SCL;
		TR_DELAY;
	}

	/* stop condition */
	TR_CLR_SDA;
	TR_DELAY;
	TR_SET_SCL;
	TR_DELAY;
	TR_SET_SDA;
	TR_DELAY;

	va_end(args);
}

static void tr_setvol(struct trust *tr, __u16 vol)
{
	mutex_lock(&tr->lock);
	tr->curvol = vol / 2048;
	write_i2c(tr, 2, TDA7318_ADDR, tr->curvol ^ 0x1f);
	mutex_unlock(&tr->lock);
}

static int basstreble2chip[15] = {
	0, 1, 2, 3, 4, 5, 6, 7, 14, 13, 12, 11, 10, 9, 8
};

static void tr_setbass(struct trust *tr, __u16 bass)
{
	mutex_lock(&tr->lock);
	tr->curbass = bass / 4370;
	write_i2c(tr, 2, TDA7318_ADDR, 0x60 | basstreble2chip[tr->curbass]);
	mutex_unlock(&tr->lock);
}

static void tr_settreble(struct trust *tr, __u16 treble)
{
	mutex_lock(&tr->lock);
	tr->curtreble = treble / 4370;
	write_i2c(tr, 2, TDA7318_ADDR, 0x70 | basstreble2chip[tr->curtreble]);
	mutex_unlock(&tr->lock);
}

static void tr_setstereo(struct trust *tr, int stereo)
{
	mutex_lock(&tr->lock);
	tr->curstereo = !!stereo;
	tr->ioval = (tr->ioval & 0xfb) | (!tr->curstereo << 2);
	outb(tr->ioval, tr->io);
	mutex_unlock(&tr->lock);
}

static void tr_setmute(struct trust *tr, int mute)
{
	mutex_lock(&tr->lock);
	tr->curmute = !!mute;
	tr->ioval = (tr->ioval & 0xf7) | (tr->curmute << 3);
	outb(tr->ioval, tr->io);
	mutex_unlock(&tr->lock);
}

static int tr_getsigstr(struct trust *tr)
{
	int i, v;

	mutex_lock(&tr->lock);
	for (i = 0, v = 0; i < 100; i++)
		v |= inb(tr->io);
	mutex_unlock(&tr->lock);
	return (v & 1) ? 0 : 0xffff;
}

static int tr_getstereo(struct trust *tr)
{
	/* don't know how to determine it, just return the setting */
	return tr->curstereo;
}

static void tr_setfreq(struct trust *tr, unsigned long f)
{
	mutex_lock(&tr->lock);
	tr->curfreq = f;
	f /= 160;	/* Convert to 10 kHz units	*/
	f += 1070;	/* Add 10.7 MHz IF		*/
	write_i2c(tr, 5, TSA6060T_ADDR, (f << 1) | 1, f >> 7, 0x60 | ((f >> 15) & 1), 0);
	mutex_unlock(&tr->lock);
}

static int vidioc_querycap(struct file *file, void *priv,
				struct v4l2_capability *v)
{
	strlcpy(v->driver, "radio-trust", sizeof(v->driver));
	strlcpy(v->card, "Trust FM Radio", sizeof(v->card));
	strlcpy(v->bus_info, "ISA", sizeof(v->bus_info));
	v->version = RADIO_VERSION;
	v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
	return 0;
}

static int vidioc_g_tuner(struct file *file, void *priv,
				struct v4l2_tuner *v)
{
	struct trust *tr = video_drvdata(file);

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

	strlcpy(v->name, "FM", sizeof(v->name));
	v->type = V4L2_TUNER_RADIO;
	v->rangelow = 87.5 * 16000;
	v->rangehigh = 108 * 16000;
	v->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
	v->capability = V4L2_TUNER_CAP_LOW;
	if (tr_getstereo(tr))
		v->audmode = V4L2_TUNER_MODE_STEREO;
	else
		v->audmode = V4L2_TUNER_MODE_MONO;
	v->signal = tr_getsigstr(tr);
	return 0;
}

static int vidioc_s_tuner(struct file *file, void *priv,
				struct v4l2_tuner *v)
{
	struct trust *tr = video_drvdata(file);

	if (v->index)
		return -EINVAL;
	tr_setstereo(tr, v->audmode == V4L2_TUNER_MODE_STEREO);
	return 0;
}

static int vidioc_s_frequency(struct file *file, void *priv,
				struct v4l2_frequency *f)
{
	struct trust *tr = video_drvdata(file);

	tr_setfreq(tr, f->frequency);
	return 0;
}

static int vidioc_g_frequency(struct file *file, void *priv,
				struct v4l2_frequency *f)
{
	struct trust *tr = video_drvdata(file);

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

static int vidioc_queryctrl(struct file *file, void *priv,
				struct v4l2_queryctrl *qc)
{
	switch (qc->id) {
	case V4L2_CID_AUDIO_MUTE:
		return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
	case V4L2_CID_AUDIO_VOLUME:
		return v4l2_ctrl_query_fill(qc, 0, 65535, 2048, 65535);
	case V4L2_CID_AUDIO_BASS:
	case V4L2_CID_AUDIO_TREBLE:
		return v4l2_ctrl_query_fill(qc, 0, 65535, 4370, 32768);
	}
	return -EINVAL;
}

static int vidioc_g_ctrl(struct file *file, void *priv,
				struct v4l2_control *ctrl)
{
	struct trust *tr = video_drvdata(file);

	switch (ctrl->id) {
	case V4L2_CID_AUDIO_MUTE:
		ctrl->value = tr->curmute;
		return 0;
	case V4L2_CID_AUDIO_VOLUME:
		ctrl->value = tr->curvol * 2048;
		return 0;
	case V4L2_CID_AUDIO_BASS:
		ctrl->value = tr->curbass * 4370;
		return 0;
	case V4L2_CID_AUDIO_TREBLE:
		ctrl->value = tr->curtreble * 4370;
		return 0;
	}
	return -EINVAL;
}

static int vidioc_s_ctrl(struct file *file, void *priv,
				struct v4l2_control *ctrl)
{
	struct trust *tr = video_drvdata(file);

	switch (ctrl->id) {
	case V4L2_CID_AUDIO_MUTE:
		tr_setmute(tr, ctrl->value);
		return 0;
	case V4L2_CID_AUDIO_VOLUME:
		tr_setvol(tr, ctrl->value);
		return 0;
	case V4L2_CID_AUDIO_BASS:
		tr_setbass(tr, ctrl->value);
		return 0;
	case V4L2_CID_AUDIO_TREBLE:
		tr_settreble(tr, ctrl->value);
		return 0;
	}
	return -EINVAL;
}

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

static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
{
	return i ? -EINVAL : 0;
}

static int vidioc_g_audio(struct file *file, void *priv,
				struct v4l2_audio *a)
{
	a->index = 0;
	strlcpy(a->name, "Radio", sizeof(a->name));
	a->capability = V4L2_AUDCAP_STEREO;
	return 0;
}

static int vidioc_s_audio(struct file *file, void *priv,
				struct v4l2_audio *a)
{
	return a->index ? -EINVAL : 0;
}

static const struct v4l2_file_operations trust_fops = {
	.owner		= THIS_MODULE,
	.ioctl		= video_ioctl2,
};

static const struct v4l2_ioctl_ops trust_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 int __init trust_init(void)
{
	struct trust *tr = &trust_card;
	struct v4l2_device *v4l2_dev = &tr->v4l2_dev;
	int res;

	strlcpy(v4l2_dev->name, "trust", sizeof(v4l2_dev->name));
	tr->io = io;
	tr->ioval = 0xf;
	mutex_init(&tr->lock);

	if (tr->io == -1) {
		v4l2_err(v4l2_dev, "You must set an I/O address with io=0x0x350 or 0x358\n");
		return -EINVAL;
	}
	if (!request_region(tr->io, 2, "Trust FM Radio")) {
		v4l2_err(v4l2_dev, "port 0x%x already in use\n", tr->io);
		return -EBUSY;
	}

	res = v4l2_device_register(NULL, v4l2_dev);
	if (res < 0) {
		release_region(tr->io, 2);
		v4l2_err(v4l2_dev, "Could not register v4l2_device\n");
		return res;
	}

	strlcpy(tr->vdev.name, v4l2_dev->name, sizeof(tr->vdev.name));
	tr->vdev.v4l2_dev = v4l2_dev;
	tr->vdev.fops = &trust_fops;
	tr->vdev.ioctl_ops = &trust_ioctl_ops;
	tr->vdev.release = video_device_release_empty;
	video_set_drvdata(&tr->vdev, tr);

	if (video_register_device(&tr->vdev, VFL_TYPE_RADIO, radio_nr) < 0) {
		v4l2_device_unregister(v4l2_dev);
		release_region(tr->io, 2);
		return -EINVAL;
	}

	v4l2_info(v4l2_dev, "Trust FM Radio card driver v1.0.\n");

	write_i2c(tr, 2, TDA7318_ADDR, 0x80);	/* speaker att. LF = 0 dB */
	write_i2c(tr, 2, TDA7318_ADDR, 0xa0);	/* speaker att. RF = 0 dB */
	write_i2c(tr, 2, TDA7318_ADDR, 0xc0);	/* speaker att. LR = 0 dB */
	write_i2c(tr, 2, TDA7318_ADDR, 0xe0);	/* speaker att. RR = 0 dB */
	write_i2c(tr, 2, TDA7318_ADDR, 0x40);	/* stereo 1 input, gain = 18.75 dB */

	tr_setvol(tr, 0xffff);
	tr_setbass(tr, 0x8000);
	tr_settreble(tr, 0x8000);
	tr_setstereo(tr, 1);

	/* mute card - prevents noisy bootups */
	tr_setmute(tr, 1);

	return 0;
}

static void __exit cleanup_trust_module(void)
{
	struct trust *tr = &trust_card;

	video_unregister_device(&tr->vdev);
	v4l2_device_unregister(&tr->v4l2_dev);
	release_region(tr->io, 2);
}

module_init(trust_init);
module_exit(cleanup_trust_module);
Commit	Line	Data
4286c6f6	1	/* radio-trust.c - Trust FM Radio card driver for Linux 2.2
1da177e4 LT	2	* by Eric Lammerts <eric@scintilla.utwente.nl>
	3	*
	4	* Based on radio-aztech.c. Original notes:
	5	*
4286c6f6	6	* Adapted to support the Video for Linux API by
1da177e4 LT	7	* Russell Kroll <rkroll@exploits.org>. Based on original tuner code by:
	8	*
	9	* Quay Ly
	10	* Donald Song
4286c6f6	11	* Jason Lewis (jlewis@twilight.vtc.vsc.edu)
1da177e4 LT	12	* Scott McGrath (smcgrath@twilight.vtc.vsc.edu)
	13	* William McGrath (wmcgrath@twilight.vtc.vsc.edu)
	14	*
982eddb9	15	* Converted to V4L2 API by Mauro Carvalho Chehab <mchehab@infradead.org>
1da177e4 LT	16	*/
	17
	18	#include <stdarg.h>
	19	#include <linux/module.h>
	20	#include <linux/init.h>
	21	#include <linux/ioport.h>
1dc8aafc	22	#include <linux/version.h> /* for KERNEL_VERSION MACRO */
982eddb9	23	#include <linux/videodev2.h>
1dc8aafc	24	#include <linux/io.h>
1dc8aafc	25	#include <media/v4l2-device.h>
35ea11ff	26	#include <media/v4l2-ioctl.h>
1da177e4	27
1dc8aafc HV	28	MODULE_AUTHOR("Eric Lammerts, Russell Kroll, Quay Lu, Donald Song, Jason Lewis, Scott McGrath, William McGrath");
	29	MODULE_DESCRIPTION("A driver for the Trust FM Radio card.");
	30	MODULE_LICENSE("GPL");
982eddb9	31
1da177e4 LT	32	/* acceptable ports: 0x350 (JP3 shorted), 0x358 (JP3 open) */
	33
	34	#ifndef CONFIG_RADIO_TRUST_PORT
	35	#define CONFIG_RADIO_TRUST_PORT -1
	36	#endif
	37
4286c6f6	38	static int io = CONFIG_RADIO_TRUST_PORT;
1da177e4	39	static int radio_nr = -1;
1dc8aafc HV	40
	41	module_param(io, int, 0);
	42	MODULE_PARM_DESC(io, "I/O address of the Trust FM Radio card (0x350 or 0x358)");
	43	module_param(radio_nr, int, 0);
	44
	45	#define RADIO_VERSION KERNEL_VERSION(0, 0, 2)
	46
	47	struct trust {
	48	struct v4l2_device v4l2_dev;
	49	struct video_device vdev;
	50	int io;
	51	int ioval;
	52	__u16 curvol;
	53	__u16 curbass;
	54	__u16 curtreble;
	55	int muted;
	56	unsigned long curfreq;
	57	int curstereo;
	58	int curmute;
	59	struct mutex lock;
	60	};
	61
	62	static struct trust trust_card;
1da177e4 LT	63
	64	/* i2c addresses */
	65	#define TDA7318_ADDR 0x88
	66	#define TSA6060T_ADDR 0xc4
	67
1dc8aafc HV	68	#define TR_DELAY do { inb(tr->io); inb(tr->io); inb(tr->io); } while (0)
	69	#define TR_SET_SCL outb(tr->ioval \|= 2, tr->io)
	70	#define TR_CLR_SCL outb(tr->ioval &= 0xfd, tr->io)
	71	#define TR_SET_SDA outb(tr->ioval \|= 1, tr->io)
	72	#define TR_CLR_SDA outb(tr->ioval &= 0xfe, tr->io)
1da177e4	73
1dc8aafc	74	static void write_i2c(struct trust *tr, int n, ...)
1da177e4 LT	75	{
	76	unsigned char val, mask;
	77	va_list args;
	78
	79	va_start(args, n);
	80
	81	/* start condition */
	82	TR_SET_SDA;
	83	TR_SET_SCL;
	84	TR_DELAY;
	85	TR_CLR_SDA;
	86	TR_CLR_SCL;
	87	TR_DELAY;
	88
	89	for(; n; n--) {
	90	val = va_arg(args, unsigned);
	91	for(mask = 0x80; mask; mask >>= 1) {
	92	if(val & mask)
	93	TR_SET_SDA;
	94	else
	95	TR_CLR_SDA;
	96	TR_SET_SCL;
	97	TR_DELAY;
	98	TR_CLR_SCL;
	99	TR_DELAY;
	100	}
	101	/* acknowledge bit */
	102	TR_SET_SDA;
	103	TR_SET_SCL;
	104	TR_DELAY;
	105	TR_CLR_SCL;
	106	TR_DELAY;
	107	}
	108
	109	/* stop condition */
	110	TR_CLR_SDA;
	111	TR_DELAY;
	112	TR_SET_SCL;
	113	TR_DELAY;
	114	TR_SET_SDA;
	115	TR_DELAY;
	116
	117	va_end(args);
	118	}
	119
1dc8aafc	120	static void tr_setvol(struct trust *tr, __u16 vol)
1da177e4	121	{
1dc8aafc HV	122	mutex_lock(&tr->lock);
	123	tr->curvol = vol / 2048;
	124	write_i2c(tr, 2, TDA7318_ADDR, tr->curvol ^ 0x1f);
	125	mutex_unlock(&tr->lock);
1da177e4 LT	126	}
	127
	128	static int basstreble2chip[15] = {
	129	0, 1, 2, 3, 4, 5, 6, 7, 14, 13, 12, 11, 10, 9, 8
	130	};
	131
1dc8aafc	132	static void tr_setbass(struct trust *tr, __u16 bass)
1da177e4	133	{
1dc8aafc HV	134	mutex_lock(&tr->lock);
	135	tr->curbass = bass / 4370;
	136	write_i2c(tr, 2, TDA7318_ADDR, 0x60 \| basstreble2chip[tr->curbass]);
	137	mutex_unlock(&tr->lock);
1da177e4 LT	138	}
1da177e4 LT	139
1dc8aafc	140	static void tr_settreble(struct trust *tr, __u16 treble)
1da177e4	141	{
1dc8aafc HV	142	mutex_lock(&tr->lock);
	143	tr->curtreble = treble / 4370;
	144	write_i2c(tr, 2, TDA7318_ADDR, 0x70 \| basstreble2chip[tr->curtreble]);
	145	mutex_unlock(&tr->lock);
1da177e4 LT	146	}
1da177e4 LT	147
1dc8aafc	148	static void tr_setstereo(struct trust *tr, int stereo)
1da177e4	149	{
1dc8aafc HV	150	mutex_lock(&tr->lock);
	151	tr->curstereo = !!stereo;
	152	tr->ioval = (tr->ioval & 0xfb) \| (!tr->curstereo << 2);
	153	outb(tr->ioval, tr->io);
	154	mutex_unlock(&tr->lock);
1da177e4 LT	155	}
1da177e4 LT	156
1dc8aafc	157	static void tr_setmute(struct trust *tr, int mute)
1da177e4	158	{
1dc8aafc HV	159	mutex_lock(&tr->lock);
	160	tr->curmute = !!mute;
	161	tr->ioval = (tr->ioval & 0xf7) \| (tr->curmute << 3);
	162	outb(tr->ioval, tr->io);
	163	mutex_unlock(&tr->lock);
1da177e4 LT	164	}
1da177e4 LT	165
1dc8aafc	166	static int tr_getsigstr(struct trust *tr)
1da177e4 LT	167	{
1da177e4 LT	168	int i, v;
4286c6f6	169
1dc8aafc HV	170	mutex_lock(&tr->lock);
	171	for (i = 0, v = 0; i < 100; i++)
	172	v \|= inb(tr->io);
	173	mutex_unlock(&tr->lock);
	174	return (v & 1) ? 0 : 0xffff;
1da177e4 LT	175	}
1da177e4 LT	176
1dc8aafc	177	static int tr_getstereo(struct trust *tr)
1da177e4 LT	178	{
1da177e4 LT	179	/* don't know how to determine it, just return the setting */
1dc8aafc	180	return tr->curstereo;
1da177e4 LT	181	}
1da177e4 LT	182
1dc8aafc	183	static void tr_setfreq(struct trust *tr, unsigned long f)
1da177e4	184	{
1dc8aafc HV	185	mutex_lock(&tr->lock);
1dc8aafc HV	186	tr->curfreq = f;
1da177e4	187	f /= 160; /* Convert to 10 kHz units */
1dc8aafc HV	188	f += 1070; /* Add 10.7 MHz IF */
	189	write_i2c(tr, 5, TSA6060T_ADDR, (f << 1) \| 1, f >> 7, 0x60 \| ((f >> 15) & 1), 0);
	190	mutex_unlock(&tr->lock);
1da177e4 LT	191	}
1da177e4 LT	192
c5f822bf DL	193	static int vidioc_querycap(struct file file, void priv,
c5f822bf DL	194	struct v4l2_capability *v)
1da177e4	195	{
c5f822bf DL	196	strlcpy(v->driver, "radio-trust", sizeof(v->driver));
c5f822bf DL	197	strlcpy(v->card, "Trust FM Radio", sizeof(v->card));
1dc8aafc	198	strlcpy(v->bus_info, "ISA", sizeof(v->bus_info));
c5f822bf	199	v->version = RADIO_VERSION;
1dc8aafc	200	v->capabilities = V4L2_CAP_TUNER \| V4L2_CAP_RADIO;
c5f822bf DL	201	return 0;
c5f822bf DL	202	}
1da177e4	203
c5f822bf DL	204	static int vidioc_g_tuner(struct file file, void priv,
	205	struct v4l2_tuner *v)
	206	{
1dc8aafc HV	207	struct trust *tr = video_drvdata(file);
1dc8aafc HV	208
c5f822bf DL	209	if (v->index > 0)
c5f822bf DL	210	return -EINVAL;
1da177e4	211
1dc8aafc	212	strlcpy(v->name, "FM", sizeof(v->name));
c5f822bf	213	v->type = V4L2_TUNER_RADIO;
1dc8aafc HV	214	v->rangelow = 87.5 * 16000;
	215	v->rangehigh = 108 * 16000;
	216	v->rxsubchans = V4L2_TUNER_SUB_MONO \| V4L2_TUNER_SUB_STEREO;
c5f822bf	217	v->capability = V4L2_TUNER_CAP_LOW;
1dc8aafc	218	if (tr_getstereo(tr))
c5f822bf DL	219	v->audmode = V4L2_TUNER_MODE_STEREO;
	220	else
	221	v->audmode = V4L2_TUNER_MODE_MONO;
1dc8aafc	222	v->signal = tr_getsigstr(tr);
c5f822bf DL	223	return 0;
c5f822bf DL	224	}
982eddb9	225
c5f822bf DL	226	static int vidioc_s_tuner(struct file file, void priv,
	227	struct v4l2_tuner *v)
	228	{
1dc8aafc	229	struct trust *tr = video_drvdata(file);
982eddb9	230
1dc8aafc HV	231	if (v->index)
	232	return -EINVAL;
	233	tr_setstereo(tr, v->audmode == V4L2_TUNER_MODE_STEREO);
c5f822bf DL	234	return 0;
c5f822bf DL	235	}
982eddb9	236
c5f822bf DL	237	static int vidioc_s_frequency(struct file file, void priv,
	238	struct v4l2_frequency *f)
	239	{
1dc8aafc HV	240	struct trust *tr = video_drvdata(file);
	241
	242	tr_setfreq(tr, f->frequency);
c5f822bf DL	243	return 0;
c5f822bf DL	244	}
982eddb9	245
c5f822bf DL	246	static int vidioc_g_frequency(struct file file, void priv,
	247	struct v4l2_frequency *f)
	248	{
1dc8aafc HV	249	struct trust *tr = video_drvdata(file);
1dc8aafc HV	250
c5f822bf	251	f->type = V4L2_TUNER_RADIO;
1dc8aafc	252	f->frequency = tr->curfreq;
c5f822bf DL	253	return 0;
	254	}
	255
	256	static int vidioc_queryctrl(struct file file, void priv,
	257	struct v4l2_queryctrl *qc)
	258	{
1dc8aafc HV	259	switch (qc->id) {
	260	case V4L2_CID_AUDIO_MUTE:
	261	return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
	262	case V4L2_CID_AUDIO_VOLUME:
	263	return v4l2_ctrl_query_fill(qc, 0, 65535, 2048, 65535);
	264	case V4L2_CID_AUDIO_BASS:
	265	case V4L2_CID_AUDIO_TREBLE:
	266	return v4l2_ctrl_query_fill(qc, 0, 65535, 4370, 32768);
c5f822bf DL	267	}
	268	return -EINVAL;
	269	}
	270
	271	static int vidioc_g_ctrl(struct file file, void priv,
	272	struct v4l2_control *ctrl)
	273	{
1dc8aafc HV	274	struct trust *tr = video_drvdata(file);
1dc8aafc HV	275
c5f822bf DL	276	switch (ctrl->id) {
c5f822bf DL	277	case V4L2_CID_AUDIO_MUTE:
1dc8aafc	278	ctrl->value = tr->curmute;
c5f822bf DL	279	return 0;
c5f822bf DL	280	case V4L2_CID_AUDIO_VOLUME:
1dc8aafc	281	ctrl->value = tr->curvol * 2048;
c5f822bf DL	282	return 0;
c5f822bf DL	283	case V4L2_CID_AUDIO_BASS:
1dc8aafc	284	ctrl->value = tr->curbass * 4370;
c5f822bf DL	285	return 0;
c5f822bf DL	286	case V4L2_CID_AUDIO_TREBLE:
1dc8aafc	287	ctrl->value = tr->curtreble * 4370;
c5f822bf DL	288	return 0;
	289	}
	290	return -EINVAL;
	291	}
982eddb9	292
c5f822bf DL	293	static int vidioc_s_ctrl(struct file file, void priv,
	294	struct v4l2_control *ctrl)
	295	{
1dc8aafc HV	296	struct trust *tr = video_drvdata(file);
1dc8aafc HV	297
c5f822bf DL	298	switch (ctrl->id) {
c5f822bf DL	299	case V4L2_CID_AUDIO_MUTE:
1dc8aafc	300	tr_setmute(tr, ctrl->value);
c5f822bf DL	301	return 0;
c5f822bf DL	302	case V4L2_CID_AUDIO_VOLUME:
1dc8aafc	303	tr_setvol(tr, ctrl->value);
c5f822bf DL	304	return 0;
c5f822bf DL	305	case V4L2_CID_AUDIO_BASS:
1dc8aafc	306	tr_setbass(tr, ctrl->value);
c5f822bf DL	307	return 0;
c5f822bf DL	308	case V4L2_CID_AUDIO_TREBLE:
1dc8aafc	309	tr_settreble(tr, ctrl->value);
c5f822bf	310	return 0;
1da177e4	311	}
c5f822bf	312	return -EINVAL;
1da177e4 LT	313	}
1da177e4 LT	314
c5f822bf DL	315	static int vidioc_g_input(struct file filp, void priv, unsigned int *i)
	316	{
	317	*i = 0;
	318	return 0;
	319	}
	320
	321	static int vidioc_s_input(struct file filp, void priv, unsigned int i)
	322	{
1dc8aafc HV	323	return i ? -EINVAL : 0;
	324	}
	325
	326	static int vidioc_g_audio(struct file file, void priv,
	327	struct v4l2_audio *a)
	328	{
	329	a->index = 0;
	330	strlcpy(a->name, "Radio", sizeof(a->name));
	331	a->capability = V4L2_AUDCAP_STEREO;
c5f822bf DL	332	return 0;
	333	}
	334
	335	static int vidioc_s_audio(struct file file, void priv,
	336	struct v4l2_audio *a)
	337	{
1dc8aafc	338	return a->index ? -EINVAL : 0;
1da177e4 LT	339	}
1da177e4 LT	340
bec43661	341	static const struct v4l2_file_operations trust_fops = {
1da177e4	342	.owner = THIS_MODULE,
c5f822bf	343	.ioctl = video_ioctl2,
1da177e4 LT	344	};
1da177e4 LT	345
a399810c	346	static const struct v4l2_ioctl_ops trust_ioctl_ops = {
c5f822bf DL	347	.vidioc_querycap = vidioc_querycap,
	348	.vidioc_g_tuner = vidioc_g_tuner,
	349	.vidioc_s_tuner = vidioc_s_tuner,
	350	.vidioc_g_frequency = vidioc_g_frequency,
	351	.vidioc_s_frequency = vidioc_s_frequency,
	352	.vidioc_queryctrl = vidioc_queryctrl,
	353	.vidioc_g_ctrl = vidioc_g_ctrl,
	354	.vidioc_s_ctrl = vidioc_s_ctrl,
	355	.vidioc_g_audio = vidioc_g_audio,
	356	.vidioc_s_audio = vidioc_s_audio,
	357	.vidioc_g_input = vidioc_g_input,
	358	.vidioc_s_input = vidioc_s_input,
1da177e4 LT	359	};
	360
	361	static int __init trust_init(void)
	362	{
1dc8aafc HV	363	struct trust *tr = &trust_card;
	364	struct v4l2_device *v4l2_dev = &tr->v4l2_dev;
	365	int res;
	366
	367	strlcpy(v4l2_dev->name, "trust", sizeof(v4l2_dev->name));
	368	tr->io = io;
	369	tr->ioval = 0xf;
	370	mutex_init(&tr->lock);
	371
	372	if (tr->io == -1) {
b24c20cc	373	v4l2_err(v4l2_dev, "You must set an I/O address with io=0x0x350 or 0x358\n");
1da177e4 LT	374	return -EINVAL;
1da177e4 LT	375	}
1dc8aafc HV	376	if (!request_region(tr->io, 2, "Trust FM Radio")) {
1dc8aafc HV	377	v4l2_err(v4l2_dev, "port 0x%x already in use\n", tr->io);
1da177e4 LT	378	return -EBUSY;
1da177e4 LT	379	}
1dc8aafc HV	380
	381	res = v4l2_device_register(NULL, v4l2_dev);
	382	if (res < 0) {
	383	release_region(tr->io, 2);
	384	v4l2_err(v4l2_dev, "Could not register v4l2_device\n");
	385	return res;
	386	}
	387
	388	strlcpy(tr->vdev.name, v4l2_dev->name, sizeof(tr->vdev.name));
	389	tr->vdev.v4l2_dev = v4l2_dev;
	390	tr->vdev.fops = &trust_fops;
	391	tr->vdev.ioctl_ops = &trust_ioctl_ops;
	392	tr->vdev.release = video_device_release_empty;
	393	video_set_drvdata(&tr->vdev, tr);
	394
	395	if (video_register_device(&tr->vdev, VFL_TYPE_RADIO, radio_nr) < 0) {
	396	v4l2_device_unregister(v4l2_dev);
	397	release_region(tr->io, 2);
1da177e4 LT	398	return -EINVAL;
	399	}
	400
1dc8aafc	401	v4l2_info(v4l2_dev, "Trust FM Radio card driver v1.0.\n");
1da177e4	402
1dc8aafc HV	403	write_i2c(tr, 2, TDA7318_ADDR, 0x80); /* speaker att. LF = 0 dB */
	404	write_i2c(tr, 2, TDA7318_ADDR, 0xa0); /* speaker att. RF = 0 dB */
	405	write_i2c(tr, 2, TDA7318_ADDR, 0xc0); /* speaker att. LR = 0 dB */
	406	write_i2c(tr, 2, TDA7318_ADDR, 0xe0); /* speaker att. RR = 0 dB */
	407	write_i2c(tr, 2, TDA7318_ADDR, 0x40); /* stereo 1 input, gain = 18.75 dB */
1da177e4	408
1dc8aafc HV	409	tr_setvol(tr, 0xffff);
	410	tr_setbass(tr, 0x8000);
	411	tr_settreble(tr, 0x8000);
	412	tr_setstereo(tr, 1);
1da177e4 LT	413
1da177e4 LT	414	/* mute card - prevents noisy bootups */
1dc8aafc	415	tr_setmute(tr, 1);
1da177e4 LT	416
	417	return 0;
	418	}
	419
1da177e4 LT	420	static void __exit cleanup_trust_module(void)
1da177e4 LT	421	{
1dc8aafc HV	422	struct trust *tr = &trust_card;
	423
	424	video_unregister_device(&tr->vdev);
	425	v4l2_device_unregister(&tr->v4l2_dev);
	426	release_region(tr->io, 2);
1da177e4 LT	427	}
	428
	429	module_init(trust_init);
	430	module_exit(cleanup_trust_module);