2 * Guillemot Maxi Radio FM 2000 PCI radio card driver for Linux
3 * (C) 2001 Dimitromanolakis Apostolos <apdim@grecian.net>
5 * Based in the radio Maestro PCI driver. Actually it uses the same chip
6 * for radio but different pci controller.
8 * I didn't have any specs I reversed engineered the protocol from
9 * the windows driver (radio.dll).
11 * The card uses the TEA5757 chip that includes a search function but it
12 * is useless as I haven't found any way to read back the frequency. If
13 * anybody does please mail me.
15 * For the pdf file see:
16 * http://www.nxp.com/acrobat_download2/expired_datasheets/TEA5757_5759_3.pdf
21 * - better pci interface thanks to Francois Romieu <romieu@cogenit.fr>
23 * 0.75 Sun Feb 4 22:51:27 EET 2001
25 * - removed support for multiple devices as it didn't work anyway
28 * - card unmutes if you change frequency
30 * (c) 2006, 2007 by Mauro Carvalho Chehab <mchehab@infradead.org>:
31 * - Conversion to V4L2 API
32 * - Uses video_ioctl2 for parsing and to add debug support
36 #include <linux/module.h>
37 #include <linux/init.h>
38 #include <linux/ioport.h>
39 #include <linux/delay.h>
40 #include <linux/mutex.h>
41 #include <linux/pci.h>
42 #include <linux/videodev2.h>
43 #include <linux/version.h> /* for KERNEL_VERSION MACRO */
45 #include <linux/slab.h>
46 #include <media/v4l2-device.h>
47 #include <media/v4l2-ioctl.h>
49 MODULE_AUTHOR("Dimitromanolakis Apostolos, apdim@grecian.net");
50 MODULE_DESCRIPTION("Radio driver for the Guillemot Maxi Radio FM2000 radio.");
51 MODULE_LICENSE("GPL");
53 static int radio_nr
= -1;
54 module_param(radio_nr
, int, 0);
58 module_param(debug
, int, 0644);
59 MODULE_PARM_DESC(debug
, "activates debug info");
61 #define DRIVER_VERSION "0.77"
63 #define RADIO_VERSION KERNEL_VERSION(0, 7, 7)
65 #define dprintk(dev, num, fmt, arg...) \
66 v4l2_dbg(num, debug, &dev->v4l2_dev, fmt, ## arg)
68 #ifndef PCI_VENDOR_ID_GUILLEMOT
69 #define PCI_VENDOR_ID_GUILLEMOT 0x5046
72 #ifndef PCI_DEVICE_ID_GUILLEMOT
73 #define PCI_DEVICE_ID_GUILLEMOT_MAXIRADIO 0x1001
77 /* TEA5757 pin mappings */
78 static const int clk
= 1, data
= 2, wren
= 4, mo_st
= 8, power
= 16;
80 #define FREQ_LO (87 * 16000)
81 #define FREQ_HI (108 * 16000)
83 #define FREQ_IF 171200 /* 10.7*16000 */
84 #define FREQ_STEP 200 /* 12.5*16 */
86 /* (x==fmhz*16*1000) -> bits */
87 #define FREQ2BITS(x) \
88 ((((unsigned int)(x) + FREQ_IF + (FREQ_STEP << 1)) / (FREQ_STEP << 2)) << 2)
90 #define BITS2FREQ(x) ((x) * FREQ_STEP - FREQ_IF)
95 struct v4l2_device v4l2_dev
;
96 struct video_device vdev
;
99 u16 io
; /* base of radio io */
100 u16 muted
; /* VIDEO_AUDIO_MUTE */
101 u16 stereo
; /* VIDEO_TUNER_STEREO_ON */
102 u16 tuned
; /* signal strength (0 or 0xffff) */
109 static inline struct maxiradio
*to_maxiradio(struct v4l2_device
*v4l2_dev
)
111 return container_of(v4l2_dev
, struct maxiradio
, v4l2_dev
);
114 static void outbit(unsigned long bit
, u16 io
)
116 int val
= power
| wren
| (bit
? data
: 0);
126 static void turn_power(struct maxiradio
*dev
, int p
)
129 dprintk(dev
, 1, "Radio powered on\n");
130 outb(power
, dev
->io
);
132 dprintk(dev
, 1, "Radio powered off\n");
137 static void set_freq(struct maxiradio
*dev
, u32 freq
)
139 unsigned long int si
;
142 int val
= FREQ2BITS(freq
);
144 /* TEA5757 shift register bits (see pdf) */
146 outbit(0, io
); /* 24 search */
147 outbit(1, io
); /* 23 search up/down */
149 outbit(0, io
); /* 22 stereo/mono */
151 outbit(0, io
); /* 21 band */
152 outbit(0, io
); /* 20 band (only 00=FM works I think) */
154 outbit(0, io
); /* 19 port ? */
155 outbit(0, io
); /* 18 port ? */
157 outbit(0, io
); /* 17 search level */
158 outbit(0, io
); /* 16 search level */
161 for (bl
= 1; bl
<= 16; bl
++) {
162 outbit(val
& si
, io
);
166 dprintk(dev
, 1, "Radio freq set to %d.%02d MHz\n",
168 freq
% 16000 * 100 / 16000);
173 static int get_stereo(u16 io
)
178 return !(inb(io
) & mo_st
);
181 static int get_tune(u16 io
)
186 return !(inb(io
) & mo_st
);
190 static int vidioc_querycap(struct file
*file
, void *priv
,
191 struct v4l2_capability
*v
)
193 struct maxiradio
*dev
= video_drvdata(file
);
195 strlcpy(v
->driver
, "radio-maxiradio", sizeof(v
->driver
));
196 strlcpy(v
->card
, "Maxi Radio FM2000 radio", sizeof(v
->card
));
197 snprintf(v
->bus_info
, sizeof(v
->bus_info
), "PCI:%s", pci_name(dev
->pdev
));
198 v
->version
= RADIO_VERSION
;
199 v
->capabilities
= V4L2_CAP_TUNER
| V4L2_CAP_RADIO
;
203 static int vidioc_g_tuner(struct file
*file
, void *priv
,
204 struct v4l2_tuner
*v
)
206 struct maxiradio
*dev
= video_drvdata(file
);
211 mutex_lock(&dev
->lock
);
212 strlcpy(v
->name
, "FM", sizeof(v
->name
));
213 v
->type
= V4L2_TUNER_RADIO
;
214 v
->rangelow
= FREQ_LO
;
215 v
->rangehigh
= FREQ_HI
;
216 v
->rxsubchans
= V4L2_TUNER_SUB_MONO
| V4L2_TUNER_SUB_STEREO
;
217 v
->capability
= V4L2_TUNER_CAP_LOW
;
218 if (get_stereo(dev
->io
))
219 v
->audmode
= V4L2_TUNER_MODE_STEREO
;
221 v
->audmode
= V4L2_TUNER_MODE_MONO
;
222 v
->signal
= 0xffff * get_tune(dev
->io
);
223 mutex_unlock(&dev
->lock
);
228 static int vidioc_s_tuner(struct file
*file
, void *priv
,
229 struct v4l2_tuner
*v
)
231 return v
->index
? -EINVAL
: 0;
234 static int vidioc_g_input(struct file
*filp
, void *priv
, unsigned int *i
)
240 static int vidioc_s_input(struct file
*filp
, void *priv
, unsigned int i
)
242 return i
? -EINVAL
: 0;
245 static int vidioc_g_audio(struct file
*file
, void *priv
,
246 struct v4l2_audio
*a
)
249 strlcpy(a
->name
, "Radio", sizeof(a
->name
));
250 a
->capability
= V4L2_AUDCAP_STEREO
;
255 static int vidioc_s_audio(struct file
*file
, void *priv
,
256 struct v4l2_audio
*a
)
258 return a
->index
? -EINVAL
: 0;
261 static int vidioc_s_frequency(struct file
*file
, void *priv
,
262 struct v4l2_frequency
*f
)
264 struct maxiradio
*dev
= video_drvdata(file
);
266 if (f
->tuner
!= 0 || f
->type
!= V4L2_TUNER_RADIO
)
268 if (f
->frequency
< FREQ_LO
|| f
->frequency
> FREQ_HI
) {
269 dprintk(dev
, 1, "radio freq (%d.%02d MHz) out of range (%d-%d)\n",
270 f
->frequency
/ 16000,
271 f
->frequency
% 16000 * 100 / 16000,
272 FREQ_LO
/ 16000, FREQ_HI
/ 16000);
277 mutex_lock(&dev
->lock
);
278 dev
->freq
= f
->frequency
;
279 set_freq(dev
, dev
->freq
);
281 mutex_unlock(&dev
->lock
);
286 static int vidioc_g_frequency(struct file
*file
, void *priv
,
287 struct v4l2_frequency
*f
)
289 struct maxiradio
*dev
= video_drvdata(file
);
293 f
->type
= V4L2_TUNER_RADIO
;
294 f
->frequency
= dev
->freq
;
296 dprintk(dev
, 4, "radio freq is %d.%02d MHz",
297 f
->frequency
/ 16000,
298 f
->frequency
% 16000 * 100 / 16000);
303 static int vidioc_queryctrl(struct file
*file
, void *priv
,
304 struct v4l2_queryctrl
*qc
)
307 case V4L2_CID_AUDIO_MUTE
:
308 return v4l2_ctrl_query_fill(qc
, 0, 1, 1, 1);
313 static int vidioc_g_ctrl(struct file
*file
, void *priv
,
314 struct v4l2_control
*ctrl
)
316 struct maxiradio
*dev
= video_drvdata(file
);
319 case V4L2_CID_AUDIO_MUTE
:
320 ctrl
->value
= dev
->muted
;
327 static int vidioc_s_ctrl(struct file
*file
, void *priv
,
328 struct v4l2_control
*ctrl
)
330 struct maxiradio
*dev
= video_drvdata(file
);
333 case V4L2_CID_AUDIO_MUTE
:
334 mutex_lock(&dev
->lock
);
335 dev
->muted
= ctrl
->value
;
339 set_freq(dev
, dev
->freq
);
340 mutex_unlock(&dev
->lock
);
347 static const struct v4l2_file_operations maxiradio_fops
= {
348 .owner
= THIS_MODULE
,
349 .unlocked_ioctl
= video_ioctl2
,
352 static const struct v4l2_ioctl_ops maxiradio_ioctl_ops
= {
353 .vidioc_querycap
= vidioc_querycap
,
354 .vidioc_g_tuner
= vidioc_g_tuner
,
355 .vidioc_s_tuner
= vidioc_s_tuner
,
356 .vidioc_g_audio
= vidioc_g_audio
,
357 .vidioc_s_audio
= vidioc_s_audio
,
358 .vidioc_g_input
= vidioc_g_input
,
359 .vidioc_s_input
= vidioc_s_input
,
360 .vidioc_g_frequency
= vidioc_g_frequency
,
361 .vidioc_s_frequency
= vidioc_s_frequency
,
362 .vidioc_queryctrl
= vidioc_queryctrl
,
363 .vidioc_g_ctrl
= vidioc_g_ctrl
,
364 .vidioc_s_ctrl
= vidioc_s_ctrl
,
367 static int __devinit
maxiradio_init_one(struct pci_dev
*pdev
, const struct pci_device_id
*ent
)
369 struct maxiradio
*dev
;
370 struct v4l2_device
*v4l2_dev
;
371 int retval
= -ENOMEM
;
373 dev
= kzalloc(sizeof(*dev
), GFP_KERNEL
);
375 dev_err(&pdev
->dev
, "not enough memory\n");
379 v4l2_dev
= &dev
->v4l2_dev
;
380 mutex_init(&dev
->lock
);
385 strlcpy(v4l2_dev
->name
, "maxiradio", sizeof(v4l2_dev
->name
));
387 retval
= v4l2_device_register(&pdev
->dev
, v4l2_dev
);
389 v4l2_err(v4l2_dev
, "Could not register v4l2_device\n");
393 if (!request_region(pci_resource_start(pdev
, 0),
394 pci_resource_len(pdev
, 0), "Maxi Radio FM 2000")) {
395 v4l2_err(v4l2_dev
, "can't reserve I/O ports\n");
399 if (pci_enable_device(pdev
))
400 goto err_out_free_region
;
402 dev
->io
= pci_resource_start(pdev
, 0);
403 strlcpy(dev
->vdev
.name
, v4l2_dev
->name
, sizeof(dev
->vdev
.name
));
404 dev
->vdev
.v4l2_dev
= v4l2_dev
;
405 dev
->vdev
.fops
= &maxiradio_fops
;
406 dev
->vdev
.ioctl_ops
= &maxiradio_ioctl_ops
;
407 dev
->vdev
.release
= video_device_release_empty
;
408 video_set_drvdata(&dev
->vdev
, dev
);
410 if (video_register_device(&dev
->vdev
, VFL_TYPE_RADIO
, radio_nr
) < 0) {
411 v4l2_err(v4l2_dev
, "can't register device!");
412 goto err_out_free_region
;
415 v4l2_info(v4l2_dev
, "version " DRIVER_VERSION
416 " time " __TIME__
" " __DATE__
"\n");
418 v4l2_info(v4l2_dev
, "found Guillemot MAXI Radio device (io = 0x%x)\n",
423 release_region(pci_resource_start(pdev
, 0), pci_resource_len(pdev
, 0));
425 v4l2_device_unregister(v4l2_dev
);
431 static void __devexit
maxiradio_remove_one(struct pci_dev
*pdev
)
433 struct v4l2_device
*v4l2_dev
= dev_get_drvdata(&pdev
->dev
);
434 struct maxiradio
*dev
= to_maxiradio(v4l2_dev
);
436 video_unregister_device(&dev
->vdev
);
437 v4l2_device_unregister(&dev
->v4l2_dev
);
438 release_region(pci_resource_start(pdev
, 0), pci_resource_len(pdev
, 0));
441 static struct pci_device_id maxiradio_pci_tbl
[] = {
442 { PCI_VENDOR_ID_GUILLEMOT
, PCI_DEVICE_ID_GUILLEMOT_MAXIRADIO
,
443 PCI_ANY_ID
, PCI_ANY_ID
, },
447 MODULE_DEVICE_TABLE(pci
, maxiradio_pci_tbl
);
449 static struct pci_driver maxiradio_driver
= {
450 .name
= "radio-maxiradio",
451 .id_table
= maxiradio_pci_tbl
,
452 .probe
= maxiradio_init_one
,
453 .remove
= __devexit_p(maxiradio_remove_one
),
456 static int __init
maxiradio_radio_init(void)
458 return pci_register_driver(&maxiradio_driver
);
461 static void __exit
maxiradio_radio_exit(void)
463 pci_unregister_driver(&maxiradio_driver
);
466 module_init(maxiradio_radio_init
);
467 module_exit(maxiradio_radio_exit
);