xref: /openbmc/linux/drivers/media/radio/radio-maxiradio.c (revision 3ca685aae04960eaa8b2c97baf384996c20cf9ac)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * Guillemot Maxi Radio FM 2000 PCI radio card driver for Linux
31da177e4SLinus Torvalds  * (C) 2001 Dimitromanolakis Apostolos <apdim@grecian.net>
41da177e4SLinus Torvalds  *
51da177e4SLinus Torvalds  * Based in the radio Maestro PCI driver. Actually it uses the same chip
61da177e4SLinus Torvalds  * for radio but different pci controller.
71da177e4SLinus Torvalds  *
81da177e4SLinus Torvalds  * I didn't have any specs I reversed engineered the protocol from
91da177e4SLinus Torvalds  * the windows driver (radio.dll).
101da177e4SLinus Torvalds  *
111da177e4SLinus Torvalds  * The card uses the TEA5757 chip that includes a search function but it
121da177e4SLinus Torvalds  * is useless as I haven't found any way to read back the frequency. If
131da177e4SLinus Torvalds  * anybody does please mail me.
141da177e4SLinus Torvalds  *
151da177e4SLinus Torvalds  * For the pdf file see:
161da177e4SLinus Torvalds  * http://www.semiconductors.philips.com/pip/TEA5757H/V1
171da177e4SLinus Torvalds  *
181da177e4SLinus Torvalds  *
191da177e4SLinus Torvalds  * CHANGES:
201da177e4SLinus Torvalds  *   0.75b
211da177e4SLinus Torvalds  *     - better pci interface thanks to Francois Romieu <romieu@cogenit.fr>
221da177e4SLinus Torvalds  *
23e84fef6bSMauro Carvalho Chehab  *   0.75      Sun Feb  4 22:51:27 EET 2001
241da177e4SLinus Torvalds  *     - tiding up
251da177e4SLinus Torvalds  *     - removed support for multiple devices as it didn't work anyway
261da177e4SLinus Torvalds  *
271da177e4SLinus Torvalds  * BUGS:
281da177e4SLinus Torvalds  *   - card unmutes if you change frequency
291da177e4SLinus Torvalds  *
3006470ed6SMauro Carvalho Chehab  * (c) 2006, 2007 by Mauro Carvalho Chehab <mchehab@infradead.org>:
3106470ed6SMauro Carvalho Chehab  *	- Conversion to V4L2 API
3206470ed6SMauro Carvalho Chehab  *      - Uses video_ioctl2 for parsing and to add debug support
331da177e4SLinus Torvalds  */
341da177e4SLinus Torvalds 
351da177e4SLinus Torvalds 
361da177e4SLinus Torvalds #include <linux/module.h>
371da177e4SLinus Torvalds #include <linux/init.h>
381da177e4SLinus Torvalds #include <linux/ioport.h>
391da177e4SLinus Torvalds #include <linux/delay.h>
401da177e4SLinus Torvalds #include <asm/io.h>
411da177e4SLinus Torvalds #include <asm/uaccess.h>
423593cab5SIngo Molnar #include <linux/mutex.h>
433593cab5SIngo Molnar 
441da177e4SLinus Torvalds #include <linux/pci.h>
45e84fef6bSMauro Carvalho Chehab #include <linux/videodev2.h>
465e87efa3SMauro Carvalho Chehab #include <media/v4l2-common.h>
4735ea11ffSHans Verkuil #include <media/v4l2-ioctl.h>
481da177e4SLinus Torvalds 
49f1557cebSMauro Carvalho Chehab #define DRIVER_VERSION	"0.77"
50e84fef6bSMauro Carvalho Chehab 
51e84fef6bSMauro Carvalho Chehab #include <linux/version.h>      /* for KERNEL_VERSION MACRO     */
52f1557cebSMauro Carvalho Chehab #define RADIO_VERSION KERNEL_VERSION(0,7,7)
53f1557cebSMauro Carvalho Chehab 
54f1557cebSMauro Carvalho Chehab static struct video_device maxiradio_radio;
55f1557cebSMauro Carvalho Chehab 
56f1557cebSMauro Carvalho Chehab #define dprintk(num, fmt, arg...)                                          \
57f1557cebSMauro Carvalho Chehab 	do {                                                               \
58f1557cebSMauro Carvalho Chehab 		if (maxiradio_radio.debug >= num)                          \
59f1557cebSMauro Carvalho Chehab 			printk(KERN_DEBUG "%s: " fmt,                      \
60f1557cebSMauro Carvalho Chehab 				maxiradio_radio.name, ## arg); } while (0)
61e84fef6bSMauro Carvalho Chehab 
62e84fef6bSMauro Carvalho Chehab static struct v4l2_queryctrl radio_qctrl[] = {
63e84fef6bSMauro Carvalho Chehab 	{
64e84fef6bSMauro Carvalho Chehab 		.id            = V4L2_CID_AUDIO_MUTE,
65e84fef6bSMauro Carvalho Chehab 		.name          = "Mute",
66e84fef6bSMauro Carvalho Chehab 		.minimum       = 0,
67e84fef6bSMauro Carvalho Chehab 		.maximum       = 1,
68e84fef6bSMauro Carvalho Chehab 		.default_value = 1,
69e84fef6bSMauro Carvalho Chehab 		.type          = V4L2_CTRL_TYPE_BOOLEAN,
70e84fef6bSMauro Carvalho Chehab 	}
71e84fef6bSMauro Carvalho Chehab };
721da177e4SLinus Torvalds 
731da177e4SLinus Torvalds #ifndef PCI_VENDOR_ID_GUILLEMOT
741da177e4SLinus Torvalds #define PCI_VENDOR_ID_GUILLEMOT 0x5046
751da177e4SLinus Torvalds #endif
761da177e4SLinus Torvalds 
771da177e4SLinus Torvalds #ifndef PCI_DEVICE_ID_GUILLEMOT
781da177e4SLinus Torvalds #define PCI_DEVICE_ID_GUILLEMOT_MAXIRADIO 0x1001
791da177e4SLinus Torvalds #endif
801da177e4SLinus Torvalds 
811da177e4SLinus Torvalds 
821da177e4SLinus Torvalds /* TEA5757 pin mappings */
831da177e4SLinus Torvalds static const int clk = 1, data = 2, wren = 4, mo_st = 8, power = 16 ;
841da177e4SLinus Torvalds 
851da177e4SLinus Torvalds static int radio_nr = -1;
861da177e4SLinus Torvalds module_param(radio_nr, int, 0);
871da177e4SLinus Torvalds 
88*3ca685aaSHans Verkuil static unsigned long in_use;
891da177e4SLinus Torvalds 
901da177e4SLinus Torvalds #define FREQ_LO		 50*16000
911da177e4SLinus Torvalds #define FREQ_HI		150*16000
921da177e4SLinus Torvalds 
931da177e4SLinus Torvalds #define FREQ_IF         171200 /* 10.7*16000   */
941da177e4SLinus Torvalds #define FREQ_STEP       200    /* 12.5*16      */
951da177e4SLinus Torvalds 
96f1557cebSMauro Carvalho Chehab /* (x==fmhz*16*1000) -> bits */
971da177e4SLinus Torvalds #define FREQ2BITS(x)	((( (unsigned int)(x)+FREQ_IF+(FREQ_STEP<<1)) \
98f1557cebSMauro Carvalho Chehab 			/(FREQ_STEP<<2))<<2)
991da177e4SLinus Torvalds 
1001da177e4SLinus Torvalds #define BITS2FREQ(x)	((x) * FREQ_STEP - FREQ_IF)
1011da177e4SLinus Torvalds 
1021da177e4SLinus Torvalds 
103*3ca685aaSHans Verkuil static int maxiradio_exclusive_open(struct inode *inode, struct file *file)
104*3ca685aaSHans Verkuil {
105*3ca685aaSHans Verkuil 	return test_and_set_bit(0, &in_use) ? -EBUSY : 0;
106*3ca685aaSHans Verkuil }
107*3ca685aaSHans Verkuil 
108*3ca685aaSHans Verkuil static int maxiradio_exclusive_release(struct inode *inode, struct file *file)
109*3ca685aaSHans Verkuil {
110*3ca685aaSHans Verkuil 	clear_bit(0, &in_use);
111*3ca685aaSHans Verkuil 	return 0;
112*3ca685aaSHans Verkuil }
113*3ca685aaSHans Verkuil 
114fa027c2aSArjan van de Ven static const struct file_operations maxiradio_fops = {
1151da177e4SLinus Torvalds 	.owner		= THIS_MODULE,
116*3ca685aaSHans Verkuil 	.open           = maxiradio_exclusive_open,
117*3ca685aaSHans Verkuil 	.release        = maxiradio_exclusive_release,
11806470ed6SMauro Carvalho Chehab 	.ioctl          = video_ioctl2,
119078ff795SDouglas Schilling Landgraf #ifdef CONFIG_COMPAT
1200d0fbf81SArnd Bergmann 	.compat_ioctl	= v4l_compat_ioctl32,
121078ff795SDouglas Schilling Landgraf #endif
1221da177e4SLinus Torvalds 	.llseek         = no_llseek,
1231da177e4SLinus Torvalds };
1241da177e4SLinus Torvalds 
1251da177e4SLinus Torvalds static struct radio_device
1261da177e4SLinus Torvalds {
1271da177e4SLinus Torvalds 	__u16	io,	/* base of radio io */
1281da177e4SLinus Torvalds 		muted,	/* VIDEO_AUDIO_MUTE */
1291da177e4SLinus Torvalds 		stereo,	/* VIDEO_TUNER_STEREO_ON */
1301da177e4SLinus Torvalds 		tuned;	/* signal strength (0 or 0xffff) */
1311da177e4SLinus Torvalds 
1321da177e4SLinus Torvalds 	unsigned long freq;
1331da177e4SLinus Torvalds 
1343593cab5SIngo Molnar 	struct mutex lock;
135712642b8SMauro Carvalho Chehab } radio_unit = {
136712642b8SMauro Carvalho Chehab 	.muted =1,
137712642b8SMauro Carvalho Chehab 	.freq = FREQ_LO,
138712642b8SMauro Carvalho Chehab };
1391da177e4SLinus Torvalds 
1401da177e4SLinus Torvalds static void outbit(unsigned long bit, __u16 io)
1411da177e4SLinus Torvalds {
1421da177e4SLinus Torvalds 	if (bit != 0)
1431da177e4SLinus Torvalds 		{
1441da177e4SLinus Torvalds 			outb(  power|wren|data     ,io); udelay(4);
1451da177e4SLinus Torvalds 			outb(  power|wren|data|clk ,io); udelay(4);
1461da177e4SLinus Torvalds 			outb(  power|wren|data     ,io); udelay(4);
1471da177e4SLinus Torvalds 		}
1481da177e4SLinus Torvalds 	else
1491da177e4SLinus Torvalds 		{
1501da177e4SLinus Torvalds 			outb(  power|wren          ,io); udelay(4);
1511da177e4SLinus Torvalds 			outb(  power|wren|clk      ,io); udelay(4);
1521da177e4SLinus Torvalds 			outb(  power|wren          ,io); udelay(4);
1531da177e4SLinus Torvalds 		}
1541da177e4SLinus Torvalds }
1551da177e4SLinus Torvalds 
1561da177e4SLinus Torvalds static void turn_power(__u16 io, int p)
1571da177e4SLinus Torvalds {
158f1557cebSMauro Carvalho Chehab 	if (p != 0) {
159f1557cebSMauro Carvalho Chehab 		dprintk(1, "Radio powered on\n");
160f1557cebSMauro Carvalho Chehab 		outb(power, io);
161f1557cebSMauro Carvalho Chehab 	} else {
162f1557cebSMauro Carvalho Chehab 		dprintk(1, "Radio powered off\n");
163f1557cebSMauro Carvalho Chehab 		outb(0,io);
164f1557cebSMauro Carvalho Chehab 	}
1651da177e4SLinus Torvalds }
1661da177e4SLinus Torvalds 
167f1557cebSMauro Carvalho Chehab static void set_freq(__u16 io, __u32 freq)
1681da177e4SLinus Torvalds {
1691da177e4SLinus Torvalds 	unsigned long int si;
1701da177e4SLinus Torvalds 	int bl;
171c6eb8eafSHans Verkuil 	int val = FREQ2BITS(freq);
1721da177e4SLinus Torvalds 
1731da177e4SLinus Torvalds 	/* TEA5757 shift register bits (see pdf) */
1741da177e4SLinus Torvalds 
175c6eb8eafSHans Verkuil 	outbit(0, io); /* 24  search */
176c6eb8eafSHans Verkuil 	outbit(1, io); /* 23  search up/down */
1771da177e4SLinus Torvalds 
178c6eb8eafSHans Verkuil 	outbit(0, io); /* 22  stereo/mono */
1791da177e4SLinus Torvalds 
180c6eb8eafSHans Verkuil 	outbit(0, io); /* 21  band */
181c6eb8eafSHans Verkuil 	outbit(0, io); /* 20  band (only 00=FM works I think) */
1821da177e4SLinus Torvalds 
183c6eb8eafSHans Verkuil 	outbit(0, io); /* 19  port ? */
184c6eb8eafSHans Verkuil 	outbit(0, io); /* 18  port ? */
1851da177e4SLinus Torvalds 
186c6eb8eafSHans Verkuil 	outbit(0, io); /* 17  search level */
187c6eb8eafSHans Verkuil 	outbit(0, io); /* 16  search level */
1881da177e4SLinus Torvalds 
1891da177e4SLinus Torvalds 	si = 0x8000;
190f1557cebSMauro Carvalho Chehab 	for (bl = 1; bl <= 16; bl++) {
191c6eb8eafSHans Verkuil 		outbit(val & si, io);
192f1557cebSMauro Carvalho Chehab 		si >>= 1;
193f1557cebSMauro Carvalho Chehab 	}
1941da177e4SLinus Torvalds 
195f1557cebSMauro Carvalho Chehab 	dprintk(1, "Radio freq set to %d.%02d MHz\n",
196f1557cebSMauro Carvalho Chehab 				freq / 16000,
197f1557cebSMauro Carvalho Chehab 				freq % 16000 * 100 / 16000);
198f1557cebSMauro Carvalho Chehab 
199f1557cebSMauro Carvalho Chehab 	turn_power(io, 1);
2001da177e4SLinus Torvalds }
2011da177e4SLinus Torvalds 
2021da177e4SLinus Torvalds static int get_stereo(__u16 io)
2031da177e4SLinus Torvalds {
204f1557cebSMauro Carvalho Chehab 	outb(power,io);
205f1557cebSMauro Carvalho Chehab 	udelay(4);
206f1557cebSMauro Carvalho Chehab 
2071da177e4SLinus Torvalds 	return !(inb(io) & mo_st);
2081da177e4SLinus Torvalds }
2091da177e4SLinus Torvalds 
2101da177e4SLinus Torvalds static int get_tune(__u16 io)
2111da177e4SLinus Torvalds {
212f1557cebSMauro Carvalho Chehab 	outb(power+clk,io);
213f1557cebSMauro Carvalho Chehab 	udelay(4);
214f1557cebSMauro Carvalho Chehab 
2151da177e4SLinus Torvalds 	return !(inb(io) & mo_st);
2161da177e4SLinus Torvalds }
2171da177e4SLinus Torvalds 
2181da177e4SLinus Torvalds 
21906470ed6SMauro Carvalho Chehab static int vidioc_querycap (struct file *file, void  *priv,
22006470ed6SMauro Carvalho Chehab 			    struct v4l2_capability *v)
2211da177e4SLinus Torvalds {
222e84fef6bSMauro Carvalho Chehab 	strlcpy(v->driver, "radio-maxiradio", sizeof (v->driver));
223e84fef6bSMauro Carvalho Chehab 	strlcpy(v->card, "Maxi Radio FM2000 radio", sizeof (v->card));
224e84fef6bSMauro Carvalho Chehab 	sprintf(v->bus_info,"ISA");
225e84fef6bSMauro Carvalho Chehab 	v->version = RADIO_VERSION;
226e84fef6bSMauro Carvalho Chehab 	v->capabilities = V4L2_CAP_TUNER;
227e84fef6bSMauro Carvalho Chehab 
2281da177e4SLinus Torvalds 	return 0;
2291da177e4SLinus Torvalds }
23006470ed6SMauro Carvalho Chehab 
23106470ed6SMauro Carvalho Chehab static int vidioc_g_tuner (struct file *file, void *priv,
23206470ed6SMauro Carvalho Chehab 			   struct v4l2_tuner *v)
233e84fef6bSMauro Carvalho Chehab {
23406470ed6SMauro Carvalho Chehab 	struct video_device *dev = video_devdata(file);
23506470ed6SMauro Carvalho Chehab 	struct radio_device *card=dev->priv;
2361da177e4SLinus Torvalds 
237e84fef6bSMauro Carvalho Chehab 	if (v->index > 0)
2381da177e4SLinus Torvalds 		return -EINVAL;
2391da177e4SLinus Torvalds 
240e84fef6bSMauro Carvalho Chehab 	memset(v,0,sizeof(*v));
2411da177e4SLinus Torvalds 	strcpy(v->name, "FM");
242e84fef6bSMauro Carvalho Chehab 	v->type = V4L2_TUNER_RADIO;
2431da177e4SLinus Torvalds 
2441da177e4SLinus Torvalds 	v->rangelow=FREQ_LO;
2451da177e4SLinus Torvalds 	v->rangehigh=FREQ_HI;
246e84fef6bSMauro Carvalho Chehab 	v->rxsubchans =V4L2_TUNER_SUB_MONO|V4L2_TUNER_SUB_STEREO;
247e84fef6bSMauro Carvalho Chehab 	v->capability=V4L2_TUNER_CAP_LOW;
248e84fef6bSMauro Carvalho Chehab 	if(get_stereo(card->io))
249e84fef6bSMauro Carvalho Chehab 		v->audmode = V4L2_TUNER_MODE_STEREO;
250e84fef6bSMauro Carvalho Chehab 	else
251e84fef6bSMauro Carvalho Chehab 		v->audmode = V4L2_TUNER_MODE_MONO;
252e84fef6bSMauro Carvalho Chehab 	v->signal=0xffff*get_tune(card->io);
2531da177e4SLinus Torvalds 
2541da177e4SLinus Torvalds 	return 0;
2551da177e4SLinus Torvalds }
256e84fef6bSMauro Carvalho Chehab 
25706470ed6SMauro Carvalho Chehab static int vidioc_s_tuner (struct file *file, void *priv,
25806470ed6SMauro Carvalho Chehab 			   struct v4l2_tuner *v)
25906470ed6SMauro Carvalho Chehab {
260e84fef6bSMauro Carvalho Chehab 	if (v->index > 0)
2611da177e4SLinus Torvalds 		return -EINVAL;
262e84fef6bSMauro Carvalho Chehab 
2631da177e4SLinus Torvalds 	return 0;
2641da177e4SLinus Torvalds }
26506470ed6SMauro Carvalho Chehab 
266140dcc46SMauro Carvalho Chehab static int vidioc_g_audio (struct file *file, void *priv,
267140dcc46SMauro Carvalho Chehab 			   struct v4l2_audio *a)
268140dcc46SMauro Carvalho Chehab {
269140dcc46SMauro Carvalho Chehab 	if (a->index > 1)
270140dcc46SMauro Carvalho Chehab 		return -EINVAL;
271140dcc46SMauro Carvalho Chehab 
272b61f8d69SMauro Carvalho Chehab 	strcpy(a->name, "FM");
273140dcc46SMauro Carvalho Chehab 	a->capability = V4L2_AUDCAP_STEREO;
274140dcc46SMauro Carvalho Chehab 	return 0;
275140dcc46SMauro Carvalho Chehab }
276140dcc46SMauro Carvalho Chehab 
277a0c05ab9SMauro Carvalho Chehab static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i)
278a0c05ab9SMauro Carvalho Chehab {
279a0c05ab9SMauro Carvalho Chehab 	*i = 0;
280f1557cebSMauro Carvalho Chehab 
281a0c05ab9SMauro Carvalho Chehab 	return 0;
282a0c05ab9SMauro Carvalho Chehab }
283a0c05ab9SMauro Carvalho Chehab 
284a0c05ab9SMauro Carvalho Chehab static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
285a0c05ab9SMauro Carvalho Chehab {
286a0c05ab9SMauro Carvalho Chehab 	if (i != 0)
287a0c05ab9SMauro Carvalho Chehab 		return -EINVAL;
288f1557cebSMauro Carvalho Chehab 
289a0c05ab9SMauro Carvalho Chehab 	return 0;
290a0c05ab9SMauro Carvalho Chehab }
291a0c05ab9SMauro Carvalho Chehab 
292a0c05ab9SMauro Carvalho Chehab 
293140dcc46SMauro Carvalho Chehab static int vidioc_s_audio (struct file *file, void *priv,
294140dcc46SMauro Carvalho Chehab 			   struct v4l2_audio *a)
295140dcc46SMauro Carvalho Chehab {
296140dcc46SMauro Carvalho Chehab 	if (a->index != 0)
297140dcc46SMauro Carvalho Chehab 		return -EINVAL;
298140dcc46SMauro Carvalho Chehab 
299140dcc46SMauro Carvalho Chehab 	return 0;
300140dcc46SMauro Carvalho Chehab }
301140dcc46SMauro Carvalho Chehab 
30206470ed6SMauro Carvalho Chehab static int vidioc_s_frequency (struct file *file, void *priv,
30306470ed6SMauro Carvalho Chehab 			       struct v4l2_frequency *f)
304e84fef6bSMauro Carvalho Chehab {
30506470ed6SMauro Carvalho Chehab 	struct video_device *dev = video_devdata(file);
30606470ed6SMauro Carvalho Chehab 	struct radio_device *card=dev->priv;
3071da177e4SLinus Torvalds 
308f1557cebSMauro Carvalho Chehab 	if (f->frequency < FREQ_LO || f->frequency > FREQ_HI) {
309f1557cebSMauro Carvalho Chehab 		dprintk(1, "radio freq (%d.%02d MHz) out of range (%d-%d)\n",
310f1557cebSMauro Carvalho Chehab 					f->frequency / 16000,
311f1557cebSMauro Carvalho Chehab 					f->frequency % 16000 * 100 / 16000,
312f1557cebSMauro Carvalho Chehab 					FREQ_LO / 16000, FREQ_HI / 16000);
313f1557cebSMauro Carvalho Chehab 
3141da177e4SLinus Torvalds 		return -EINVAL;
315f1557cebSMauro Carvalho Chehab 	}
316e84fef6bSMauro Carvalho Chehab 
317e84fef6bSMauro Carvalho Chehab 	card->freq = f->frequency;
318f1557cebSMauro Carvalho Chehab 	set_freq(card->io, card->freq);
3191da177e4SLinus Torvalds 	msleep(125);
32006470ed6SMauro Carvalho Chehab 
3211da177e4SLinus Torvalds 	return 0;
3221da177e4SLinus Torvalds }
32306470ed6SMauro Carvalho Chehab 
32406470ed6SMauro Carvalho Chehab static int vidioc_g_frequency (struct file *file, void *priv,
32506470ed6SMauro Carvalho Chehab 			       struct v4l2_frequency *f)
326e84fef6bSMauro Carvalho Chehab {
32706470ed6SMauro Carvalho Chehab 	struct video_device *dev = video_devdata(file);
32806470ed6SMauro Carvalho Chehab 	struct radio_device *card=dev->priv;
329e84fef6bSMauro Carvalho Chehab 
330e84fef6bSMauro Carvalho Chehab 	f->type = V4L2_TUNER_RADIO;
331e84fef6bSMauro Carvalho Chehab 	f->frequency = card->freq;
332e84fef6bSMauro Carvalho Chehab 
333f1557cebSMauro Carvalho Chehab 	dprintk(4, "radio freq is %d.%02d MHz",
334f1557cebSMauro Carvalho Chehab 				f->frequency / 16000,
335f1557cebSMauro Carvalho Chehab 				f->frequency % 16000 * 100 / 16000);
336f1557cebSMauro Carvalho Chehab 
3371da177e4SLinus Torvalds 	return 0;
3381da177e4SLinus Torvalds }
33906470ed6SMauro Carvalho Chehab 
34006470ed6SMauro Carvalho Chehab static int vidioc_queryctrl (struct file *file, void *priv,
34106470ed6SMauro Carvalho Chehab 			     struct v4l2_queryctrl *qc)
342e84fef6bSMauro Carvalho Chehab {
343e84fef6bSMauro Carvalho Chehab 	int i;
3441da177e4SLinus Torvalds 
345e84fef6bSMauro Carvalho Chehab 	for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) {
346e84fef6bSMauro Carvalho Chehab 		if (qc->id && qc->id == radio_qctrl[i].id) {
34706470ed6SMauro Carvalho Chehab 			memcpy(qc, &(radio_qctrl[i]), sizeof(*qc));
348e84fef6bSMauro Carvalho Chehab 			return (0);
349e84fef6bSMauro Carvalho Chehab 		}
350e84fef6bSMauro Carvalho Chehab 	}
351f1557cebSMauro Carvalho Chehab 
3521da177e4SLinus Torvalds 	return -EINVAL;
353e84fef6bSMauro Carvalho Chehab }
35406470ed6SMauro Carvalho Chehab 
35506470ed6SMauro Carvalho Chehab static int vidioc_g_ctrl (struct file *file, void *priv,
35606470ed6SMauro Carvalho Chehab 			    struct v4l2_control *ctrl)
357e84fef6bSMauro Carvalho Chehab {
35806470ed6SMauro Carvalho Chehab 	struct video_device *dev = video_devdata(file);
35906470ed6SMauro Carvalho Chehab 	struct radio_device *card=dev->priv;
360e84fef6bSMauro Carvalho Chehab 
361e84fef6bSMauro Carvalho Chehab 	switch (ctrl->id) {
362e84fef6bSMauro Carvalho Chehab 		case V4L2_CID_AUDIO_MUTE:
363e84fef6bSMauro Carvalho Chehab 			ctrl->value=card->muted;
364e84fef6bSMauro Carvalho Chehab 			return (0);
365e84fef6bSMauro Carvalho Chehab 	}
366f1557cebSMauro Carvalho Chehab 
367e84fef6bSMauro Carvalho Chehab 	return -EINVAL;
368e84fef6bSMauro Carvalho Chehab }
36906470ed6SMauro Carvalho Chehab 
37006470ed6SMauro Carvalho Chehab static int vidioc_s_ctrl (struct file *file, void *priv,
37106470ed6SMauro Carvalho Chehab 			  struct v4l2_control *ctrl)
372e84fef6bSMauro Carvalho Chehab {
37306470ed6SMauro Carvalho Chehab 	struct video_device *dev = video_devdata(file);
37406470ed6SMauro Carvalho Chehab 	struct radio_device *card=dev->priv;
375e84fef6bSMauro Carvalho Chehab 
376e84fef6bSMauro Carvalho Chehab 	switch (ctrl->id) {
377e84fef6bSMauro Carvalho Chehab 		case V4L2_CID_AUDIO_MUTE:
378e84fef6bSMauro Carvalho Chehab 			card->muted = ctrl->value;
3791da177e4SLinus Torvalds 			if(card->muted)
3801da177e4SLinus Torvalds 				turn_power(card->io, 0);
3811da177e4SLinus Torvalds 			else
382f1557cebSMauro Carvalho Chehab 				set_freq(card->io, card->freq);
3831da177e4SLinus Torvalds 			return 0;
3841da177e4SLinus Torvalds 	}
385f1557cebSMauro Carvalho Chehab 
386e84fef6bSMauro Carvalho Chehab 	return -EINVAL;
3871da177e4SLinus Torvalds }
388e84fef6bSMauro Carvalho Chehab 
389a399810cSHans Verkuil static const struct v4l2_ioctl_ops maxiradio_ioctl_ops = {
39006470ed6SMauro Carvalho Chehab 	.vidioc_querycap    = vidioc_querycap,
39106470ed6SMauro Carvalho Chehab 	.vidioc_g_tuner     = vidioc_g_tuner,
39206470ed6SMauro Carvalho Chehab 	.vidioc_s_tuner     = vidioc_s_tuner,
393140dcc46SMauro Carvalho Chehab 	.vidioc_g_audio     = vidioc_g_audio,
394140dcc46SMauro Carvalho Chehab 	.vidioc_s_audio     = vidioc_s_audio,
395a0c05ab9SMauro Carvalho Chehab 	.vidioc_g_input     = vidioc_g_input,
396a0c05ab9SMauro Carvalho Chehab 	.vidioc_s_input     = vidioc_s_input,
39706470ed6SMauro Carvalho Chehab 	.vidioc_g_frequency = vidioc_g_frequency,
39806470ed6SMauro Carvalho Chehab 	.vidioc_s_frequency = vidioc_s_frequency,
39906470ed6SMauro Carvalho Chehab 	.vidioc_queryctrl   = vidioc_queryctrl,
40006470ed6SMauro Carvalho Chehab 	.vidioc_g_ctrl      = vidioc_g_ctrl,
40106470ed6SMauro Carvalho Chehab 	.vidioc_s_ctrl      = vidioc_s_ctrl,
40206470ed6SMauro Carvalho Chehab };
4031da177e4SLinus Torvalds 
404a399810cSHans Verkuil static struct video_device maxiradio_radio = {
405a399810cSHans Verkuil 	.name		    = "Maxi Radio FM2000 radio",
406a399810cSHans Verkuil 	.fops               = &maxiradio_fops,
407a399810cSHans Verkuil 	.ioctl_ops 	    = &maxiradio_ioctl_ops,
408a399810cSHans Verkuil };
409a399810cSHans Verkuil 
4101da177e4SLinus Torvalds static int __devinit maxiradio_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
4111da177e4SLinus Torvalds {
4121da177e4SLinus Torvalds 	if(!request_region(pci_resource_start(pdev, 0),
4131da177e4SLinus Torvalds 			   pci_resource_len(pdev, 0), "Maxi Radio FM 2000")) {
4141da177e4SLinus Torvalds 		printk(KERN_ERR "radio-maxiradio: can't reserve I/O ports\n");
4151da177e4SLinus Torvalds 		goto err_out;
4161da177e4SLinus Torvalds 	}
4171da177e4SLinus Torvalds 
4181da177e4SLinus Torvalds 	if (pci_enable_device(pdev))
4191da177e4SLinus Torvalds 		goto err_out_free_region;
4201da177e4SLinus Torvalds 
4211da177e4SLinus Torvalds 	radio_unit.io = pci_resource_start(pdev, 0);
4223593cab5SIngo Molnar 	mutex_init(&radio_unit.lock);
4231da177e4SLinus Torvalds 	maxiradio_radio.priv = &radio_unit;
4241da177e4SLinus Torvalds 
425cba99ae8SHans Verkuil 	if (video_register_device(&maxiradio_radio, VFL_TYPE_RADIO, radio_nr) < 0) {
4261da177e4SLinus Torvalds 		printk("radio-maxiradio: can't register device!");
4271da177e4SLinus Torvalds 		goto err_out_free_region;
4281da177e4SLinus Torvalds 	}
4291da177e4SLinus Torvalds 
4301da177e4SLinus Torvalds 	printk(KERN_INFO "radio-maxiradio: version "
4311da177e4SLinus Torvalds 	       DRIVER_VERSION
4321da177e4SLinus Torvalds 	       " time "
4331da177e4SLinus Torvalds 	       __TIME__ "  "
4341da177e4SLinus Torvalds 	       __DATE__
4351da177e4SLinus Torvalds 	       "\n");
4361da177e4SLinus Torvalds 
4371da177e4SLinus Torvalds 	printk(KERN_INFO "radio-maxiradio: found Guillemot MAXI Radio device (io = 0x%x)\n",
4381da177e4SLinus Torvalds 	       radio_unit.io);
4391da177e4SLinus Torvalds 	return 0;
4401da177e4SLinus Torvalds 
4411da177e4SLinus Torvalds err_out_free_region:
4421da177e4SLinus Torvalds 	release_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0));
4431da177e4SLinus Torvalds err_out:
4441da177e4SLinus Torvalds 	return -ENODEV;
4451da177e4SLinus Torvalds }
4461da177e4SLinus Torvalds 
4471da177e4SLinus Torvalds static void __devexit maxiradio_remove_one(struct pci_dev *pdev)
4481da177e4SLinus Torvalds {
4491da177e4SLinus Torvalds 	video_unregister_device(&maxiradio_radio);
4501da177e4SLinus Torvalds 	release_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0));
4511da177e4SLinus Torvalds }
4521da177e4SLinus Torvalds 
4531da177e4SLinus Torvalds static struct pci_device_id maxiradio_pci_tbl[] = {
4541da177e4SLinus Torvalds 	{ PCI_VENDOR_ID_GUILLEMOT, PCI_DEVICE_ID_GUILLEMOT_MAXIRADIO,
4551da177e4SLinus Torvalds 		PCI_ANY_ID, PCI_ANY_ID, },
4561da177e4SLinus Torvalds 	{ 0,}
4571da177e4SLinus Torvalds };
4581da177e4SLinus Torvalds 
4591da177e4SLinus Torvalds MODULE_DEVICE_TABLE(pci, maxiradio_pci_tbl);
4601da177e4SLinus Torvalds 
4611da177e4SLinus Torvalds static struct pci_driver maxiradio_driver = {
4621da177e4SLinus Torvalds 	.name		= "radio-maxiradio",
4631da177e4SLinus Torvalds 	.id_table	= maxiradio_pci_tbl,
4641da177e4SLinus Torvalds 	.probe		= maxiradio_init_one,
4651da177e4SLinus Torvalds 	.remove		= __devexit_p(maxiradio_remove_one),
4661da177e4SLinus Torvalds };
4671da177e4SLinus Torvalds 
4681da177e4SLinus Torvalds static int __init maxiradio_radio_init(void)
4691da177e4SLinus Torvalds {
4709bfab8ceSRichard Knutsson 	return pci_register_driver(&maxiradio_driver);
4711da177e4SLinus Torvalds }
4721da177e4SLinus Torvalds 
4731da177e4SLinus Torvalds static void __exit maxiradio_radio_exit(void)
4741da177e4SLinus Torvalds {
4751da177e4SLinus Torvalds 	pci_unregister_driver(&maxiradio_driver);
4761da177e4SLinus Torvalds }
4771da177e4SLinus Torvalds 
4781da177e4SLinus Torvalds module_init(maxiradio_radio_init);
4791da177e4SLinus Torvalds module_exit(maxiradio_radio_exit);
48006470ed6SMauro Carvalho Chehab 
48106470ed6SMauro Carvalho Chehab MODULE_AUTHOR("Dimitromanolakis Apostolos, apdim@grecian.net");
48206470ed6SMauro Carvalho Chehab MODULE_DESCRIPTION("Radio driver for the Guillemot Maxi Radio FM2000 radio.");
48306470ed6SMauro Carvalho Chehab MODULE_LICENSE("GPL");
48406470ed6SMauro Carvalho Chehab 
48506470ed6SMauro Carvalho Chehab module_param_named(debug,maxiradio_radio.debug, int, 0644);
48606470ed6SMauro Carvalho Chehab MODULE_PARM_DESC(debug,"activates debug info");
487