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/isapnp.h>
26 #include <linux/mutex.h>
27 #include <linux/videodev2.h> /* kernel radio structs */
28 #include <linux/io.h> /* outb, outb_p */
29 #include <media/v4l2-device.h>
30 #include <media/v4l2-ioctl.h>
32 MODULE_AUTHOR("Petr Vandrovec, vandrove@vc.cvut.cz and M. Kirkwood");
33 MODULE_DESCRIPTION("A driver for the SF16MI radio.");
34 MODULE_LICENSE("GPL");
37 static int radio_nr
= -1;
39 module_param(io
, int, 0);
40 MODULE_PARM_DESC(io
, "I/O address of the SF16MI card (0x284 or 0x384)");
41 module_param(radio_nr
, int, 0);
43 #define RADIO_VERSION KERNEL_VERSION(0, 0, 2)
47 struct v4l2_device v4l2_dev
;
48 struct video_device vdev
;
50 int curvol
; /* 1 or 0 */
51 unsigned long curfreq
; /* freq in kHz */
56 static struct fmi fmi_card
;
57 static struct pnp_dev
*dev
;
59 /* freq is in 1/16 kHz to internal number, hw precision is 50 kHz */
60 /* It is only useful to give freq in intervall of 800 (=0.05Mhz),
61 * other bits will be truncated, e.g 92.7400016 -> 92.7, but
64 #define RSF16_ENCODE(x) ((x) / 800 + 214)
65 #define RSF16_MINFREQ (87 * 16000)
66 #define RSF16_MAXFREQ (108 * 16000)
68 static void outbits(int bits
, unsigned int data
, int io
)
86 static inline void fmi_mute(struct fmi
*fmi
)
88 mutex_lock(&fmi
->lock
);
90 mutex_unlock(&fmi
->lock
);
93 static inline void fmi_unmute(struct fmi
*fmi
)
95 mutex_lock(&fmi
->lock
);
97 mutex_unlock(&fmi
->lock
);
100 static inline int fmi_setfreq(struct fmi
*fmi
, unsigned long freq
)
102 mutex_lock(&fmi
->lock
);
105 outbits(16, RSF16_ENCODE(freq
), fmi
->io
);
106 outbits(8, 0xC0, fmi
->io
);
107 msleep(143); /* was schedule_timeout(HZ/7) */
108 mutex_unlock(&fmi
->lock
);
114 static inline int fmi_getsigstr(struct fmi
*fmi
)
119 mutex_lock(&fmi
->lock
);
120 val
= fmi
->curvol
? 0x08 : 0x00; /* unmute/mute */
122 outb(val
| 0x10, fmi
->io
);
123 msleep(143); /* was schedule_timeout(HZ/7) */
124 res
= (int)inb(fmi
->io
+ 1);
127 mutex_unlock(&fmi
->lock
);
128 return (res
& 2) ? 0 : 0xFFFF;
131 static int vidioc_querycap(struct file
*file
, void *priv
,
132 struct v4l2_capability
*v
)
134 strlcpy(v
->driver
, "radio-sf16fmi", sizeof(v
->driver
));
135 strlcpy(v
->card
, "SF16-FMx radio", sizeof(v
->card
));
136 strlcpy(v
->bus_info
, "ISA", sizeof(v
->bus_info
));
137 v
->version
= RADIO_VERSION
;
138 v
->capabilities
= V4L2_CAP_TUNER
| V4L2_CAP_RADIO
;
142 static int vidioc_g_tuner(struct file
*file
, void *priv
,
143 struct v4l2_tuner
*v
)
146 struct fmi
*fmi
= video_drvdata(file
);
151 strlcpy(v
->name
, "FM", sizeof(v
->name
));
152 v
->type
= V4L2_TUNER_RADIO
;
153 mult
= (fmi
->flags
& V4L2_TUNER_CAP_LOW
) ? 1 : 1000;
154 v
->rangelow
= RSF16_MINFREQ
/ mult
;
155 v
->rangehigh
= RSF16_MAXFREQ
/ mult
;
156 v
->rxsubchans
= V4L2_TUNER_SUB_MONO
| V4L2_TUNER_SUB_STEREO
;
157 v
->capability
= fmi
->flags
& V4L2_TUNER_CAP_LOW
;
158 v
->audmode
= V4L2_TUNER_MODE_STEREO
;
159 v
->signal
= fmi_getsigstr(fmi
);
163 static int vidioc_s_tuner(struct file
*file
, void *priv
,
164 struct v4l2_tuner
*v
)
166 return v
->index
? -EINVAL
: 0;
169 static int vidioc_s_frequency(struct file
*file
, void *priv
,
170 struct v4l2_frequency
*f
)
172 struct fmi
*fmi
= video_drvdata(file
);
174 if (!(fmi
->flags
& V4L2_TUNER_CAP_LOW
))
175 f
->frequency
*= 1000;
176 if (f
->frequency
< RSF16_MINFREQ
||
177 f
->frequency
> RSF16_MAXFREQ
)
179 /* rounding in steps of 800 to match the freq
181 fmi_setfreq(fmi
, (f
->frequency
/ 800) * 800);
185 static int vidioc_g_frequency(struct file
*file
, void *priv
,
186 struct v4l2_frequency
*f
)
188 struct fmi
*fmi
= video_drvdata(file
);
190 f
->type
= V4L2_TUNER_RADIO
;
191 f
->frequency
= fmi
->curfreq
;
192 if (!(fmi
->flags
& V4L2_TUNER_CAP_LOW
))
193 f
->frequency
/= 1000;
197 static int vidioc_queryctrl(struct file
*file
, void *priv
,
198 struct v4l2_queryctrl
*qc
)
201 case V4L2_CID_AUDIO_MUTE
:
202 return v4l2_ctrl_query_fill(qc
, 0, 1, 1, 1);
207 static int vidioc_g_ctrl(struct file
*file
, void *priv
,
208 struct v4l2_control
*ctrl
)
210 struct fmi
*fmi
= video_drvdata(file
);
213 case V4L2_CID_AUDIO_MUTE
:
214 ctrl
->value
= fmi
->curvol
;
220 static int vidioc_s_ctrl(struct file
*file
, void *priv
,
221 struct v4l2_control
*ctrl
)
223 struct fmi
*fmi
= video_drvdata(file
);
226 case V4L2_CID_AUDIO_MUTE
:
231 fmi
->curvol
= ctrl
->value
;
237 static int vidioc_g_input(struct file
*filp
, void *priv
, unsigned int *i
)
243 static int vidioc_s_input(struct file
*filp
, void *priv
, unsigned int i
)
245 return i
? -EINVAL
: 0;
248 static int vidioc_g_audio(struct file
*file
, void *priv
,
249 struct v4l2_audio
*a
)
252 strlcpy(a
->name
, "Radio", sizeof(a
->name
));
253 a
->capability
= V4L2_AUDCAP_STEREO
;
257 static int vidioc_s_audio(struct file
*file
, void *priv
,
258 struct v4l2_audio
*a
)
260 return a
->index
? -EINVAL
: 0;
263 static const struct v4l2_file_operations fmi_fops
= {
264 .owner
= THIS_MODULE
,
265 .ioctl
= video_ioctl2
,
268 static const struct v4l2_ioctl_ops fmi_ioctl_ops
= {
269 .vidioc_querycap
= vidioc_querycap
,
270 .vidioc_g_tuner
= vidioc_g_tuner
,
271 .vidioc_s_tuner
= vidioc_s_tuner
,
272 .vidioc_g_audio
= vidioc_g_audio
,
273 .vidioc_s_audio
= vidioc_s_audio
,
274 .vidioc_g_input
= vidioc_g_input
,
275 .vidioc_s_input
= vidioc_s_input
,
276 .vidioc_g_frequency
= vidioc_g_frequency
,
277 .vidioc_s_frequency
= vidioc_s_frequency
,
278 .vidioc_queryctrl
= vidioc_queryctrl
,
279 .vidioc_g_ctrl
= vidioc_g_ctrl
,
280 .vidioc_s_ctrl
= vidioc_s_ctrl
,
283 /* ladis: this is my card. does any other types exist? */
284 static struct isapnp_device_id id_table
[] __devinitdata
= {
285 { ISAPNP_ANY_ID
, ISAPNP_ANY_ID
,
286 ISAPNP_VENDOR('M','F','R'), ISAPNP_FUNCTION(0xad10), 0},
287 { ISAPNP_CARD_END
, },
290 MODULE_DEVICE_TABLE(isapnp
, id_table
);
292 static int __init
isapnp_fmi_probe(void)
296 while (id_table
[i
].card_vendor
!= 0 && dev
== NULL
) {
297 dev
= pnp_find_dev(NULL
, id_table
[i
].vendor
,
298 id_table
[i
].function
, NULL
);
304 if (pnp_device_attach(dev
) < 0)
306 if (pnp_activate_dev(dev
) < 0) {
307 printk(KERN_ERR
"radio-sf16fmi: PnP configure failed (out of resources?)\n");
308 pnp_device_detach(dev
);
311 if (!pnp_port_valid(dev
, 0)) {
312 pnp_device_detach(dev
);
316 i
= pnp_port_start(dev
, 0);
317 printk(KERN_INFO
"radio-sf16fmi: PnP reports card at %#x\n", i
);
322 static int __init
fmi_init(void)
324 struct fmi
*fmi
= &fmi_card
;
325 struct v4l2_device
*v4l2_dev
= &fmi
->v4l2_dev
;
329 io
= isapnp_fmi_probe();
330 strlcpy(v4l2_dev
->name
, "sf16fmi", sizeof(v4l2_dev
->name
));
333 v4l2_err(v4l2_dev
, "No PnP card found.\n");
336 if (!request_region(io
, 2, "radio-sf16fmi")) {
337 v4l2_err(v4l2_dev
, "port 0x%x already in use\n", fmi
->io
);
338 pnp_device_detach(dev
);
342 res
= v4l2_device_register(NULL
, v4l2_dev
);
344 release_region(fmi
->io
, 2);
345 pnp_device_detach(dev
);
346 v4l2_err(v4l2_dev
, "Could not register v4l2_device\n");
350 fmi
->flags
= V4L2_TUNER_CAP_LOW
;
351 strlcpy(fmi
->vdev
.name
, v4l2_dev
->name
, sizeof(fmi
->vdev
.name
));
352 fmi
->vdev
.v4l2_dev
= v4l2_dev
;
353 fmi
->vdev
.fops
= &fmi_fops
;
354 fmi
->vdev
.ioctl_ops
= &fmi_ioctl_ops
;
355 fmi
->vdev
.release
= video_device_release_empty
;
356 video_set_drvdata(&fmi
->vdev
, fmi
);
358 mutex_init(&fmi
->lock
);
360 if (video_register_device(&fmi
->vdev
, VFL_TYPE_RADIO
, radio_nr
) < 0) {
361 v4l2_device_unregister(v4l2_dev
);
362 release_region(fmi
->io
, 2);
363 pnp_device_detach(dev
);
367 v4l2_info(v4l2_dev
, "card driver at 0x%x\n", fmi
->io
);
368 /* mute card - prevents noisy bootups */
373 static void __exit
fmi_exit(void)
375 struct fmi
*fmi
= &fmi_card
;
377 video_unregister_device(&fmi
->vdev
);
378 v4l2_device_unregister(&fmi
->v4l2_dev
);
379 release_region(fmi
->io
, 2);
381 pnp_device_detach(dev
);
384 module_init(fmi_init
);
385 module_exit(fmi_exit
);