iwlwifi: refactor init geos function
[linux-2.6/openmoko-kernel/knife-kernel.git] / drivers / media / radio / radio-rtrack2.c
blob82aedfc95d4f3883b0e487402a53d21631baf494
1 /* RadioTrack II driver for Linux radio support (C) 1998 Ben Pfaff
3 * Based on RadioTrack I/RadioReveal (C) 1997 M. Kirkwood
4 * Converted to new API by Alan Cox <Alan.Cox@linux.org>
5 * Various bugfixes and enhancements by Russell Kroll <rkroll@exploits.org>
7 * TODO: Allow for more than one of these foolish entities :-)
9 * Converted to V4L2 API by Mauro Carvalho Chehab <mchehab@infradead.org>
12 #include <linux/module.h> /* Modules */
13 #include <linux/init.h> /* Initdata */
14 #include <linux/ioport.h> /* request_region */
15 #include <linux/delay.h> /* udelay */
16 #include <asm/io.h> /* outb, outb_p */
17 #include <asm/uaccess.h> /* copy to/from user */
18 #include <linux/videodev2.h> /* kernel radio structs */
19 #include <media/v4l2-common.h>
20 #include <linux/spinlock.h>
22 #include <linux/version.h> /* for KERNEL_VERSION MACRO */
23 #define RADIO_VERSION KERNEL_VERSION(0,0,2)
25 static struct v4l2_queryctrl radio_qctrl[] = {
27 .id = V4L2_CID_AUDIO_MUTE,
28 .name = "Mute",
29 .minimum = 0,
30 .maximum = 1,
31 .default_value = 1,
32 .type = V4L2_CTRL_TYPE_BOOLEAN,
33 },{
34 .id = V4L2_CID_AUDIO_VOLUME,
35 .name = "Volume",
36 .minimum = 0,
37 .maximum = 65535,
38 .step = 65535,
39 .default_value = 0xff,
40 .type = V4L2_CTRL_TYPE_INTEGER,
44 #ifndef CONFIG_RADIO_RTRACK2_PORT
45 #define CONFIG_RADIO_RTRACK2_PORT -1
46 #endif
48 static int io = CONFIG_RADIO_RTRACK2_PORT;
49 static int radio_nr = -1;
50 static spinlock_t lock;
52 struct rt_device
54 int port;
55 unsigned long curfreq;
56 int muted;
60 /* local things */
62 static void rt_mute(struct rt_device *dev)
64 if(dev->muted)
65 return;
66 spin_lock(&lock);
67 outb(1, io);
68 spin_unlock(&lock);
69 dev->muted = 1;
72 static void rt_unmute(struct rt_device *dev)
74 if(dev->muted == 0)
75 return;
76 spin_lock(&lock);
77 outb(0, io);
78 spin_unlock(&lock);
79 dev->muted = 0;
82 static void zero(void)
84 outb_p(1, io);
85 outb_p(3, io);
86 outb_p(1, io);
89 static void one(void)
91 outb_p(5, io);
92 outb_p(7, io);
93 outb_p(5, io);
96 static int rt_setfreq(struct rt_device *dev, unsigned long freq)
98 int i;
100 freq = freq / 200 + 856;
102 spin_lock(&lock);
104 outb_p(0xc8, io);
105 outb_p(0xc9, io);
106 outb_p(0xc9, io);
108 for (i = 0; i < 10; i++)
109 zero ();
111 for (i = 14; i >= 0; i--)
112 if (freq & (1 << i))
113 one ();
114 else
115 zero ();
117 outb_p(0xc8, io);
118 if (!dev->muted)
119 outb_p(0, io);
121 spin_unlock(&lock);
122 return 0;
125 static int vidioc_querycap(struct file *file, void *priv,
126 struct v4l2_capability *v)
128 strlcpy(v->driver, "radio-rtrack2", sizeof(v->driver));
129 strlcpy(v->card, "RadioTrack II", sizeof(v->card));
130 sprintf(v->bus_info, "ISA");
131 v->version = RADIO_VERSION;
132 v->capabilities = V4L2_CAP_TUNER;
133 return 0;
136 static int vidioc_s_tuner(struct file *file, void *priv,
137 struct v4l2_tuner *v)
139 if (v->index > 0)
140 return -EINVAL;
142 return 0;
145 static int rt_getsigstr(struct rt_device *dev)
147 if (inb(io) & 2) /* bit set = no signal present */
148 return 0;
149 return 1; /* signal present */
152 static int vidioc_g_tuner(struct file *file, void *priv,
153 struct v4l2_tuner *v)
155 struct video_device *dev = video_devdata(file);
156 struct rt_device *rt = dev->priv;
158 if (v->index > 0)
159 return -EINVAL;
161 strcpy(v->name, "FM");
162 v->type = V4L2_TUNER_RADIO;
163 v->rangelow = (88*16000);
164 v->rangehigh = (108*16000);
165 v->rxsubchans = V4L2_TUNER_SUB_MONO;
166 v->capability = V4L2_TUNER_CAP_LOW;
167 v->audmode = V4L2_TUNER_MODE_MONO;
168 v->signal = 0xFFFF*rt_getsigstr(rt);
169 return 0;
172 static int vidioc_s_frequency(struct file *file, void *priv,
173 struct v4l2_frequency *f)
175 struct video_device *dev = video_devdata(file);
176 struct rt_device *rt = dev->priv;
178 rt->curfreq = f->frequency;
179 rt_setfreq(rt, rt->curfreq);
180 return 0;
183 static int vidioc_g_frequency(struct file *file, void *priv,
184 struct v4l2_frequency *f)
186 struct video_device *dev = video_devdata(file);
187 struct rt_device *rt = dev->priv;
189 f->type = V4L2_TUNER_RADIO;
190 f->frequency = rt->curfreq;
191 return 0;
194 static int vidioc_queryctrl(struct file *file, void *priv,
195 struct v4l2_queryctrl *qc)
197 int i;
199 for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) {
200 if (qc->id && qc->id == radio_qctrl[i].id) {
201 memcpy(qc, &(radio_qctrl[i]),
202 sizeof(*qc));
203 return 0;
206 return -EINVAL;
209 static int vidioc_g_ctrl(struct file *file, void *priv,
210 struct v4l2_control *ctrl)
212 struct video_device *dev = video_devdata(file);
213 struct rt_device *rt = dev->priv;
215 switch (ctrl->id) {
216 case V4L2_CID_AUDIO_MUTE:
217 ctrl->value = rt->muted;
218 return 0;
219 case V4L2_CID_AUDIO_VOLUME:
220 if (rt->muted)
221 ctrl->value = 0;
222 else
223 ctrl->value = 65535;
224 return 0;
226 return -EINVAL;
229 static int vidioc_s_ctrl(struct file *file, void *priv,
230 struct v4l2_control *ctrl)
232 struct video_device *dev = video_devdata(file);
233 struct rt_device *rt = dev->priv;
235 switch (ctrl->id) {
236 case V4L2_CID_AUDIO_MUTE:
237 if (ctrl->value)
238 rt_mute(rt);
239 else
240 rt_unmute(rt);
241 return 0;
242 case V4L2_CID_AUDIO_VOLUME:
243 if (ctrl->value)
244 rt_unmute(rt);
245 else
246 rt_mute(rt);
247 return 0;
249 return -EINVAL;
252 static int vidioc_g_audio(struct file *file, void *priv,
253 struct v4l2_audio *a)
255 if (a->index > 1)
256 return -EINVAL;
258 strcpy(a->name, "Radio");
259 a->capability = V4L2_AUDCAP_STEREO;
260 return 0;
263 static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i)
265 *i = 0;
266 return 0;
269 static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
271 if (i != 0)
272 return -EINVAL;
273 return 0;
276 static int vidioc_s_audio(struct file *file, void *priv,
277 struct v4l2_audio *a)
279 if (a->index != 0)
280 return -EINVAL;
281 return 0;
284 static struct rt_device rtrack2_unit;
286 static const struct file_operations rtrack2_fops = {
287 .owner = THIS_MODULE,
288 .open = video_exclusive_open,
289 .release = video_exclusive_release,
290 .ioctl = video_ioctl2,
291 .compat_ioctl = v4l_compat_ioctl32,
292 .llseek = no_llseek,
295 static struct video_device rtrack2_radio=
297 .owner = THIS_MODULE,
298 .name = "RadioTrack II radio",
299 .type = VID_TYPE_TUNER,
300 .fops = &rtrack2_fops,
301 .vidioc_querycap = vidioc_querycap,
302 .vidioc_g_tuner = vidioc_g_tuner,
303 .vidioc_s_tuner = vidioc_s_tuner,
304 .vidioc_g_frequency = vidioc_g_frequency,
305 .vidioc_s_frequency = vidioc_s_frequency,
306 .vidioc_queryctrl = vidioc_queryctrl,
307 .vidioc_g_ctrl = vidioc_g_ctrl,
308 .vidioc_s_ctrl = vidioc_s_ctrl,
309 .vidioc_g_audio = vidioc_g_audio,
310 .vidioc_s_audio = vidioc_s_audio,
311 .vidioc_g_input = vidioc_g_input,
312 .vidioc_s_input = vidioc_s_input,
315 static int __init rtrack2_init(void)
317 if(io==-1)
319 printk(KERN_ERR "You must set an I/O address with io=0x20c or io=0x30c\n");
320 return -EINVAL;
322 if (!request_region(io, 4, "rtrack2"))
324 printk(KERN_ERR "rtrack2: port 0x%x already in use\n", io);
325 return -EBUSY;
328 rtrack2_radio.priv=&rtrack2_unit;
330 spin_lock_init(&lock);
331 if(video_register_device(&rtrack2_radio, VFL_TYPE_RADIO, radio_nr)==-1)
333 release_region(io, 4);
334 return -EINVAL;
337 printk(KERN_INFO "AIMSlab Radiotrack II card driver.\n");
339 /* mute card - prevents noisy bootups */
340 outb(1, io);
341 rtrack2_unit.muted = 1;
343 return 0;
346 MODULE_AUTHOR("Ben Pfaff");
347 MODULE_DESCRIPTION("A driver for the RadioTrack II radio card.");
348 MODULE_LICENSE("GPL");
350 module_param(io, int, 0);
351 MODULE_PARM_DESC(io, "I/O address of the RadioTrack card (0x20c or 0x30c)");
352 module_param(radio_nr, int, 0);
354 static void __exit rtrack2_cleanup_module(void)
356 video_unregister_device(&rtrack2_radio);
357 release_region(io,4);
360 module_init(rtrack2_init);
361 module_exit(rtrack2_cleanup_module);
364 Local variables:
365 compile-command: "mmake"
366 End: