V4L/DVB (3318b): sem2mutex: drivers/media/, #2
[linux-2.6.git] / drivers / media / radio / radio-sf16fmi.c
1 /* SF16FMI radio driver for Linux radio support
2  * heavily based on rtrack driver...
3  * (c) 1997 M. Kirkwood
4  * (c) 1998 Petr Vandrovec, vandrove@vc.cvut.cz
5  *
6  * Fitted to new interface by Alan Cox <alan.cox@linux.org>
7  * Made working and cleaned up functions <mikael.hedin@irf.se>
8  * Support for ISAPnP by Ladislav Michl <ladis@psi.cz>
9  *
10  * Notes on the hardware
11  *
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
15  *  
16  */
17
18 #include <linux/kernel.h>       /* __setup                      */
19 #include <linux/module.h>       /* Modules                      */
20 #include <linux/init.h>         /* Initdata                     */
21 #include <linux/ioport.h>       /* request_region               */
22 #include <linux/delay.h>        /* udelay                       */
23 #include <linux/videodev.h>     /* kernel radio structs         */
24 #include <linux/isapnp.h>
25 #include <asm/io.h>             /* outb, outb_p                 */
26 #include <asm/uaccess.h>        /* copy to/from user            */
27 #include <linux/mutex.h>
28
29 struct fmi_device
30 {
31         int port;
32         int curvol; /* 1 or 0 */
33         unsigned long curfreq; /* freq in kHz */
34         __u32 flags;
35 };
36
37 static int io = -1; 
38 static int radio_nr = -1;
39 static struct pnp_dev *dev = NULL;
40 static struct mutex lock;
41
42 /* freq is in 1/16 kHz to internal number, hw precision is 50 kHz */
43 /* It is only useful to give freq in intervall of 800 (=0.05Mhz),
44  * other bits will be truncated, e.g 92.7400016 -> 92.7, but 
45  * 92.7400017 -> 92.75
46  */
47 #define RSF16_ENCODE(x) ((x)/800+214)
48 #define RSF16_MINFREQ 87*16000
49 #define RSF16_MAXFREQ 108*16000
50
51 static void outbits(int bits, unsigned int data, int port)
52 {
53         while(bits--) {
54                 if(data & 1) {
55                         outb(5, port);
56                         udelay(6);
57                         outb(7, port);
58                         udelay(6);
59                 } else {
60                         outb(1, port);
61                         udelay(6);
62                         outb(3, port);
63                         udelay(6);
64                 }
65                 data>>=1;
66         }
67 }
68
69 static inline void fmi_mute(int port)
70 {
71         mutex_lock(&lock);
72         outb(0x00, port);
73         mutex_unlock(&lock);
74 }
75
76 static inline void fmi_unmute(int port)
77 {
78         mutex_lock(&lock);
79         outb(0x08, port);
80         mutex_unlock(&lock);
81 }
82
83 static inline int fmi_setfreq(struct fmi_device *dev)
84 {
85         int myport = dev->port;
86         unsigned long freq = dev->curfreq;
87
88         mutex_lock(&lock);
89
90         outbits(16, RSF16_ENCODE(freq), myport);
91         outbits(8, 0xC0, myport);
92         msleep(143);            /* was schedule_timeout(HZ/7) */
93         mutex_unlock(&lock);
94         if (dev->curvol) fmi_unmute(myport);
95         return 0;
96 }
97
98 static inline int fmi_getsigstr(struct fmi_device *dev)
99 {
100         int val;
101         int res;
102         int myport = dev->port;
103
104         
105         mutex_lock(&lock);
106         val = dev->curvol ? 0x08 : 0x00;        /* unmute/mute */
107         outb(val, myport);
108         outb(val | 0x10, myport);
109         msleep(143);            /* was schedule_timeout(HZ/7) */
110         res = (int)inb(myport+1);
111         outb(val, myport);
112         
113         mutex_unlock(&lock);
114         return (res & 2) ? 0 : 0xFFFF;
115 }
116
117 static int fmi_do_ioctl(struct inode *inode, struct file *file,
118                         unsigned int cmd, void *arg)
119 {
120         struct video_device *dev = video_devdata(file);
121         struct fmi_device *fmi=dev->priv;
122         
123         switch(cmd)
124         {
125                 case VIDIOCGCAP:
126                 {
127                         struct video_capability *v = arg;
128                         memset(v,0,sizeof(*v));
129                         strcpy(v->name, "SF16-FMx radio");
130                         v->type=VID_TYPE_TUNER;
131                         v->channels=1;
132                         v->audios=1;
133                         return 0;
134                 }
135                 case VIDIOCGTUNER:
136                 {
137                         struct video_tuner *v = arg;
138                         int mult;
139
140                         if(v->tuner)    /* Only 1 tuner */
141                                 return -EINVAL;
142                         strcpy(v->name, "FM");
143                         mult = (fmi->flags & VIDEO_TUNER_LOW) ? 1 : 1000;
144                         v->rangelow = RSF16_MINFREQ/mult;
145                         v->rangehigh = RSF16_MAXFREQ/mult;
146                         v->flags=fmi->flags;
147                         v->mode=VIDEO_MODE_AUTO;
148                         v->signal = fmi_getsigstr(fmi);
149                         return 0;
150                 }
151                 case VIDIOCSTUNER:
152                 {
153                         struct video_tuner *v = arg;
154                         if(v->tuner!=0)
155                                 return -EINVAL;
156                         fmi->flags = v->flags & VIDEO_TUNER_LOW;
157                         /* Only 1 tuner so no setting needed ! */
158                         return 0;
159                 }
160                 case VIDIOCGFREQ:
161                 {
162                         unsigned long *freq = arg;
163                         *freq = fmi->curfreq;
164                         if (!(fmi->flags & VIDEO_TUNER_LOW))
165                             *freq /= 1000;
166                         return 0;
167                 }
168                 case VIDIOCSFREQ:
169                 {
170                         unsigned long *freq = arg;
171                         if (!(fmi->flags & VIDEO_TUNER_LOW))
172                                 *freq *= 1000;
173                         if (*freq < RSF16_MINFREQ || *freq > RSF16_MAXFREQ )
174                                 return -EINVAL;
175                         /*rounding in steps of 800 to match th freq
176                           that will be used */
177                         fmi->curfreq = (*freq/800)*800; 
178                         fmi_setfreq(fmi);
179                         return 0;
180                 }
181                 case VIDIOCGAUDIO:
182                 {       
183                         struct video_audio *v = arg;
184                         memset(v,0,sizeof(*v));
185                         v->flags=( (!fmi->curvol)*VIDEO_AUDIO_MUTE | VIDEO_AUDIO_MUTABLE);
186                         strcpy(v->name, "Radio");
187                         v->mode=VIDEO_SOUND_STEREO;
188                         return 0;                       
189                 }
190                 case VIDIOCSAUDIO:
191                 {
192                         struct video_audio *v = arg;
193                         if(v->audio)
194                                 return -EINVAL;
195                         fmi->curvol= v->flags&VIDEO_AUDIO_MUTE ? 0 : 1;
196                         fmi->curvol ? 
197                                 fmi_unmute(fmi->port) : fmi_mute(fmi->port);
198                         return 0;
199                 }
200                 case VIDIOCGUNIT:
201                 {
202                         struct video_unit *v = arg;
203                         v->video=VIDEO_NO_UNIT;
204                         v->vbi=VIDEO_NO_UNIT;
205                         v->radio=dev->minor;
206                         v->audio=0; /* How do we find out this??? */
207                         v->teletext=VIDEO_NO_UNIT;
208                         return 0;                       
209                 }
210                 default:
211                         return -ENOIOCTLCMD;
212         }
213 }
214
215 static int fmi_ioctl(struct inode *inode, struct file *file,
216                      unsigned int cmd, unsigned long arg)
217 {
218         return video_usercopy(inode, file, cmd, arg, fmi_do_ioctl);
219 }
220
221 static struct fmi_device fmi_unit;
222
223 static struct file_operations fmi_fops = {
224         .owner          = THIS_MODULE,
225         .open           = video_exclusive_open,
226         .release        = video_exclusive_release,
227         .ioctl          = fmi_ioctl,
228         .compat_ioctl   = v4l_compat_ioctl32,
229         .llseek         = no_llseek,
230 };
231
232 static struct video_device fmi_radio=
233 {
234         .owner          = THIS_MODULE,
235         .name           = "SF16FMx radio",
236         .type           = VID_TYPE_TUNER,
237         .hardware       = VID_HARDWARE_SF16MI,
238         .fops           = &fmi_fops,
239 };
240
241 /* ladis: this is my card. does any other types exist? */
242 static struct isapnp_device_id id_table[] __devinitdata = {
243         {       ISAPNP_ANY_ID, ISAPNP_ANY_ID,
244                 ISAPNP_VENDOR('M','F','R'), ISAPNP_FUNCTION(0xad10), 0},
245         {       ISAPNP_CARD_END, },
246 };
247
248 MODULE_DEVICE_TABLE(isapnp, id_table);
249
250 static int isapnp_fmi_probe(void)
251 {
252         int i = 0;
253
254         while (id_table[i].card_vendor != 0 && dev == NULL) {
255                 dev = pnp_find_dev(NULL, id_table[i].vendor,
256                                    id_table[i].function, NULL);
257                 i++;
258         }
259
260         if (!dev)
261                 return -ENODEV;
262         if (pnp_device_attach(dev) < 0)
263                 return -EAGAIN;
264         if (pnp_activate_dev(dev) < 0) {
265                 printk ("radio-sf16fmi: PnP configure failed (out of resources?)\n");
266                 pnp_device_detach(dev);
267                 return -ENOMEM;
268         }
269         if (!pnp_port_valid(dev, 0)) {
270                 pnp_device_detach(dev);
271                 return -ENODEV;
272         }
273
274         i = pnp_port_start(dev, 0);
275         printk ("radio-sf16fmi: PnP reports card at %#x\n", i);
276
277         return i;
278 }
279
280 static int __init fmi_init(void)
281 {
282         if (io < 0)
283                 io = isapnp_fmi_probe();
284         if (io < 0) {
285                 printk(KERN_ERR "radio-sf16fmi: No PnP card found.\n");
286                 return io;
287         }
288         if (!request_region(io, 2, "radio-sf16fmi")) {
289                 printk(KERN_ERR "radio-sf16fmi: port 0x%x already in use\n", io);
290                 return -EBUSY;
291         }
292
293         fmi_unit.port = io;
294         fmi_unit.curvol = 0;
295         fmi_unit.curfreq = 0;
296         fmi_unit.flags = VIDEO_TUNER_LOW;
297         fmi_radio.priv = &fmi_unit;
298         
299         mutex_init(&lock);
300         
301         if (video_register_device(&fmi_radio, VFL_TYPE_RADIO, radio_nr) == -1) {
302                 release_region(io, 2);
303                 return -EINVAL;
304         }
305                 
306         printk(KERN_INFO "SF16FMx radio card driver at 0x%x\n", io);
307         /* mute card - prevents noisy bootups */
308         fmi_mute(io);
309         return 0;
310 }
311
312 MODULE_AUTHOR("Petr Vandrovec, vandrove@vc.cvut.cz and M. Kirkwood");
313 MODULE_DESCRIPTION("A driver for the SF16MI radio.");
314 MODULE_LICENSE("GPL");
315
316 module_param(io, int, 0);
317 MODULE_PARM_DESC(io, "I/O address of the SF16MI card (0x284 or 0x384)");
318 module_param(radio_nr, int, 0);
319
320 static void __exit fmi_cleanup_module(void)
321 {
322         video_unregister_device(&fmi_radio);
323         release_region(io, 2);
324         if (dev)
325                 pnp_device_detach(dev);
326 }
327
328 module_init(fmi_init);
329 module_exit(fmi_cleanup_module);