]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* zoltrix radio plus driver for Linux radio support |
2 | * (c) 1998 C. van Schaik <carl@leg.uct.ac.za> | |
3 | * | |
4286c6f6 | 4 | * BUGS |
1da177e4 LT |
5 | * Due to the inconsistency in reading from the signal flags |
6 | * it is difficult to get an accurate tuned signal. | |
7 | * | |
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. | |
11 | * | |
12 | * Some code derived from code by Romolo Manfredini | |
13 | * romolo@bicnet.it | |
14 | * | |
15 | * 1999-05-06 - (C. van Schaik) | |
16 | * - Make signal strength and stereo scans | |
4286c6f6 | 17 | * kinder to cpu while in delay |
1da177e4 LT |
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 | |
2ab65299 MCC |
27 | * |
28 | * 2006-07-24 - Converted to V4L2 API | |
29 | * by Mauro Carvalho Chehab <mchehab@infradead.org> | |
1da177e4 LT |
30 | */ |
31 | ||
32 | #include <linux/module.h> /* Modules */ | |
33 | #include <linux/init.h> /* Initdata */ | |
fb911ee8 | 34 | #include <linux/ioport.h> /* request_region */ |
1da177e4 LT |
35 | #include <linux/delay.h> /* udelay, msleep */ |
36 | #include <asm/io.h> /* outb, outb_p */ | |
37 | #include <asm/uaccess.h> /* copy to/from user */ | |
2ab65299 | 38 | #include <linux/videodev2.h> /* kernel radio structs */ |
5e87efa3 | 39 | #include <media/v4l2-common.h> |
1da177e4 | 40 | |
2ab65299 MCC |
41 | #include <linux/version.h> /* for KERNEL_VERSION MACRO */ |
42 | #define RADIO_VERSION KERNEL_VERSION(0,0,2) | |
43 | ||
44 | static struct v4l2_queryctrl radio_qctrl[] = { | |
45 | { | |
46 | .id = V4L2_CID_AUDIO_MUTE, | |
47 | .name = "Mute", | |
48 | .minimum = 0, | |
49 | .maximum = 1, | |
50 | .default_value = 1, | |
51 | .type = V4L2_CTRL_TYPE_BOOLEAN, | |
52 | },{ | |
53 | .id = V4L2_CID_AUDIO_VOLUME, | |
54 | .name = "Volume", | |
55 | .minimum = 0, | |
56 | .maximum = 65535, | |
57 | .step = 4096, | |
58 | .default_value = 0xff, | |
59 | .type = V4L2_CTRL_TYPE_INTEGER, | |
60 | } | |
61 | }; | |
62 | ||
1da177e4 LT |
63 | #ifndef CONFIG_RADIO_ZOLTRIX_PORT |
64 | #define CONFIG_RADIO_ZOLTRIX_PORT -1 | |
65 | #endif | |
66 | ||
67 | static int io = CONFIG_RADIO_ZOLTRIX_PORT; | |
68 | static int radio_nr = -1; | |
69 | ||
70 | struct zol_device { | |
71 | int port; | |
72 | int curvol; | |
73 | unsigned long curfreq; | |
74 | int muted; | |
75 | unsigned int stereo; | |
3593cab5 | 76 | struct mutex lock; |
1da177e4 LT |
77 | }; |
78 | ||
79 | static int zol_setvol(struct zol_device *dev, int vol) | |
80 | { | |
81 | dev->curvol = vol; | |
82 | if (dev->muted) | |
83 | return 0; | |
84 | ||
3593cab5 | 85 | mutex_lock(&dev->lock); |
1da177e4 LT |
86 | if (vol == 0) { |
87 | outb(0, io); | |
88 | outb(0, io); | |
89 | inb(io + 3); /* Zoltrix needs to be read to confirm */ | |
3593cab5 | 90 | mutex_unlock(&dev->lock); |
1da177e4 LT |
91 | return 0; |
92 | } | |
93 | ||
94 | outb(dev->curvol-1, io); | |
95 | msleep(10); | |
96 | inb(io + 2); | |
3593cab5 | 97 | mutex_unlock(&dev->lock); |
1da177e4 LT |
98 | return 0; |
99 | } | |
100 | ||
101 | static void zol_mute(struct zol_device *dev) | |
102 | { | |
103 | dev->muted = 1; | |
3593cab5 | 104 | mutex_lock(&dev->lock); |
1da177e4 LT |
105 | outb(0, io); |
106 | outb(0, io); | |
107 | inb(io + 3); /* Zoltrix needs to be read to confirm */ | |
3593cab5 | 108 | mutex_unlock(&dev->lock); |
1da177e4 LT |
109 | } |
110 | ||
111 | static void zol_unmute(struct zol_device *dev) | |
112 | { | |
113 | dev->muted = 0; | |
114 | zol_setvol(dev, dev->curvol); | |
115 | } | |
116 | ||
117 | static int zol_setfreq(struct zol_device *dev, unsigned long freq) | |
118 | { | |
119 | /* tunes the radio to the desired frequency */ | |
120 | unsigned long long bitmask, f, m; | |
121 | unsigned int stereo = dev->stereo; | |
122 | int i; | |
123 | ||
124 | if (freq == 0) | |
125 | return 1; | |
126 | m = (freq / 160 - 8800) * 2; | |
127 | f = (unsigned long long) m + 0x4d1c; | |
128 | ||
129 | bitmask = 0xc480402c10080000ull; | |
130 | i = 45; | |
131 | ||
3593cab5 | 132 | mutex_lock(&dev->lock); |
4286c6f6 | 133 | |
1da177e4 LT |
134 | outb(0, io); |
135 | outb(0, io); | |
136 | inb(io + 3); /* Zoltrix needs to be read to confirm */ | |
137 | ||
138 | outb(0x40, io); | |
139 | outb(0xc0, io); | |
140 | ||
141 | bitmask = (bitmask ^ ((f & 0xff) << 47) ^ ((f & 0xff00) << 30) ^ ( stereo << 31)); | |
142 | while (i--) { | |
143 | if ((bitmask & 0x8000000000000000ull) != 0) { | |
144 | outb(0x80, io); | |
145 | udelay(50); | |
146 | outb(0x00, io); | |
147 | udelay(50); | |
148 | outb(0x80, io); | |
149 | udelay(50); | |
150 | } else { | |
151 | outb(0xc0, io); | |
152 | udelay(50); | |
153 | outb(0x40, io); | |
154 | udelay(50); | |
155 | outb(0xc0, io); | |
156 | udelay(50); | |
157 | } | |
158 | bitmask *= 2; | |
159 | } | |
160 | /* termination sequence */ | |
161 | outb(0x80, io); | |
162 | outb(0xc0, io); | |
163 | outb(0x40, io); | |
164 | udelay(1000); | |
165 | inb(io+2); | |
166 | ||
4286c6f6 MCC |
167 | udelay(1000); |
168 | ||
1da177e4 LT |
169 | if (dev->muted) |
170 | { | |
171 | outb(0, io); | |
172 | outb(0, io); | |
173 | inb(io + 3); | |
174 | udelay(1000); | |
175 | } | |
4286c6f6 | 176 | |
3593cab5 | 177 | mutex_unlock(&dev->lock); |
4286c6f6 | 178 | |
1da177e4 LT |
179 | if(!dev->muted) |
180 | { | |
4286c6f6 | 181 | zol_setvol(dev, dev->curvol); |
1da177e4 LT |
182 | } |
183 | return 0; | |
184 | } | |
185 | ||
186 | /* Get signal strength */ | |
187 | ||
188 | static int zol_getsigstr(struct zol_device *dev) | |
189 | { | |
190 | int a, b; | |
191 | ||
3593cab5 | 192 | mutex_lock(&dev->lock); |
1da177e4 LT |
193 | outb(0x00, io); /* This stuff I found to do nothing */ |
194 | outb(dev->curvol, io); | |
195 | msleep(20); | |
196 | ||
197 | a = inb(io); | |
198 | msleep(10); | |
199 | b = inb(io); | |
200 | ||
3593cab5 | 201 | mutex_unlock(&dev->lock); |
4286c6f6 | 202 | |
1da177e4 LT |
203 | if (a != b) |
204 | return (0); | |
205 | ||
4286c6f6 | 206 | if ((a == 0xcf) || (a == 0xdf) /* I found this out by playing */ |
1da177e4 LT |
207 | || (a == 0xef)) /* with a binary scanner on the card io */ |
208 | return (1); | |
4286c6f6 | 209 | return (0); |
1da177e4 LT |
210 | } |
211 | ||
212 | static int zol_is_stereo (struct zol_device *dev) | |
213 | { | |
214 | int x1, x2; | |
215 | ||
3593cab5 | 216 | mutex_lock(&dev->lock); |
4286c6f6 | 217 | |
1da177e4 LT |
218 | outb(0x00, io); |
219 | outb(dev->curvol, io); | |
220 | msleep(20); | |
221 | ||
222 | x1 = inb(io); | |
223 | msleep(10); | |
224 | x2 = inb(io); | |
225 | ||
3593cab5 | 226 | mutex_unlock(&dev->lock); |
4286c6f6 | 227 | |
1da177e4 LT |
228 | if ((x1 == x2) && (x1 == 0xcf)) |
229 | return 1; | |
230 | return 0; | |
231 | } | |
232 | ||
233 | static int zol_do_ioctl(struct inode *inode, struct file *file, | |
234 | unsigned int cmd, void *arg) | |
235 | { | |
236 | struct video_device *dev = video_devdata(file); | |
237 | struct zol_device *zol = dev->priv; | |
238 | ||
239 | switch (cmd) { | |
2ab65299 | 240 | case VIDIOC_QUERYCAP: |
1da177e4 | 241 | { |
2ab65299 | 242 | struct v4l2_capability *v = arg; |
1da177e4 | 243 | memset(v,0,sizeof(*v)); |
2ab65299 MCC |
244 | strlcpy(v->driver, "radio-zoltrix", sizeof (v->driver)); |
245 | strlcpy(v->card, "Zoltrix Radio", sizeof (v->card)); | |
246 | sprintf(v->bus_info,"ISA"); | |
247 | v->version = RADIO_VERSION; | |
248 | v->capabilities = V4L2_CAP_TUNER; | |
249 | ||
1da177e4 LT |
250 | return 0; |
251 | } | |
2ab65299 | 252 | case VIDIOC_G_TUNER: |
1da177e4 | 253 | { |
2ab65299 MCC |
254 | struct v4l2_tuner *v = arg; |
255 | ||
256 | if (v->index > 0) | |
1da177e4 | 257 | return -EINVAL; |
2ab65299 MCC |
258 | |
259 | memset(v,0,sizeof(*v)); | |
1da177e4 | 260 | strcpy(v->name, "FM"); |
2ab65299 MCC |
261 | v->type = V4L2_TUNER_RADIO; |
262 | ||
263 | v->rangelow=(88*16000); | |
264 | v->rangehigh=(108*16000); | |
265 | v->rxsubchans =V4L2_TUNER_SUB_MONO|V4L2_TUNER_SUB_STEREO; | |
266 | v->capability=V4L2_TUNER_CAP_LOW; | |
267 | if(zol_is_stereo(zol)) | |
268 | v->audmode = V4L2_TUNER_MODE_STEREO; | |
269 | else | |
270 | v->audmode = V4L2_TUNER_MODE_MONO; | |
271 | v->signal=0xFFFF*zol_getsigstr(zol); | |
272 | ||
1da177e4 LT |
273 | return 0; |
274 | } | |
2ab65299 | 275 | case VIDIOC_S_TUNER: |
1da177e4 | 276 | { |
2ab65299 MCC |
277 | struct v4l2_tuner *v = arg; |
278 | ||
279 | if (v->index > 0) | |
1da177e4 | 280 | return -EINVAL; |
2ab65299 | 281 | |
1da177e4 LT |
282 | return 0; |
283 | } | |
2ab65299 | 284 | case VIDIOC_S_FREQUENCY: |
1da177e4 | 285 | { |
2ab65299 MCC |
286 | struct v4l2_frequency *f = arg; |
287 | ||
288 | zol->curfreq = f->frequency; | |
289 | zol_setfreq(zol, zol->curfreq); | |
1da177e4 LT |
290 | return 0; |
291 | } | |
2ab65299 | 292 | case VIDIOC_G_FREQUENCY: |
1da177e4 | 293 | { |
2ab65299 | 294 | struct v4l2_frequency *f = arg; |
1da177e4 | 295 | |
2ab65299 MCC |
296 | f->type = V4L2_TUNER_RADIO; |
297 | f->frequency = zol->curfreq; | |
1da177e4 | 298 | |
2ab65299 MCC |
299 | return 0; |
300 | } | |
301 | case VIDIOC_QUERYCTRL: | |
302 | { | |
303 | struct v4l2_queryctrl *qc = arg; | |
304 | int i; | |
305 | ||
306 | for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) { | |
307 | if (qc->id && qc->id == radio_qctrl[i].id) { | |
308 | memcpy(qc, &(radio_qctrl[i]), | |
309 | sizeof(*qc)); | |
310 | return (0); | |
311 | } | |
312 | } | |
313 | return -EINVAL; | |
314 | } | |
315 | case VIDIOC_G_CTRL: | |
316 | { | |
317 | struct v4l2_control *ctrl= arg; | |
318 | ||
319 | switch (ctrl->id) { | |
320 | case V4L2_CID_AUDIO_MUTE: | |
321 | ctrl->value=zol->muted; | |
322 | return (0); | |
323 | case V4L2_CID_AUDIO_VOLUME: | |
324 | ctrl->value=zol->curvol * 4096; | |
325 | return (0); | |
326 | } | |
327 | return -EINVAL; | |
328 | } | |
329 | case VIDIOC_S_CTRL: | |
330 | { | |
331 | struct v4l2_control *ctrl= arg; | |
332 | ||
333 | switch (ctrl->id) { | |
334 | case V4L2_CID_AUDIO_MUTE: | |
335 | if (ctrl->value) { | |
336 | zol_mute(zol); | |
337 | } else { | |
338 | zol_unmute(zol); | |
339 | zol_setvol(zol,zol->curvol); | |
340 | } | |
341 | return (0); | |
342 | case V4L2_CID_AUDIO_VOLUME: | |
343 | zol_setvol(zol,ctrl->value/4096); | |
344 | return (0); | |
345 | } | |
346 | zol->stereo = 1; | |
347 | zol_setfreq(zol, zol->curfreq); | |
348 | #if 0 | |
349 | /* FIXME: Implement stereo/mono switch on V4L2 */ | |
1da177e4 LT |
350 | if (v->mode & VIDEO_SOUND_STEREO) { |
351 | zol->stereo = 1; | |
352 | zol_setfreq(zol, zol->curfreq); | |
353 | } | |
354 | if (v->mode & VIDEO_SOUND_MONO) { | |
355 | zol->stereo = 0; | |
356 | zol_setfreq(zol, zol->curfreq); | |
357 | } | |
2ab65299 MCC |
358 | #endif |
359 | return -EINVAL; | |
1da177e4 | 360 | } |
2ab65299 MCC |
361 | |
362 | default: | |
363 | return v4l_compat_translate_ioctl(inode,file,cmd,arg, | |
364 | zol_do_ioctl); | |
1da177e4 LT |
365 | } |
366 | } | |
367 | ||
368 | static int zol_ioctl(struct inode *inode, struct file *file, | |
369 | unsigned int cmd, unsigned long arg) | |
370 | { | |
371 | return video_usercopy(inode, file, cmd, arg, zol_do_ioctl); | |
372 | } | |
373 | ||
374 | static struct zol_device zoltrix_unit; | |
375 | ||
fa027c2a | 376 | static const struct file_operations zoltrix_fops = |
1da177e4 LT |
377 | { |
378 | .owner = THIS_MODULE, | |
379 | .open = video_exclusive_open, | |
380 | .release = video_exclusive_release, | |
381 | .ioctl = zol_ioctl, | |
0d0fbf81 | 382 | .compat_ioctl = v4l_compat_ioctl32, |
1da177e4 LT |
383 | .llseek = no_llseek, |
384 | }; | |
385 | ||
386 | static struct video_device zoltrix_radio = | |
387 | { | |
388 | .owner = THIS_MODULE, | |
389 | .name = "Zoltrix Radio Plus", | |
390 | .type = VID_TYPE_TUNER, | |
2ab65299 | 391 | .hardware = 0, |
1da177e4 LT |
392 | .fops = &zoltrix_fops, |
393 | }; | |
394 | ||
395 | static int __init zoltrix_init(void) | |
396 | { | |
397 | if (io == -1) { | |
398 | printk(KERN_ERR "You must set an I/O address with io=0x???\n"); | |
399 | return -EINVAL; | |
400 | } | |
401 | if ((io != 0x20c) && (io != 0x30c)) { | |
402 | printk(KERN_ERR "zoltrix: invalid port, try 0x20c or 0x30c\n"); | |
403 | return -ENXIO; | |
404 | } | |
405 | ||
406 | zoltrix_radio.priv = &zoltrix_unit; | |
407 | if (!request_region(io, 2, "zoltrix")) { | |
408 | printk(KERN_ERR "zoltrix: port 0x%x already in use\n", io); | |
409 | return -EBUSY; | |
410 | } | |
411 | ||
412 | if (video_register_device(&zoltrix_radio, VFL_TYPE_RADIO, radio_nr) == -1) | |
413 | { | |
414 | release_region(io, 2); | |
415 | return -EINVAL; | |
416 | } | |
417 | printk(KERN_INFO "Zoltrix Radio Plus card driver.\n"); | |
418 | ||
3593cab5 | 419 | mutex_init(&zoltrix_unit.lock); |
4286c6f6 | 420 | |
1da177e4 LT |
421 | /* mute card - prevents noisy bootups */ |
422 | ||
423 | /* this ensures that the volume is all the way down */ | |
424 | ||
425 | outb(0, io); | |
426 | outb(0, io); | |
427 | msleep(20); | |
428 | inb(io + 3); | |
429 | ||
430 | zoltrix_unit.curvol = 0; | |
431 | zoltrix_unit.stereo = 1; | |
432 | ||
433 | return 0; | |
434 | } | |
435 | ||
436 | MODULE_AUTHOR("C.van Schaik"); | |
437 | MODULE_DESCRIPTION("A driver for the Zoltrix Radio Plus."); | |
438 | MODULE_LICENSE("GPL"); | |
439 | ||
440 | module_param(io, int, 0); | |
441 | MODULE_PARM_DESC(io, "I/O address of the Zoltrix Radio Plus (0x20c or 0x30c)"); | |
442 | module_param(radio_nr, int, 0); | |
443 | ||
444 | static void __exit zoltrix_cleanup_module(void) | |
445 | { | |
446 | video_unregister_device(&zoltrix_radio); | |
447 | release_region(io, 2); | |
448 | } | |
449 | ||
450 | module_init(zoltrix_init); | |
451 | module_exit(zoltrix_cleanup_module); | |
452 |