1 /* SF16FMI radio driver for Linux radio support
2 * heavily based on rtrack driver...
4 * (c) 1998 Petr Vandrovec, vandrove@vc.cvut.cz
6 * Fitted to new interface by Alan Cox <alan@lxorguk.ukuu.org.uk>
7 * Made working and cleaned up functions <mikael.hedin@irf.se>
8 * Support for ISAPnP by Ladislav Michl <ladis@psi.cz>
10 * Notes on the hardware
12 * Frequency control is done digitally -- ie out(port,encodefreq(95.8));
13 * No volume control - only mute/unmute - you have to use line volume
14 * control on SB-part of SF16FMI
16 * Converted to V4L2 API by Mauro Carvalho Chehab <mchehab@infradead.org>
19 #include <linux/version.h>
20 #include <linux/kernel.h> /* __setup */
21 #include <linux/module.h> /* Modules */
22 #include <linux/init.h> /* Initdata */
23 #include <linux/ioport.h> /* request_region */
24 #include <linux/delay.h> /* udelay */
25 #include <linux/videodev2.h> /* kernel radio structs */
26 #include <media/v4l2-common.h>
27 #include <media/v4l2-ioctl.h>
28 #include <linux/isapnp.h>
29 #include <asm/io.h> /* outb, outb_p */
30 #include <asm/uaccess.h> /* copy to/from user */
31 #include <linux/mutex.h>
33 #define RADIO_VERSION KERNEL_VERSION(0,0,2)
35 static struct v4l2_queryctrl radio_qctrl
[] = {
37 .id
= V4L2_CID_AUDIO_MUTE
,
42 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
50 int curvol
; /* 1 or 0 */
51 unsigned long curfreq
; /* freq in kHz */
56 static int radio_nr
= -1;
57 static struct pnp_dev
*dev
= NULL
;
58 static struct mutex lock
;
60 /* freq is in 1/16 kHz to internal number, hw precision is 50 kHz */
61 /* It is only useful to give freq in intervall of 800 (=0.05Mhz),
62 * other bits will be truncated, e.g 92.7400016 -> 92.7, but
65 #define RSF16_ENCODE(x) ((x)/800+214)
66 #define RSF16_MINFREQ 87*16000
67 #define RSF16_MAXFREQ 108*16000
69 static void outbits(int bits
, unsigned int data
, int port
)
87 static inline void fmi_mute(int port
)
94 static inline void fmi_unmute(int port
)
101 static inline int fmi_setfreq(struct fmi_device
*dev
)
103 int myport
= dev
->port
;
104 unsigned long freq
= dev
->curfreq
;
108 outbits(16, RSF16_ENCODE(freq
), myport
);
109 outbits(8, 0xC0, myport
);
110 msleep(143); /* was schedule_timeout(HZ/7) */
112 if (dev
->curvol
) fmi_unmute(myport
);
116 static inline int fmi_getsigstr(struct fmi_device
*dev
)
120 int myport
= dev
->port
;
124 val
= dev
->curvol
? 0x08 : 0x00; /* unmute/mute */
126 outb(val
| 0x10, myport
);
127 msleep(143); /* was schedule_timeout(HZ/7) */
128 res
= (int)inb(myport
+1);
132 return (res
& 2) ? 0 : 0xFFFF;
135 static int vidioc_querycap(struct file
*file
, void *priv
,
136 struct v4l2_capability
*v
)
138 strlcpy(v
->driver
, "radio-sf16fmi", sizeof(v
->driver
));
139 strlcpy(v
->card
, "SF16-FMx radio", sizeof(v
->card
));
140 sprintf(v
->bus_info
, "ISA");
141 v
->version
= RADIO_VERSION
;
142 v
->capabilities
= V4L2_CAP_TUNER
;
146 static int vidioc_g_tuner(struct file
*file
, void *priv
,
147 struct v4l2_tuner
*v
)
150 struct fmi_device
*fmi
= video_drvdata(file
);
155 strcpy(v
->name
, "FM");
156 v
->type
= V4L2_TUNER_RADIO
;
157 mult
= (fmi
->flags
& V4L2_TUNER_CAP_LOW
) ? 1 : 1000;
158 v
->rangelow
= RSF16_MINFREQ
/mult
;
159 v
->rangehigh
= RSF16_MAXFREQ
/mult
;
160 v
->rxsubchans
= V4L2_TUNER_SUB_MONO
| V4L2_TUNER_MODE_STEREO
;
161 v
->capability
= fmi
->flags
&V4L2_TUNER_CAP_LOW
;
162 v
->audmode
= V4L2_TUNER_MODE_STEREO
;
163 v
->signal
= fmi_getsigstr(fmi
);
167 static int vidioc_s_tuner(struct file
*file
, void *priv
,
168 struct v4l2_tuner
*v
)
175 static int vidioc_s_frequency(struct file
*file
, void *priv
,
176 struct v4l2_frequency
*f
)
178 struct fmi_device
*fmi
= video_drvdata(file
);
180 if (!(fmi
->flags
& V4L2_TUNER_CAP_LOW
))
181 f
->frequency
*= 1000;
182 if (f
->frequency
< RSF16_MINFREQ
||
183 f
->frequency
> RSF16_MAXFREQ
)
185 /*rounding in steps of 800 to match th freq
187 fmi
->curfreq
= (f
->frequency
/800)*800;
192 static int vidioc_g_frequency(struct file
*file
, void *priv
,
193 struct v4l2_frequency
*f
)
195 struct fmi_device
*fmi
= video_drvdata(file
);
197 f
->type
= V4L2_TUNER_RADIO
;
198 f
->frequency
= fmi
->curfreq
;
199 if (!(fmi
->flags
& V4L2_TUNER_CAP_LOW
))
200 f
->frequency
/= 1000;
204 static int vidioc_queryctrl(struct file
*file
, void *priv
,
205 struct v4l2_queryctrl
*qc
)
209 for (i
= 0; i
< ARRAY_SIZE(radio_qctrl
); i
++) {
210 if (qc
->id
&& qc
->id
== radio_qctrl
[i
].id
) {
211 memcpy(qc
, &(radio_qctrl
[i
]),
219 static int vidioc_g_ctrl(struct file
*file
, void *priv
,
220 struct v4l2_control
*ctrl
)
222 struct fmi_device
*fmi
= video_drvdata(file
);
225 case V4L2_CID_AUDIO_MUTE
:
226 ctrl
->value
= fmi
->curvol
;
232 static int vidioc_s_ctrl(struct file
*file
, void *priv
,
233 struct v4l2_control
*ctrl
)
235 struct fmi_device
*fmi
= video_drvdata(file
);
238 case V4L2_CID_AUDIO_MUTE
:
242 fmi_unmute(fmi
->port
);
243 fmi
->curvol
= ctrl
->value
;
249 static int vidioc_g_audio(struct file
*file
, void *priv
,
250 struct v4l2_audio
*a
)
255 strcpy(a
->name
, "Radio");
256 a
->capability
= V4L2_AUDCAP_STEREO
;
260 static int vidioc_g_input(struct file
*filp
, void *priv
, unsigned int *i
)
266 static int vidioc_s_input(struct file
*filp
, void *priv
, unsigned int i
)
273 static int vidioc_s_audio(struct file
*file
, void *priv
,
274 struct v4l2_audio
*a
)
281 static struct fmi_device fmi_unit
;
283 static int fmi_exclusive_open(struct file
*file
)
285 return test_and_set_bit(0, &fmi_unit
.in_use
) ? -EBUSY
: 0;
288 static int fmi_exclusive_release(struct file
*file
)
290 clear_bit(0, &fmi_unit
.in_use
);
294 static const struct v4l2_file_operations fmi_fops
= {
295 .owner
= THIS_MODULE
,
296 .open
= fmi_exclusive_open
,
297 .release
= fmi_exclusive_release
,
298 .ioctl
= video_ioctl2
,
301 static const struct v4l2_ioctl_ops fmi_ioctl_ops
= {
302 .vidioc_querycap
= vidioc_querycap
,
303 .vidioc_g_tuner
= vidioc_g_tuner
,
304 .vidioc_s_tuner
= vidioc_s_tuner
,
305 .vidioc_g_audio
= vidioc_g_audio
,
306 .vidioc_s_audio
= vidioc_s_audio
,
307 .vidioc_g_input
= vidioc_g_input
,
308 .vidioc_s_input
= vidioc_s_input
,
309 .vidioc_g_frequency
= vidioc_g_frequency
,
310 .vidioc_s_frequency
= vidioc_s_frequency
,
311 .vidioc_queryctrl
= vidioc_queryctrl
,
312 .vidioc_g_ctrl
= vidioc_g_ctrl
,
313 .vidioc_s_ctrl
= vidioc_s_ctrl
,
316 static struct video_device fmi_radio
= {
317 .name
= "SF16FMx radio",
319 .ioctl_ops
= &fmi_ioctl_ops
,
320 .release
= video_device_release_empty
,
323 /* ladis: this is my card. does any other types exist? */
324 static struct isapnp_device_id id_table
[] __devinitdata
= {
325 { ISAPNP_ANY_ID
, ISAPNP_ANY_ID
,
326 ISAPNP_VENDOR('M','F','R'), ISAPNP_FUNCTION(0xad10), 0},
327 { ISAPNP_CARD_END
, },
330 MODULE_DEVICE_TABLE(isapnp
, id_table
);
332 static int __init
isapnp_fmi_probe(void)
336 while (id_table
[i
].card_vendor
!= 0 && dev
== NULL
) {
337 dev
= pnp_find_dev(NULL
, id_table
[i
].vendor
,
338 id_table
[i
].function
, NULL
);
344 if (pnp_device_attach(dev
) < 0)
346 if (pnp_activate_dev(dev
) < 0) {
347 printk ("radio-sf16fmi: PnP configure failed (out of resources?)\n");
348 pnp_device_detach(dev
);
351 if (!pnp_port_valid(dev
, 0)) {
352 pnp_device_detach(dev
);
356 i
= pnp_port_start(dev
, 0);
357 printk ("radio-sf16fmi: PnP reports card at %#x\n", i
);
362 static int __init
fmi_init(void)
365 io
= isapnp_fmi_probe();
367 printk(KERN_ERR
"radio-sf16fmi: No PnP card found.\n");
370 if (!request_region(io
, 2, "radio-sf16fmi")) {
371 printk(KERN_ERR
"radio-sf16fmi: port 0x%x already in use\n", io
);
372 pnp_device_detach(dev
);
378 fmi_unit
.curfreq
= 0;
379 fmi_unit
.flags
= V4L2_TUNER_CAP_LOW
;
380 video_set_drvdata(&fmi_radio
, &fmi_unit
);
384 if (video_register_device(&fmi_radio
, VFL_TYPE_RADIO
, radio_nr
) < 0) {
385 release_region(io
, 2);
389 printk(KERN_INFO
"SF16FMx radio card driver at 0x%x\n", io
);
390 /* mute card - prevents noisy bootups */
395 MODULE_AUTHOR("Petr Vandrovec, vandrove@vc.cvut.cz and M. Kirkwood");
396 MODULE_DESCRIPTION("A driver for the SF16MI radio.");
397 MODULE_LICENSE("GPL");
399 module_param(io
, int, 0);
400 MODULE_PARM_DESC(io
, "I/O address of the SF16MI card (0x284 or 0x384)");
401 module_param(radio_nr
, int, 0);
403 static void __exit
fmi_cleanup_module(void)
405 video_unregister_device(&fmi_radio
);
406 release_region(io
, 2);
408 pnp_device_detach(dev
);
411 module_init(fmi_init
);
412 module_exit(fmi_cleanup_module
);