1 /* zoltrix radio plus driver for Linux radio support
2 * (c) 1998 C. van Schaik <carl@leg.uct.ac.za>
5 * Due to the inconsistency in reading from the signal flags
6 * it is difficult to get an accurate tuned signal.
8 * It seems that the card is not linear to 0 volume. It cuts off
9 * at a low volume, and it is not possible (at least I have not found)
10 * to get fine volume control over the low volume range.
12 * Some code derived from code by Romolo Manfredini
15 * 1999-05-06 - (C. van Schaik)
16 * - Make signal strength and stereo scans
17 * kinder to cpu while in delay
18 * 1999-01-05 - (C. van Schaik)
19 * - Changed tuning to 1/160Mhz accuracy
20 * - Added stereo support
21 * (card defaults to stereo)
22 * (can explicitly force mono on the card)
23 * (can detect if station is in stereo)
24 * - Added unmute function
25 * - Reworked ioctl functions
26 * 2002-07-15 - Fix Stereo typo
28 * 2006-07-24 - Converted to V4L2 API
29 * by Mauro Carvalho Chehab <mchehab@infradead.org>
32 #include <linux/module.h> /* Modules */
33 #include <linux/init.h> /* Initdata */
34 #include <linux/ioport.h> /* request_region */
35 #include <linux/delay.h> /* udelay, msleep */
36 #include <asm/io.h> /* outb, outb_p */
37 #include <asm/uaccess.h> /* copy to/from user */
38 #include <linux/videodev2.h> /* kernel radio structs */
39 #include <media/v4l2-common.h>
40 #include <media/v4l2-ioctl.h>
42 #include <linux/version.h> /* for KERNEL_VERSION MACRO */
43 #define RADIO_VERSION KERNEL_VERSION(0,0,2)
45 static struct v4l2_queryctrl radio_qctrl
[] = {
47 .id
= V4L2_CID_AUDIO_MUTE
,
52 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
54 .id
= V4L2_CID_AUDIO_VOLUME
,
59 .default_value
= 0xff,
60 .type
= V4L2_CTRL_TYPE_INTEGER
,
64 #ifndef CONFIG_RADIO_ZOLTRIX_PORT
65 #define CONFIG_RADIO_ZOLTRIX_PORT -1
68 static int io
= CONFIG_RADIO_ZOLTRIX_PORT
;
69 static int radio_nr
= -1;
75 unsigned long curfreq
;
81 static int zol_setvol(struct zol_device
*dev
, int vol
)
87 mutex_lock(&dev
->lock
);
91 inb(io
+ 3); /* Zoltrix needs to be read to confirm */
92 mutex_unlock(&dev
->lock
);
96 outb(dev
->curvol
-1, io
);
99 mutex_unlock(&dev
->lock
);
103 static void zol_mute(struct zol_device
*dev
)
106 mutex_lock(&dev
->lock
);
109 inb(io
+ 3); /* Zoltrix needs to be read to confirm */
110 mutex_unlock(&dev
->lock
);
113 static void zol_unmute(struct zol_device
*dev
)
116 zol_setvol(dev
, dev
->curvol
);
119 static int zol_setfreq(struct zol_device
*dev
, unsigned long freq
)
121 /* tunes the radio to the desired frequency */
122 unsigned long long bitmask
, f
, m
;
123 unsigned int stereo
= dev
->stereo
;
127 printk(KERN_WARNING
"zoltrix: received zero freq. Failed to set.\n");
131 m
= (freq
/ 160 - 8800) * 2;
132 f
= (unsigned long long) m
+ 0x4d1c;
134 bitmask
= 0xc480402c10080000ull
;
137 mutex_lock(&dev
->lock
);
141 inb(io
+ 3); /* Zoltrix needs to be read to confirm */
146 bitmask
= (bitmask
^ ((f
& 0xff) << 47) ^ ((f
& 0xff00) << 30) ^ ( stereo
<< 31));
148 if ((bitmask
& 0x8000000000000000ull
) != 0) {
165 /* termination sequence */
182 mutex_unlock(&dev
->lock
);
186 zol_setvol(dev
, dev
->curvol
);
191 /* Get signal strength */
193 static int zol_getsigstr(struct zol_device
*dev
)
197 mutex_lock(&dev
->lock
);
198 outb(0x00, io
); /* This stuff I found to do nothing */
199 outb(dev
->curvol
, io
);
206 mutex_unlock(&dev
->lock
);
211 if ((a
== 0xcf) || (a
== 0xdf) /* I found this out by playing */
212 || (a
== 0xef)) /* with a binary scanner on the card io */
217 static int zol_is_stereo (struct zol_device
*dev
)
221 mutex_lock(&dev
->lock
);
224 outb(dev
->curvol
, io
);
231 mutex_unlock(&dev
->lock
);
233 if ((x1
== x2
) && (x1
== 0xcf))
238 static int vidioc_querycap(struct file
*file
, void *priv
,
239 struct v4l2_capability
*v
)
241 strlcpy(v
->driver
, "radio-zoltrix", sizeof(v
->driver
));
242 strlcpy(v
->card
, "Zoltrix Radio", sizeof(v
->card
));
243 sprintf(v
->bus_info
, "ISA");
244 v
->version
= RADIO_VERSION
;
245 v
->capabilities
= V4L2_CAP_TUNER
;
249 static int vidioc_g_tuner(struct file
*file
, void *priv
,
250 struct v4l2_tuner
*v
)
252 struct zol_device
*zol
= video_drvdata(file
);
257 strcpy(v
->name
, "FM");
258 v
->type
= V4L2_TUNER_RADIO
;
259 v
->rangelow
= (88*16000);
260 v
->rangehigh
= (108*16000);
261 v
->rxsubchans
= V4L2_TUNER_SUB_MONO
|V4L2_TUNER_SUB_STEREO
;
262 v
->capability
= V4L2_TUNER_CAP_LOW
;
263 if (zol_is_stereo(zol
))
264 v
->audmode
= V4L2_TUNER_MODE_STEREO
;
266 v
->audmode
= V4L2_TUNER_MODE_MONO
;
267 v
->signal
= 0xFFFF*zol_getsigstr(zol
);
271 static int vidioc_s_tuner(struct file
*file
, void *priv
,
272 struct v4l2_tuner
*v
)
279 static int vidioc_s_frequency(struct file
*file
, void *priv
,
280 struct v4l2_frequency
*f
)
282 struct zol_device
*zol
= video_drvdata(file
);
284 zol
->curfreq
= f
->frequency
;
285 if (zol_setfreq(zol
, zol
->curfreq
) != 0) {
286 printk(KERN_WARNING
"zoltrix: Set frequency failed.\n");
292 static int vidioc_g_frequency(struct file
*file
, void *priv
,
293 struct v4l2_frequency
*f
)
295 struct zol_device
*zol
= video_drvdata(file
);
297 f
->type
= V4L2_TUNER_RADIO
;
298 f
->frequency
= zol
->curfreq
;
302 static int vidioc_queryctrl(struct file
*file
, void *priv
,
303 struct v4l2_queryctrl
*qc
)
307 for (i
= 0; i
< ARRAY_SIZE(radio_qctrl
); i
++) {
308 if (qc
->id
&& qc
->id
== radio_qctrl
[i
].id
) {
309 memcpy(qc
, &(radio_qctrl
[i
]),
317 static int vidioc_g_ctrl(struct file
*file
, void *priv
,
318 struct v4l2_control
*ctrl
)
320 struct zol_device
*zol
= video_drvdata(file
);
323 case V4L2_CID_AUDIO_MUTE
:
324 ctrl
->value
= zol
->muted
;
326 case V4L2_CID_AUDIO_VOLUME
:
327 ctrl
->value
= zol
->curvol
* 4096;
333 static int vidioc_s_ctrl(struct file
*file
, void *priv
,
334 struct v4l2_control
*ctrl
)
336 struct zol_device
*zol
= video_drvdata(file
);
339 case V4L2_CID_AUDIO_MUTE
:
344 zol_setvol(zol
,zol
->curvol
);
347 case V4L2_CID_AUDIO_VOLUME
:
348 zol_setvol(zol
,ctrl
->value
/4096);
352 if (zol_setfreq(zol
, zol
->curfreq
) != 0) {
353 printk(KERN_WARNING
"zoltrix: Set frequency failed.\n");
357 /* FIXME: Implement stereo/mono switch on V4L2 */
358 if (v
->mode
& VIDEO_SOUND_STEREO
) {
360 zol_setfreq(zol
, zol
->curfreq
);
362 if (v
->mode
& VIDEO_SOUND_MONO
) {
364 zol_setfreq(zol
, zol
->curfreq
);
370 static int vidioc_g_audio(struct file
*file
, void *priv
,
371 struct v4l2_audio
*a
)
376 strcpy(a
->name
, "Radio");
377 a
->capability
= V4L2_AUDCAP_STEREO
;
381 static int vidioc_g_input(struct file
*filp
, void *priv
, unsigned int *i
)
387 static int vidioc_s_input(struct file
*filp
, void *priv
, unsigned int i
)
394 static int vidioc_s_audio(struct file
*file
, void *priv
,
395 struct v4l2_audio
*a
)
402 static struct zol_device zoltrix_unit
;
404 static int zoltrix_exclusive_open(struct file
*file
)
406 return test_and_set_bit(0, &zoltrix_unit
.in_use
) ? -EBUSY
: 0;
409 static int zoltrix_exclusive_release(struct file
*file
)
411 clear_bit(0, &zoltrix_unit
.in_use
);
415 static const struct v4l2_file_operations zoltrix_fops
=
417 .owner
= THIS_MODULE
,
418 .open
= zoltrix_exclusive_open
,
419 .release
= zoltrix_exclusive_release
,
420 .ioctl
= video_ioctl2
,
423 static const struct v4l2_ioctl_ops zoltrix_ioctl_ops
= {
424 .vidioc_querycap
= vidioc_querycap
,
425 .vidioc_g_tuner
= vidioc_g_tuner
,
426 .vidioc_s_tuner
= vidioc_s_tuner
,
427 .vidioc_g_audio
= vidioc_g_audio
,
428 .vidioc_s_audio
= vidioc_s_audio
,
429 .vidioc_g_input
= vidioc_g_input
,
430 .vidioc_s_input
= vidioc_s_input
,
431 .vidioc_g_frequency
= vidioc_g_frequency
,
432 .vidioc_s_frequency
= vidioc_s_frequency
,
433 .vidioc_queryctrl
= vidioc_queryctrl
,
434 .vidioc_g_ctrl
= vidioc_g_ctrl
,
435 .vidioc_s_ctrl
= vidioc_s_ctrl
,
438 static struct video_device zoltrix_radio
= {
439 .name
= "Zoltrix Radio Plus",
440 .fops
= &zoltrix_fops
,
441 .ioctl_ops
= &zoltrix_ioctl_ops
,
442 .release
= video_device_release_empty
,
445 static int __init
zoltrix_init(void)
448 printk(KERN_ERR
"You must set an I/O address with io=0x???\n");
451 if ((io
!= 0x20c) && (io
!= 0x30c)) {
452 printk(KERN_ERR
"zoltrix: invalid port, try 0x20c or 0x30c\n");
456 video_set_drvdata(&zoltrix_radio
, &zoltrix_unit
);
457 if (!request_region(io
, 2, "zoltrix")) {
458 printk(KERN_ERR
"zoltrix: port 0x%x already in use\n", io
);
462 if (video_register_device(&zoltrix_radio
, VFL_TYPE_RADIO
, radio_nr
) < 0) {
463 release_region(io
, 2);
466 printk(KERN_INFO
"Zoltrix Radio Plus card driver.\n");
468 mutex_init(&zoltrix_unit
.lock
);
470 /* mute card - prevents noisy bootups */
472 /* this ensures that the volume is all the way down */
479 zoltrix_unit
.curvol
= 0;
480 zoltrix_unit
.stereo
= 1;
485 MODULE_AUTHOR("C.van Schaik");
486 MODULE_DESCRIPTION("A driver for the Zoltrix Radio Plus.");
487 MODULE_LICENSE("GPL");
489 module_param(io
, int, 0);
490 MODULE_PARM_DESC(io
, "I/O address of the Zoltrix Radio Plus (0x20c or 0x30c)");
491 module_param(radio_nr
, int, 0);
493 static void __exit
zoltrix_cleanup_module(void)
495 video_unregister_device(&zoltrix_radio
);
496 release_region(io
, 2);
499 module_init(zoltrix_init
);
500 module_exit(zoltrix_cleanup_module
);