1 /* SF16FMR2 radio driver for Linux radio support
2 * heavily based on fmi driver...
3 * (c) 2000-2002 Ziglio Frediano, freddy77@angelfire.com
5 * Notes on the hardware
7 * Frequency control is done digitally -- ie out(port,encodefreq(95.8));
8 * No volume control - only mute/unmute - you have to use line volume
10 * For read stereo/mono you must wait 0.1 sec after set frequency and
11 * card unmuted so I set frequency on unmute
12 * Signal handling seem to work only on autoscanning (not implemented)
14 * Converted to V4L2 API by Mauro Carvalho Chehab <mchehab@infradead.org>
17 #include <linux/module.h> /* Modules */
18 #include <linux/init.h> /* Initdata */
19 #include <linux/ioport.h> /* request_region */
20 #include <linux/delay.h> /* udelay */
21 #include <asm/io.h> /* outb, outb_p */
22 #include <asm/uaccess.h> /* copy to/from user */
23 #include <linux/videodev2.h> /* kernel radio structs */
24 #include <media/v4l2-common.h>
25 #include <media/v4l2-ioctl.h>
26 #include <linux/mutex.h>
28 static struct mutex lock
;
30 #include <linux/version.h> /* for KERNEL_VERSION MACRO */
31 #define RADIO_VERSION KERNEL_VERSION(0,0,2)
33 #define AUD_VOL_INDEX 1
35 static struct v4l2_queryctrl radio_qctrl
[] = {
37 .id
= V4L2_CID_AUDIO_MUTE
,
42 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
45 .id
= V4L2_CID_AUDIO_VOLUME
,
51 .type
= V4L2_CTRL_TYPE_INTEGER
,
59 # define debug_print(s) printk s
61 # define debug_print(s)
64 /* this should be static vars for module size */
68 int curvol
; /* 0-15 */
70 int stereo
; /* card is producing stereo audio */
71 unsigned long curfreq
; /* freq in kHz */
76 static int io
= 0x384;
77 static int radio_nr
= -1;
79 /* hw precision is 12.5 kHz
80 * It is only useful to give freq in intervall of 200 (=0.0125Mhz),
81 * other bits will be truncated
83 #define RSF16_ENCODE(x) ((x)/200+856)
84 #define RSF16_MINFREQ 87*16000
85 #define RSF16_MAXFREQ 108*16000
87 static inline void wait(int n
,int port
)
89 for (;n
;--n
) inb(port
);
92 static void outbits(int bits
, unsigned int data
, int nWait
, int port
)
96 bit
= (data
>>bits
) & 1;
106 static inline void fmr2_mute(int port
)
112 static inline void fmr2_unmute(int port
)
118 static inline int fmr2_stereo_mode(int port
)
124 debug_print((KERN_DEBUG
"stereo: %d\n", n
));
128 static int fmr2_product_info(struct fmr2_device
*dev
)
130 int n
= inb(dev
->port
);
134 /* this should support volume set */
138 /* not volume (mine is 11) */
139 dev
->card_type
= (n
==128)?11:0;
143 static inline int fmr2_getsigstr(struct fmr2_device
*dev
)
145 /* !!! work only if scanning freq */
146 int port
= dev
->port
, res
= 0xffff;
149 if (!(inb(port
)&1)) res
= 0;
150 debug_print((KERN_DEBUG
"signal: %d\n", res
));
154 /* set frequency and unmute card */
155 static int fmr2_setfreq(struct fmr2_device
*dev
)
157 int port
= dev
->port
;
158 unsigned long freq
= dev
->curfreq
;
162 /* 0x42 for mono output
163 * 0x102 forward scanning
164 * 0x182 scansione avanti
166 outbits(9,0x2,3,port
);
167 outbits(16,RSF16_ENCODE(freq
),2,port
);
174 /* NOTE if mute this stop radio
175 you must set freq on unmute */
176 dev
->stereo
= fmr2_stereo_mode(port
);
180 /* !!! not tested, in my card this does't work !!! */
181 static int fmr2_setvolume(struct fmr2_device
*dev
)
183 int vol
[16] = { 0x021, 0x084, 0x090, 0x104,
184 0x110, 0x204, 0x210, 0x402,
185 0x404, 0x408, 0x410, 0x801,
186 0x802, 0x804, 0x808, 0x810 };
187 int i
, a
, port
= dev
->port
;
188 int n
= vol
[dev
->curvol
& 0x0f];
190 if (dev
->card_type
!= 11)
193 for (i
= 12; --i
>= 0; ) {
194 a
= ((n
>> i
) & 1) << 6; /* if (a=0) a= 0; else a= 0x40; */
197 outb(a
| 0x24, port
);
202 for (i
= 6; --i
>= 0; ) {
203 a
= ((0x18 >> i
) & 1) << 6;
206 outb(a
| 0x24, port
);
217 static int vidioc_querycap(struct file
*file
, void *priv
,
218 struct v4l2_capability
*v
)
220 strlcpy(v
->driver
, "radio-sf16fmr2", sizeof(v
->driver
));
221 strlcpy(v
->card
, "SF16-FMR2 radio", sizeof(v
->card
));
222 sprintf(v
->bus_info
, "ISA");
223 v
->version
= RADIO_VERSION
;
224 v
->capabilities
= V4L2_CAP_TUNER
;
228 static int vidioc_g_tuner(struct file
*file
, void *priv
,
229 struct v4l2_tuner
*v
)
232 struct video_device
*dev
= video_devdata(file
);
233 struct fmr2_device
*fmr2
= dev
->priv
;
238 strcpy(v
->name
, "FM");
239 v
->type
= V4L2_TUNER_RADIO
;
241 mult
= (fmr2
->flags
& V4L2_TUNER_CAP_LOW
) ? 1 : 1000;
242 v
->rangelow
= RSF16_MINFREQ
/mult
;
243 v
->rangehigh
= RSF16_MAXFREQ
/mult
;
244 v
->rxsubchans
= V4L2_TUNER_SUB_MONO
| V4L2_TUNER_MODE_STEREO
;
245 v
->capability
= fmr2
->flags
&V4L2_TUNER_CAP_LOW
;
246 v
->audmode
= fmr2
->stereo
? V4L2_TUNER_MODE_STEREO
:
247 V4L2_TUNER_MODE_MONO
;
249 v
->signal
= fmr2_getsigstr(fmr2
);
254 static int vidioc_s_tuner(struct file
*file
, void *priv
,
255 struct v4l2_tuner
*v
)
262 static int vidioc_s_frequency(struct file
*file
, void *priv
,
263 struct v4l2_frequency
*f
)
265 struct video_device
*dev
= video_devdata(file
);
266 struct fmr2_device
*fmr2
= dev
->priv
;
268 if (!(fmr2
->flags
& V4L2_TUNER_CAP_LOW
))
269 f
->frequency
*= 1000;
270 if (f
->frequency
< RSF16_MINFREQ
||
271 f
->frequency
> RSF16_MAXFREQ
)
273 /*rounding in steps of 200 to match th freq
275 fmr2
->curfreq
= (f
->frequency
/200)*200;
277 /* set card freq (if not muted) */
278 if (fmr2
->curvol
&& !fmr2
->mute
) {
286 static int vidioc_g_frequency(struct file
*file
, void *priv
,
287 struct v4l2_frequency
*f
)
289 struct video_device
*dev
= video_devdata(file
);
290 struct fmr2_device
*fmr2
= dev
->priv
;
292 f
->type
= V4L2_TUNER_RADIO
;
293 f
->frequency
= fmr2
->curfreq
;
294 if (!(fmr2
->flags
& V4L2_TUNER_CAP_LOW
))
295 f
->frequency
/= 1000;
299 static int vidioc_queryctrl(struct file
*file
, void *priv
,
300 struct v4l2_queryctrl
*qc
)
304 for (i
= 0; i
< ARRAY_SIZE(radio_qctrl
); i
++) {
305 if (qc
->id
&& qc
->id
== radio_qctrl
[i
].id
) {
306 memcpy(qc
, &radio_qctrl
[i
], sizeof(*qc
));
313 static int vidioc_g_ctrl(struct file
*file
, void *priv
,
314 struct v4l2_control
*ctrl
)
316 struct video_device
*dev
= video_devdata(file
);
317 struct fmr2_device
*fmr2
= dev
->priv
;
320 case V4L2_CID_AUDIO_MUTE
:
321 ctrl
->value
= fmr2
->mute
;
323 case V4L2_CID_AUDIO_VOLUME
:
324 ctrl
->value
= fmr2
->curvol
;
330 static int vidioc_s_ctrl(struct file
*file
, void *priv
,
331 struct v4l2_control
*ctrl
)
333 struct video_device
*dev
= video_devdata(file
);
334 struct fmr2_device
*fmr2
= dev
->priv
;
337 case V4L2_CID_AUDIO_MUTE
:
338 fmr2
->mute
= ctrl
->value
;
340 case V4L2_CID_AUDIO_VOLUME
:
341 if (ctrl
->value
> radio_qctrl
[AUD_VOL_INDEX
].maximum
)
342 fmr2
->curvol
= radio_qctrl
[AUD_VOL_INDEX
].maximum
;
344 fmr2
->curvol
= ctrl
->value
;
352 if (fmr2
->curvol
&& !fmr2
->mute
)
353 printk(KERN_DEBUG
"unmute\n");
355 printk(KERN_DEBUG
"mute\n");
359 if (fmr2
->curvol
&& !fmr2
->mute
) {
360 fmr2_setvolume(fmr2
);
361 /* Set frequency and unmute card */
364 fmr2_mute(fmr2
->port
);
369 static int vidioc_g_audio(struct file
*file
, void *priv
,
370 struct v4l2_audio
*a
)
375 strcpy(a
->name
, "Radio");
376 a
->capability
= V4L2_AUDCAP_STEREO
;
380 static int vidioc_g_input(struct file
*filp
, void *priv
, unsigned int *i
)
386 static int vidioc_s_input(struct file
*filp
, void *priv
, unsigned int i
)
393 static int vidioc_s_audio(struct file
*file
, void *priv
,
394 struct v4l2_audio
*a
)
401 static struct fmr2_device fmr2_unit
;
403 static const struct file_operations fmr2_fops
= {
404 .owner
= THIS_MODULE
,
405 .open
= video_exclusive_open
,
406 .release
= video_exclusive_release
,
407 .ioctl
= video_ioctl2
,
409 .compat_ioctl
= v4l_compat_ioctl32
,
414 static const struct v4l2_ioctl_ops fmr2_ioctl_ops
= {
415 .vidioc_querycap
= vidioc_querycap
,
416 .vidioc_g_tuner
= vidioc_g_tuner
,
417 .vidioc_s_tuner
= vidioc_s_tuner
,
418 .vidioc_g_audio
= vidioc_g_audio
,
419 .vidioc_s_audio
= vidioc_s_audio
,
420 .vidioc_g_input
= vidioc_g_input
,
421 .vidioc_s_input
= vidioc_s_input
,
422 .vidioc_g_frequency
= vidioc_g_frequency
,
423 .vidioc_s_frequency
= vidioc_s_frequency
,
424 .vidioc_queryctrl
= vidioc_queryctrl
,
425 .vidioc_g_ctrl
= vidioc_g_ctrl
,
426 .vidioc_s_ctrl
= vidioc_s_ctrl
,
429 static struct video_device fmr2_radio
= {
430 .name
= "SF16FMR2 radio",
432 .ioctl_ops
= &fmr2_ioctl_ops
,
435 static int __init
fmr2_init(void)
438 fmr2_unit
.curvol
= 0;
440 fmr2_unit
.curfreq
= 0;
441 fmr2_unit
.stereo
= 1;
442 fmr2_unit
.flags
= V4L2_TUNER_CAP_LOW
;
443 fmr2_unit
.card_type
= 0;
444 fmr2_radio
.priv
= &fmr2_unit
;
448 if (!request_region(io
, 2, "sf16fmr2")) {
449 printk(KERN_ERR
"radio-sf16fmr2: request_region failed!\n");
453 if (video_register_device(&fmr2_radio
, VFL_TYPE_RADIO
, radio_nr
) < 0) {
454 release_region(io
, 2);
458 printk(KERN_INFO
"SF16FMR2 radio card driver at 0x%x.\n", io
);
459 /* mute card - prevents noisy bootups */
462 fmr2_product_info(&fmr2_unit
);
464 debug_print((KERN_DEBUG
"card_type %d\n", fmr2_unit
.card_type
));
466 /* Only card_type == 11 implements volume */
467 if (fmr2_unit
.card_type
!= 11)
468 radio_qctrl
[AUD_VOL_INDEX
].maximum
= 1;
473 MODULE_AUTHOR("Ziglio Frediano, freddy77@angelfire.com");
474 MODULE_DESCRIPTION("A driver for the SF16FMR2 radio.");
475 MODULE_LICENSE("GPL");
477 module_param(io
, int, 0);
478 MODULE_PARM_DESC(io
, "I/O address of the SF16FMR2 card (should be 0x384, if do not work try 0x284)");
479 module_param(radio_nr
, int, 0);
481 static void __exit
fmr2_cleanup_module(void)
483 video_unregister_device(&fmr2_radio
);
484 release_region(io
,2);
487 module_init(fmr2_init
);
488 module_exit(fmr2_cleanup_module
);
492 static int __init
fmr2_setup_io(char *str
)
494 get_option(&str
, &io
);
498 __setup("sf16fmr2=", fmr2_setup_io
);