]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* radio-cadet.c - A video4linux driver for the ADS Cadet AM/FM Radio Card |
2 | * | |
3 | * by Fred Gleason <fredg@wava.com> | |
4 | * Version 0.3.3 | |
5 | * | |
6 | * (Loosely) based on code for the Aztech radio card by | |
7 | * | |
8 | * Russell Kroll (rkroll@exploits.org) | |
9 | * Quay Ly | |
10 | * Donald Song | |
4286c6f6 | 11 | * Jason Lewis (jlewis@twilight.vtc.vsc.edu) |
1da177e4 LT |
12 | * Scott McGrath (smcgrath@twilight.vtc.vsc.edu) |
13 | * William McGrath (wmcgrath@twilight.vtc.vsc.edu) | |
14 | * | |
15 | * History: | |
16 | * 2000-04-29 Russell Kroll <rkroll@exploits.org> | |
17 | * Added ISAPnP detection for Linux 2.3/2.4 | |
18 | * | |
19 | * 2001-01-10 Russell Kroll <rkroll@exploits.org> | |
20 | * Removed dead CONFIG_RADIO_CADET_PORT code | |
21 | * PnP detection on load is now default (no args necessary) | |
22 | * | |
23 | * 2002-01-17 Adam Belay <ambx1@neo.rr.com> | |
24 | * Updated to latest pnp code | |
25 | * | |
26 | * 2003-01-31 Alan Cox <alan@redhat.com> | |
27 | * Cleaned up locking, delay code, general odds and ends | |
c0c7fa09 HK |
28 | * |
29 | * 2006-07-30 Hans J. Koch <koch@hjk-az.de> | |
30 | * Changed API to V4L2 | |
1da177e4 LT |
31 | */ |
32 | ||
d591b9cc | 33 | #include <linux/version.h> |
1da177e4 LT |
34 | #include <linux/module.h> /* Modules */ |
35 | #include <linux/init.h> /* Initdata */ | |
fb911ee8 | 36 | #include <linux/ioport.h> /* request_region */ |
1da177e4 LT |
37 | #include <linux/delay.h> /* udelay */ |
38 | #include <asm/io.h> /* outb, outb_p */ | |
39 | #include <asm/uaccess.h> /* copy to/from user */ | |
c0c7fa09 | 40 | #include <linux/videodev2.h> /* V4L2 API defs */ |
5e87efa3 | 41 | #include <media/v4l2-common.h> |
1da177e4 LT |
42 | #include <linux/param.h> |
43 | #include <linux/pnp.h> | |
44 | ||
45 | #define RDS_BUFFER 256 | |
c0c7fa09 HK |
46 | #define RDS_RX_FLAG 1 |
47 | #define MBS_RX_FLAG 2 | |
48 | ||
49 | #define CADET_VERSION KERNEL_VERSION(0,3,3) | |
1da177e4 LT |
50 | |
51 | static int io=-1; /* default to isapnp activation */ | |
52 | static int radio_nr = -1; | |
53 | static int users=0; | |
54 | static int curtuner=0; | |
55 | static int tunestat=0; | |
56 | static int sigstrength=0; | |
57 | static wait_queue_head_t read_queue; | |
58 | static struct timer_list readtimer; | |
59 | static __u8 rdsin=0,rdsout=0,rdsstat=0; | |
60 | static unsigned char rdsbuf[RDS_BUFFER]; | |
61 | static spinlock_t cadet_io_lock; | |
62 | ||
63 | static int cadet_probe(void); | |
64 | ||
65 | /* | |
66 | * Signal Strength Threshold Values | |
4286c6f6 | 67 | * The V4L API spec does not define any particular unit for the signal |
1da177e4 LT |
68 | * strength value. These values are in microvolts of RF at the tuner's input. |
69 | */ | |
70 | static __u16 sigtable[2][4]={{5,10,30,150},{28,40,63,1000}}; | |
71 | ||
1da177e4 | 72 | |
c0c7fa09 HK |
73 | static int |
74 | cadet_getstereo(void) | |
1da177e4 | 75 | { |
c0c7fa09 | 76 | int ret = V4L2_TUNER_SUB_MONO; |
4286c6f6 | 77 | if(curtuner != 0) /* Only FM has stereo capability! */ |
c0c7fa09 | 78 | return V4L2_TUNER_SUB_MONO; |
1da177e4 LT |
79 | |
80 | spin_lock(&cadet_io_lock); | |
4286c6f6 | 81 | outb(7,io); /* Select tuner control */ |
1da177e4 | 82 | if( (inb(io+1) & 0x40) == 0) |
c0c7fa09 | 83 | ret = V4L2_TUNER_SUB_STEREO; |
4286c6f6 MCC |
84 | spin_unlock(&cadet_io_lock); |
85 | return ret; | |
1da177e4 LT |
86 | } |
87 | ||
c0c7fa09 HK |
88 | static unsigned |
89 | cadet_gettune(void) | |
1da177e4 | 90 | { |
4286c6f6 | 91 | int curvol,i; |
1da177e4 LT |
92 | unsigned fifo=0; |
93 | ||
4286c6f6 MCC |
94 | /* |
95 | * Prepare for read | |
96 | */ | |
1da177e4 LT |
97 | |
98 | spin_lock(&cadet_io_lock); | |
4286c6f6 MCC |
99 | |
100 | outb(7,io); /* Select tuner control */ | |
101 | curvol=inb(io+1); /* Save current volume/mute setting */ | |
102 | outb(0x00,io+1); /* Ensure WRITE-ENABLE is LOW */ | |
1da177e4 LT |
103 | tunestat=0xffff; |
104 | ||
4286c6f6 MCC |
105 | /* |
106 | * Read the shift register | |
107 | */ | |
108 | for(i=0;i<25;i++) { | |
109 | fifo=(fifo<<1)|((inb(io+1)>>7)&0x01); | |
110 | if(i<24) { | |
111 | outb(0x01,io+1); | |
1da177e4 | 112 | tunestat&=inb(io+1); |
4286c6f6 MCC |
113 | outb(0x00,io+1); |
114 | } | |
115 | } | |
116 | ||
117 | /* | |
118 | * Restore volume/mute setting | |
119 | */ | |
120 | outb(curvol,io+1); | |
1da177e4 LT |
121 | spin_unlock(&cadet_io_lock); |
122 | ||
123 | return fifo; | |
124 | } | |
125 | ||
c0c7fa09 HK |
126 | static unsigned |
127 | cadet_getfreq(void) | |
1da177e4 | 128 | { |
4286c6f6 MCC |
129 | int i; |
130 | unsigned freq=0,test,fifo=0; | |
1da177e4 LT |
131 | |
132 | /* | |
133 | * Read current tuning | |
134 | */ | |
135 | fifo=cadet_gettune(); | |
136 | ||
4286c6f6 MCC |
137 | /* |
138 | * Convert to actual frequency | |
139 | */ | |
1da177e4 | 140 | if(curtuner==0) { /* FM */ |
4286c6f6 MCC |
141 | test=12500; |
142 | for(i=0;i<14;i++) { | |
143 | if((fifo&0x01)!=0) { | |
144 | freq+=test; | |
145 | } | |
146 | test=test<<1; | |
147 | fifo=fifo>>1; | |
148 | } | |
149 | freq-=10700000; /* IF frequency is 10.7 MHz */ | |
150 | freq=(freq*16)/1000000; /* Make it 1/16 MHz */ | |
1da177e4 LT |
151 | } |
152 | if(curtuner==1) { /* AM */ | |
4286c6f6 | 153 | freq=((fifo&0x7fff)-2010)*16; |
1da177e4 LT |
154 | } |
155 | ||
4286c6f6 | 156 | return freq; |
1da177e4 LT |
157 | } |
158 | ||
c0c7fa09 HK |
159 | static void |
160 | cadet_settune(unsigned fifo) | |
1da177e4 | 161 | { |
4286c6f6 MCC |
162 | int i; |
163 | unsigned test; | |
1da177e4 LT |
164 | |
165 | spin_lock(&cadet_io_lock); | |
4286c6f6 | 166 | |
1da177e4 LT |
167 | outb(7,io); /* Select tuner control */ |
168 | /* | |
169 | * Write the shift register | |
170 | */ | |
171 | test=0; | |
172 | test=(fifo>>23)&0x02; /* Align data for SDO */ | |
173 | test|=0x1c; /* SDM=1, SWE=1, SEN=1, SCK=0 */ | |
174 | outb(7,io); /* Select tuner control */ | |
175 | outb(test,io+1); /* Initialize for write */ | |
176 | for(i=0;i<25;i++) { | |
4286c6f6 | 177 | test|=0x01; /* Toggle SCK High */ |
1da177e4 LT |
178 | outb(test,io+1); |
179 | test&=0xfe; /* Toggle SCK Low */ | |
180 | outb(test,io+1); | |
181 | fifo=fifo<<1; /* Prepare the next bit */ | |
182 | test=0x1c|((fifo>>23)&0x02); | |
183 | outb(test,io+1); | |
184 | } | |
185 | spin_unlock(&cadet_io_lock); | |
186 | } | |
187 | ||
c0c7fa09 HK |
188 | static void |
189 | cadet_setfreq(unsigned freq) | |
1da177e4 | 190 | { |
4286c6f6 MCC |
191 | unsigned fifo; |
192 | int i,j,test; | |
193 | int curvol; | |
1da177e4 | 194 | |
4286c6f6 MCC |
195 | /* |
196 | * Formulate a fifo command | |
197 | */ | |
1da177e4 LT |
198 | fifo=0; |
199 | if(curtuner==0) { /* FM */ | |
4286c6f6 MCC |
200 | test=102400; |
201 | freq=(freq*1000)/16; /* Make it kHz */ | |
202 | freq+=10700; /* IF is 10700 kHz */ | |
203 | for(i=0;i<14;i++) { | |
204 | fifo=fifo<<1; | |
205 | if(freq>=test) { | |
206 | fifo|=0x01; | |
207 | freq-=test; | |
208 | } | |
209 | test=test>>1; | |
210 | } | |
1da177e4 LT |
211 | } |
212 | if(curtuner==1) { /* AM */ | |
4286c6f6 | 213 | fifo=(freq/16)+2010; /* Make it kHz */ |
1da177e4 LT |
214 | fifo|=0x100000; /* Select AM Band */ |
215 | } | |
216 | ||
4286c6f6 MCC |
217 | /* |
218 | * Save current volume/mute setting | |
219 | */ | |
1da177e4 LT |
220 | |
221 | spin_lock(&cadet_io_lock); | |
222 | outb(7,io); /* Select tuner control */ | |
4286c6f6 MCC |
223 | curvol=inb(io+1); |
224 | spin_unlock(&cadet_io_lock); | |
1da177e4 LT |
225 | |
226 | /* | |
227 | * Tune the card | |
228 | */ | |
229 | for(j=3;j>-1;j--) { | |
4286c6f6 MCC |
230 | cadet_settune(fifo|(j<<16)); |
231 | ||
232 | spin_lock(&cadet_io_lock); | |
1da177e4 LT |
233 | outb(7,io); /* Select tuner control */ |
234 | outb(curvol,io+1); | |
235 | spin_unlock(&cadet_io_lock); | |
4286c6f6 | 236 | |
1da177e4 LT |
237 | msleep(100); |
238 | ||
239 | cadet_gettune(); | |
240 | if((tunestat & 0x40) == 0) { /* Tuned */ | |
4286c6f6 | 241 | sigstrength=sigtable[curtuner][j]; |
1da177e4 LT |
242 | return; |
243 | } | |
244 | } | |
245 | sigstrength=0; | |
246 | } | |
247 | ||
248 | ||
c0c7fa09 HK |
249 | static int |
250 | cadet_getvol(void) | |
1da177e4 LT |
251 | { |
252 | int ret = 0; | |
4286c6f6 | 253 | |
1da177e4 | 254 | spin_lock(&cadet_io_lock); |
4286c6f6 MCC |
255 | |
256 | outb(7,io); /* Select tuner control */ | |
257 | if((inb(io + 1) & 0x20) != 0) | |
258 | ret = 0xffff; | |
259 | ||
260 | spin_unlock(&cadet_io_lock); | |
261 | return ret; | |
1da177e4 LT |
262 | } |
263 | ||
264 | ||
c0c7fa09 HK |
265 | static void |
266 | cadet_setvol(int vol) | |
1da177e4 LT |
267 | { |
268 | spin_lock(&cadet_io_lock); | |
4286c6f6 MCC |
269 | outb(7,io); /* Select tuner control */ |
270 | if(vol>0) | |
271 | outb(0x20,io+1); | |
272 | else | |
273 | outb(0x00,io+1); | |
1da177e4 | 274 | spin_unlock(&cadet_io_lock); |
4286c6f6 | 275 | } |
1da177e4 | 276 | |
c0c7fa09 HK |
277 | static void |
278 | cadet_handler(unsigned long data) | |
1da177e4 LT |
279 | { |
280 | /* | |
281 | * Service the RDS fifo | |
282 | */ | |
283 | ||
284 | if(spin_trylock(&cadet_io_lock)) | |
285 | { | |
4286c6f6 | 286 | outb(0x3,io); /* Select RDS Decoder Control */ |
1da177e4 | 287 | if((inb(io+1)&0x20)!=0) { |
4286c6f6 | 288 | printk(KERN_CRIT "cadet: RDS fifo overflow\n"); |
1da177e4 LT |
289 | } |
290 | outb(0x80,io); /* Select RDS fifo */ | |
291 | while((inb(io)&0x80)!=0) { | |
4286c6f6 | 292 | rdsbuf[rdsin]=inb(io+1); |
1da177e4 | 293 | if(rdsin==rdsout) |
4286c6f6 | 294 | printk(KERN_WARNING "cadet: RDS buffer overflow\n"); |
1da177e4 LT |
295 | else |
296 | rdsin++; | |
297 | } | |
298 | spin_unlock(&cadet_io_lock); | |
299 | } | |
300 | ||
301 | /* | |
302 | * Service pending read | |
303 | */ | |
304 | if( rdsin!=rdsout) | |
4286c6f6 | 305 | wake_up_interruptible(&read_queue); |
1da177e4 | 306 | |
4286c6f6 | 307 | /* |
1da177e4 LT |
308 | * Clean up and exit |
309 | */ | |
310 | init_timer(&readtimer); | |
311 | readtimer.function=cadet_handler; | |
312 | readtimer.data=(unsigned long)0; | |
313 | readtimer.expires=jiffies+(HZ/20); | |
314 | add_timer(&readtimer); | |
315 | } | |
316 | ||
317 | ||
318 | ||
c0c7fa09 HK |
319 | static ssize_t |
320 | cadet_read(struct file *file, char __user *data, size_t count, loff_t *ppos) | |
1da177e4 | 321 | { |
4286c6f6 | 322 | int i=0; |
1da177e4 LT |
323 | unsigned char readbuf[RDS_BUFFER]; |
324 | ||
4286c6f6 | 325 | if(rdsstat==0) { |
1da177e4 | 326 | spin_lock(&cadet_io_lock); |
4286c6f6 | 327 | rdsstat=1; |
1da177e4 LT |
328 | outb(0x80,io); /* Select RDS fifo */ |
329 | spin_unlock(&cadet_io_lock); | |
330 | init_timer(&readtimer); | |
331 | readtimer.function=cadet_handler; | |
332 | readtimer.data=(unsigned long)0; | |
333 | readtimer.expires=jiffies+(HZ/20); | |
334 | add_timer(&readtimer); | |
335 | } | |
336 | if(rdsin==rdsout) { | |
4286c6f6 MCC |
337 | if (file->f_flags & O_NONBLOCK) |
338 | return -EWOULDBLOCK; | |
339 | interruptible_sleep_on(&read_queue); | |
340 | } | |
1da177e4 | 341 | while( i<count && rdsin!=rdsout) |
4286c6f6 | 342 | readbuf[i++]=rdsbuf[rdsout++]; |
1da177e4 LT |
343 | |
344 | if (copy_to_user(data,readbuf,i)) | |
4286c6f6 | 345 | return -EFAULT; |
1da177e4 LT |
346 | return i; |
347 | } | |
348 | ||
349 | ||
350 | ||
351 | static int cadet_do_ioctl(struct inode *inode, struct file *file, | |
352 | unsigned int cmd, void *arg) | |
353 | { | |
354 | switch(cmd) | |
355 | { | |
c0c7fa09 | 356 | case VIDIOC_QUERYCAP: |
1da177e4 | 357 | { |
c0c7fa09 HK |
358 | struct v4l2_capability *cap = arg; |
359 | memset(cap,0,sizeof(*cap)); | |
360 | cap->capabilities = | |
361 | V4L2_CAP_TUNER | | |
362 | V4L2_CAP_READWRITE; | |
363 | cap->version = CADET_VERSION; | |
364 | strcpy(cap->driver, "ADS Cadet"); | |
365 | strcpy(cap->card, "ADS Cadet"); | |
1da177e4 LT |
366 | return 0; |
367 | } | |
c0c7fa09 | 368 | case VIDIOC_G_TUNER: |
1da177e4 | 369 | { |
c0c7fa09 HK |
370 | struct v4l2_tuner *t = arg; |
371 | memset(t,0,sizeof(*t)); | |
372 | t->type = V4L2_TUNER_RADIO; | |
373 | switch (t->index) | |
374 | { | |
375 | case 0: strcpy(t->name, "FM"); | |
376 | t->capability = V4L2_TUNER_CAP_STEREO; | |
377 | t->rangelow = 1400; /* 87.5 MHz */ | |
378 | t->rangehigh = 1728; /* 108.0 MHz */ | |
379 | t->rxsubchans=cadet_getstereo(); | |
380 | switch (t->rxsubchans){ | |
381 | case V4L2_TUNER_SUB_MONO: | |
382 | t->audmode = V4L2_TUNER_MODE_MONO; | |
383 | break; | |
384 | case V4L2_TUNER_SUB_STEREO: | |
385 | t->audmode = V4L2_TUNER_MODE_STEREO; | |
386 | break; | |
387 | default: ; | |
388 | } | |
389 | break; | |
390 | case 1: strcpy(t->name, "AM"); | |
391 | t->capability = V4L2_TUNER_CAP_LOW; | |
392 | t->rangelow = 8320; /* 520 kHz */ | |
393 | t->rangehigh = 26400; /* 1650 kHz */ | |
394 | t->rxsubchans = V4L2_TUNER_SUB_MONO; | |
395 | t->audmode = V4L2_TUNER_MODE_MONO; | |
396 | break; | |
397 | default: | |
398 | return -EINVAL; | |
1da177e4 | 399 | } |
c0c7fa09 HK |
400 | |
401 | t->signal = sigstrength; /* We might need to modify scaling of this */ | |
1da177e4 LT |
402 | return 0; |
403 | } | |
c0c7fa09 | 404 | case VIDIOC_S_TUNER: |
1da177e4 | 405 | { |
c0c7fa09 HK |
406 | struct v4l2_tuner *t = arg; |
407 | if((t->index != 0)&&(t->index != 1)) | |
1da177e4 | 408 | return -EINVAL; |
c0c7fa09 HK |
409 | |
410 | curtuner = t->index; | |
1da177e4 LT |
411 | return 0; |
412 | } | |
c0c7fa09 | 413 | case VIDIOC_G_FREQUENCY: |
1da177e4 | 414 | { |
c0c7fa09 HK |
415 | struct v4l2_frequency *f = arg; |
416 | memset(f,0,sizeof(*f)); | |
417 | f->tuner = curtuner; | |
418 | f->type = V4L2_TUNER_RADIO; | |
419 | f->frequency = cadet_getfreq(); | |
1da177e4 LT |
420 | return 0; |
421 | } | |
c0c7fa09 | 422 | case VIDIOC_S_FREQUENCY: |
1da177e4 | 423 | { |
c0c7fa09 HK |
424 | struct v4l2_frequency *f = arg; |
425 | if (f->type != V4L2_TUNER_RADIO){ | |
426 | return -EINVAL; | |
427 | } | |
428 | if((curtuner==0)&&((f->frequency<1400)||(f->frequency>1728))) { | |
4286c6f6 | 429 | return -EINVAL; |
1da177e4 | 430 | } |
c0c7fa09 | 431 | if((curtuner==1)&&((f->frequency<8320)||(f->frequency>26400))) { |
4286c6f6 | 432 | return -EINVAL; |
1da177e4 | 433 | } |
c0c7fa09 | 434 | cadet_setfreq(f->frequency); |
1da177e4 LT |
435 | return 0; |
436 | } | |
c0c7fa09 | 437 | case VIDIOC_G_CTRL: |
4286c6f6 | 438 | { |
c0c7fa09 HK |
439 | struct v4l2_control *c = arg; |
440 | switch (c->id){ | |
441 | case V4L2_CID_AUDIO_MUTE: /* TODO: Handle this correctly */ | |
442 | c->value = (cadet_getvol() == 0); | |
443 | break; | |
444 | case V4L2_CID_AUDIO_VOLUME: | |
445 | c->value = cadet_getvol(); | |
446 | break; | |
447 | default: | |
448 | return -EINVAL; | |
1da177e4 | 449 | } |
4286c6f6 | 450 | return 0; |
1da177e4 | 451 | } |
c0c7fa09 | 452 | case VIDIOC_S_CTRL: |
1da177e4 | 453 | { |
c0c7fa09 HK |
454 | struct v4l2_control *c = arg; |
455 | switch (c->id){ | |
456 | case V4L2_CID_AUDIO_MUTE: /* TODO: Handle this correctly */ | |
457 | if (c->value) cadet_setvol(0); | |
458 | else cadet_setvol(0xffff); | |
459 | break; | |
460 | case V4L2_CID_AUDIO_VOLUME: | |
461 | cadet_setvol(c->value); | |
462 | break; | |
463 | default: | |
464 | return -EINVAL; | |
465 | } | |
1da177e4 LT |
466 | return 0; |
467 | } | |
c0c7fa09 | 468 | |
1da177e4 LT |
469 | default: |
470 | return -ENOIOCTLCMD; | |
471 | } | |
472 | } | |
473 | ||
c0c7fa09 HK |
474 | static int |
475 | cadet_ioctl(struct inode *inode, struct file *file, | |
1da177e4 LT |
476 | unsigned int cmd, unsigned long arg) |
477 | { | |
478 | return video_usercopy(inode, file, cmd, arg, cadet_do_ioctl); | |
479 | } | |
480 | ||
c0c7fa09 HK |
481 | static int |
482 | cadet_open(struct inode *inode, struct file *file) | |
1da177e4 | 483 | { |
1da177e4 | 484 | users++; |
c0c7fa09 | 485 | if (1 == users) init_waitqueue_head(&read_queue); |
1da177e4 LT |
486 | return 0; |
487 | } | |
488 | ||
c0c7fa09 HK |
489 | static int |
490 | cadet_release(struct inode *inode, struct file *file) | |
1da177e4 | 491 | { |
1da177e4 | 492 | users--; |
c0c7fa09 HK |
493 | if (0 == users){ |
494 | del_timer_sync(&readtimer); | |
495 | rdsstat=0; | |
496 | } | |
497 | return 0; | |
498 | } | |
499 | ||
500 | static unsigned int | |
501 | cadet_poll(struct file *file, struct poll_table_struct *wait) | |
502 | { | |
503 | poll_wait(file,&read_queue,wait); | |
504 | if(rdsin != rdsout) | |
505 | return POLLIN | POLLRDNORM; | |
1da177e4 LT |
506 | return 0; |
507 | } | |
508 | ||
509 | ||
fa027c2a | 510 | static const struct file_operations cadet_fops = { |
1da177e4 LT |
511 | .owner = THIS_MODULE, |
512 | .open = cadet_open, | |
513 | .release = cadet_release, | |
514 | .read = cadet_read, | |
515 | .ioctl = cadet_ioctl, | |
c0c7fa09 | 516 | .poll = cadet_poll, |
0d0fbf81 | 517 | .compat_ioctl = v4l_compat_ioctl32, |
1da177e4 LT |
518 | .llseek = no_llseek, |
519 | }; | |
520 | ||
521 | static struct video_device cadet_radio= | |
522 | { | |
523 | .owner = THIS_MODULE, | |
524 | .name = "Cadet radio", | |
525 | .type = VID_TYPE_TUNER, | |
1da177e4 LT |
526 | .fops = &cadet_fops, |
527 | }; | |
528 | ||
529 | static struct pnp_device_id cadet_pnp_devices[] = { | |
530 | /* ADS Cadet AM/FM Radio Card */ | |
531 | {.id = "MSM0c24", .driver_data = 0}, | |
532 | {.id = ""} | |
533 | }; | |
534 | ||
535 | MODULE_DEVICE_TABLE(pnp, cadet_pnp_devices); | |
536 | ||
537 | static int cadet_pnp_probe(struct pnp_dev * dev, const struct pnp_device_id *dev_id) | |
538 | { | |
539 | if (!dev) | |
540 | return -ENODEV; | |
541 | /* only support one device */ | |
542 | if (io > 0) | |
543 | return -EBUSY; | |
544 | ||
545 | if (!pnp_port_valid(dev, 0)) { | |
546 | return -ENODEV; | |
547 | } | |
548 | ||
549 | io = pnp_port_start(dev, 0); | |
550 | ||
551 | printk ("radio-cadet: PnP reports device at %#x\n", io); | |
552 | ||
553 | return io; | |
554 | } | |
555 | ||
556 | static struct pnp_driver cadet_pnp_driver = { | |
557 | .name = "radio-cadet", | |
558 | .id_table = cadet_pnp_devices, | |
559 | .probe = cadet_pnp_probe, | |
560 | .remove = NULL, | |
561 | }; | |
562 | ||
563 | static int cadet_probe(void) | |
564 | { | |
4286c6f6 | 565 | static int iovals[8]={0x330,0x332,0x334,0x336,0x338,0x33a,0x33c,0x33e}; |
1da177e4 LT |
566 | int i; |
567 | ||
568 | for(i=0;i<8;i++) { | |
4286c6f6 | 569 | io=iovals[i]; |
f1ac046d | 570 | if (request_region(io, 2, "cadet-probe")) { |
4286c6f6 | 571 | cadet_setfreq(1410); |
1da177e4 LT |
572 | if(cadet_getfreq()==1410) { |
573 | release_region(io, 2); | |
4286c6f6 | 574 | return io; |
1da177e4 LT |
575 | } |
576 | release_region(io, 2); | |
577 | } | |
578 | } | |
579 | return -1; | |
580 | } | |
581 | ||
4286c6f6 | 582 | /* |
1da177e4 LT |
583 | * io should only be set if the user has used something like |
584 | * isapnp (the userspace program) to initialize this card for us | |
585 | */ | |
586 | ||
587 | static int __init cadet_init(void) | |
588 | { | |
589 | spin_lock_init(&cadet_io_lock); | |
4286c6f6 | 590 | |
1da177e4 LT |
591 | /* |
592 | * If a probe was requested then probe ISAPnP first (safest) | |
593 | */ | |
594 | if (io < 0) | |
595 | pnp_register_driver(&cadet_pnp_driver); | |
596 | /* | |
597 | * If that fails then probe unsafely if probe is requested | |
598 | */ | |
599 | if(io < 0) | |
600 | io = cadet_probe (); | |
601 | ||
602 | /* | |
603 | * Else we bail out | |
604 | */ | |
4286c6f6 MCC |
605 | |
606 | if(io < 0) { | |
607 | #ifdef MODULE | |
1da177e4 LT |
608 | printk(KERN_ERR "You must set an I/O address with io=0x???\n"); |
609 | #endif | |
4286c6f6 | 610 | goto fail; |
1da177e4 LT |
611 | } |
612 | if (!request_region(io,2,"cadet")) | |
613 | goto fail; | |
614 | if(video_register_device(&cadet_radio,VFL_TYPE_RADIO,radio_nr)==-1) { | |
615 | release_region(io,2); | |
616 | goto fail; | |
617 | } | |
618 | printk(KERN_INFO "ADS Cadet Radio Card at 0x%x\n",io); | |
619 | return 0; | |
620 | fail: | |
621 | pnp_unregister_driver(&cadet_pnp_driver); | |
622 | return -1; | |
623 | } | |
624 | ||
625 | ||
626 | ||
627 | MODULE_AUTHOR("Fred Gleason, Russell Kroll, Quay Lu, Donald Song, Jason Lewis, Scott McGrath, William McGrath"); | |
628 | MODULE_DESCRIPTION("A driver for the ADS Cadet AM/FM/RDS radio card."); | |
629 | MODULE_LICENSE("GPL"); | |
630 | ||
631 | module_param(io, int, 0); | |
632 | MODULE_PARM_DESC(io, "I/O address of Cadet card (0x330,0x332,0x334,0x336,0x338,0x33a,0x33c,0x33e)"); | |
633 | module_param(radio_nr, int, 0); | |
634 | ||
635 | static void __exit cadet_cleanup_module(void) | |
636 | { | |
637 | video_unregister_device(&cadet_radio); | |
638 | release_region(io,2); | |
639 | pnp_unregister_driver(&cadet_pnp_driver); | |
640 | } | |
641 | ||
642 | module_init(cadet_init); | |
643 | module_exit(cadet_cleanup_module); | |
644 |