drivers:staging:solo6x10:add the missed slab.h
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / sound / oss / msnd.c
blobc0cc951ba97d99d52fb0a067754380ba44ed905c
1 /*********************************************************************
3 * msnd.c - Driver Base
5 * Turtle Beach MultiSound Sound Card Driver for Linux
7 * Copyright (C) 1998 Andrew Veliath
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 ********************************************************************/
25 #include <linux/module.h>
26 #include <linux/kernel.h>
27 #include <linux/vmalloc.h>
28 #include <linux/types.h>
29 #include <linux/delay.h>
30 #include <linux/mm.h>
31 #include <linux/init.h>
32 #include <linux/interrupt.h>
34 #include <asm/io.h>
35 #include <asm/uaccess.h>
36 #include <linux/spinlock.h>
37 #include <asm/irq.h>
38 #include "msnd.h"
40 #define LOGNAME "msnd"
42 #define MSND_MAX_DEVS 4
44 static multisound_dev_t *devs[MSND_MAX_DEVS];
45 static int num_devs;
47 int msnd_register(multisound_dev_t *dev)
49 int i;
51 for (i = 0; i < MSND_MAX_DEVS; ++i)
52 if (devs[i] == NULL)
53 break;
55 if (i == MSND_MAX_DEVS)
56 return -ENOMEM;
58 devs[i] = dev;
59 ++num_devs;
60 return 0;
63 void msnd_unregister(multisound_dev_t *dev)
65 int i;
67 for (i = 0; i < MSND_MAX_DEVS; ++i)
68 if (devs[i] == dev)
69 break;
71 if (i == MSND_MAX_DEVS) {
72 printk(KERN_WARNING LOGNAME ": Unregistering unknown device\n");
73 return;
76 devs[i] = NULL;
77 --num_devs;
80 void msnd_init_queue(void __iomem *base, int start, int size)
82 writew(PCTODSP_BASED(start), base + JQS_wStart);
83 writew(PCTODSP_OFFSET(size) - 1, base + JQS_wSize);
84 writew(0, base + JQS_wHead);
85 writew(0, base + JQS_wTail);
88 void msnd_fifo_init(msnd_fifo *f)
90 f->data = NULL;
93 void msnd_fifo_free(msnd_fifo *f)
95 vfree(f->data);
96 f->data = NULL;
99 int msnd_fifo_alloc(msnd_fifo *f, size_t n)
101 msnd_fifo_free(f);
102 f->data = vmalloc(n);
103 f->n = n;
104 f->tail = 0;
105 f->head = 0;
106 f->len = 0;
108 if (!f->data)
109 return -ENOMEM;
111 return 0;
114 void msnd_fifo_make_empty(msnd_fifo *f)
116 f->len = f->tail = f->head = 0;
119 int msnd_fifo_write_io(msnd_fifo *f, char __iomem *buf, size_t len)
121 int count = 0;
123 while ((count < len) && (f->len != f->n)) {
125 int nwritten;
127 if (f->head <= f->tail) {
128 nwritten = len - count;
129 if (nwritten > f->n - f->tail)
130 nwritten = f->n - f->tail;
132 else {
133 nwritten = f->head - f->tail;
134 if (nwritten > len - count)
135 nwritten = len - count;
138 memcpy_fromio(f->data + f->tail, buf, nwritten);
140 count += nwritten;
141 buf += nwritten;
142 f->len += nwritten;
143 f->tail += nwritten;
144 f->tail %= f->n;
147 return count;
150 int msnd_fifo_write(msnd_fifo *f, const char *buf, size_t len)
152 int count = 0;
154 while ((count < len) && (f->len != f->n)) {
156 int nwritten;
158 if (f->head <= f->tail) {
159 nwritten = len - count;
160 if (nwritten > f->n - f->tail)
161 nwritten = f->n - f->tail;
163 else {
164 nwritten = f->head - f->tail;
165 if (nwritten > len - count)
166 nwritten = len - count;
169 memcpy(f->data + f->tail, buf, nwritten);
171 count += nwritten;
172 buf += nwritten;
173 f->len += nwritten;
174 f->tail += nwritten;
175 f->tail %= f->n;
178 return count;
181 int msnd_fifo_read_io(msnd_fifo *f, char __iomem *buf, size_t len)
183 int count = 0;
185 while ((count < len) && (f->len > 0)) {
187 int nread;
189 if (f->tail <= f->head) {
190 nread = len - count;
191 if (nread > f->n - f->head)
192 nread = f->n - f->head;
194 else {
195 nread = f->tail - f->head;
196 if (nread > len - count)
197 nread = len - count;
200 memcpy_toio(buf, f->data + f->head, nread);
202 count += nread;
203 buf += nread;
204 f->len -= nread;
205 f->head += nread;
206 f->head %= f->n;
209 return count;
212 int msnd_fifo_read(msnd_fifo *f, char *buf, size_t len)
214 int count = 0;
216 while ((count < len) && (f->len > 0)) {
218 int nread;
220 if (f->tail <= f->head) {
221 nread = len - count;
222 if (nread > f->n - f->head)
223 nread = f->n - f->head;
225 else {
226 nread = f->tail - f->head;
227 if (nread > len - count)
228 nread = len - count;
231 memcpy(buf, f->data + f->head, nread);
233 count += nread;
234 buf += nread;
235 f->len -= nread;
236 f->head += nread;
237 f->head %= f->n;
240 return count;
243 static int msnd_wait_TXDE(multisound_dev_t *dev)
245 register unsigned int io = dev->io;
246 register int timeout = 1000;
248 while(timeout-- > 0)
249 if (msnd_inb(io + HP_ISR) & HPISR_TXDE)
250 return 0;
252 return -EIO;
255 static int msnd_wait_HC0(multisound_dev_t *dev)
257 register unsigned int io = dev->io;
258 register int timeout = 1000;
260 while(timeout-- > 0)
261 if (!(msnd_inb(io + HP_CVR) & HPCVR_HC))
262 return 0;
264 return -EIO;
267 int msnd_send_dsp_cmd(multisound_dev_t *dev, BYTE cmd)
269 unsigned long flags;
271 spin_lock_irqsave(&dev->lock, flags);
272 if (msnd_wait_HC0(dev) == 0) {
273 msnd_outb(cmd, dev->io + HP_CVR);
274 spin_unlock_irqrestore(&dev->lock, flags);
275 return 0;
277 spin_unlock_irqrestore(&dev->lock, flags);
279 printk(KERN_DEBUG LOGNAME ": Send DSP command timeout\n");
281 return -EIO;
284 int msnd_send_word(multisound_dev_t *dev, unsigned char high,
285 unsigned char mid, unsigned char low)
287 register unsigned int io = dev->io;
289 if (msnd_wait_TXDE(dev) == 0) {
290 msnd_outb(high, io + HP_TXH);
291 msnd_outb(mid, io + HP_TXM);
292 msnd_outb(low, io + HP_TXL);
293 return 0;
296 printk(KERN_DEBUG LOGNAME ": Send host word timeout\n");
298 return -EIO;
301 int msnd_upload_host(multisound_dev_t *dev, char *bin, int len)
303 int i;
305 if (len % 3 != 0) {
306 printk(KERN_WARNING LOGNAME ": Upload host data not multiple of 3!\n");
307 return -EINVAL;
310 for (i = 0; i < len; i += 3)
311 if (msnd_send_word(dev, bin[i], bin[i + 1], bin[i + 2]) != 0)
312 return -EIO;
314 msnd_inb(dev->io + HP_RXL);
315 msnd_inb(dev->io + HP_CVR);
317 return 0;
320 int msnd_enable_irq(multisound_dev_t *dev)
322 unsigned long flags;
324 if (dev->irq_ref++)
325 return 0;
327 printk(KERN_DEBUG LOGNAME ": Enabling IRQ\n");
329 spin_lock_irqsave(&dev->lock, flags);
330 if (msnd_wait_TXDE(dev) == 0) {
331 msnd_outb(msnd_inb(dev->io + HP_ICR) | HPICR_TREQ, dev->io + HP_ICR);
332 if (dev->type == msndClassic)
333 msnd_outb(dev->irqid, dev->io + HP_IRQM);
334 msnd_outb(msnd_inb(dev->io + HP_ICR) & ~HPICR_TREQ, dev->io + HP_ICR);
335 msnd_outb(msnd_inb(dev->io + HP_ICR) | HPICR_RREQ, dev->io + HP_ICR);
336 enable_irq(dev->irq);
337 msnd_init_queue(dev->DSPQ, dev->dspq_data_buff, dev->dspq_buff_size);
338 spin_unlock_irqrestore(&dev->lock, flags);
339 return 0;
341 spin_unlock_irqrestore(&dev->lock, flags);
343 printk(KERN_DEBUG LOGNAME ": Enable IRQ failed\n");
345 return -EIO;
348 int msnd_disable_irq(multisound_dev_t *dev)
350 unsigned long flags;
352 if (--dev->irq_ref > 0)
353 return 0;
355 if (dev->irq_ref < 0)
356 printk(KERN_DEBUG LOGNAME ": IRQ ref count is %d\n", dev->irq_ref);
358 printk(KERN_DEBUG LOGNAME ": Disabling IRQ\n");
360 spin_lock_irqsave(&dev->lock, flags);
361 if (msnd_wait_TXDE(dev) == 0) {
362 msnd_outb(msnd_inb(dev->io + HP_ICR) & ~HPICR_RREQ, dev->io + HP_ICR);
363 if (dev->type == msndClassic)
364 msnd_outb(HPIRQ_NONE, dev->io + HP_IRQM);
365 disable_irq(dev->irq);
366 spin_unlock_irqrestore(&dev->lock, flags);
367 return 0;
369 spin_unlock_irqrestore(&dev->lock, flags);
371 printk(KERN_DEBUG LOGNAME ": Disable IRQ failed\n");
373 return -EIO;
376 #ifndef LINUX20
377 EXPORT_SYMBOL(msnd_register);
378 EXPORT_SYMBOL(msnd_unregister);
380 EXPORT_SYMBOL(msnd_init_queue);
382 EXPORT_SYMBOL(msnd_fifo_init);
383 EXPORT_SYMBOL(msnd_fifo_free);
384 EXPORT_SYMBOL(msnd_fifo_alloc);
385 EXPORT_SYMBOL(msnd_fifo_make_empty);
386 EXPORT_SYMBOL(msnd_fifo_write_io);
387 EXPORT_SYMBOL(msnd_fifo_read_io);
388 EXPORT_SYMBOL(msnd_fifo_write);
389 EXPORT_SYMBOL(msnd_fifo_read);
391 EXPORT_SYMBOL(msnd_send_dsp_cmd);
392 EXPORT_SYMBOL(msnd_send_word);
393 EXPORT_SYMBOL(msnd_upload_host);
395 EXPORT_SYMBOL(msnd_enable_irq);
396 EXPORT_SYMBOL(msnd_disable_irq);
397 #endif
399 #ifdef MODULE
400 MODULE_AUTHOR ("Andrew Veliath <andrewtv@usa.net>");
401 MODULE_DESCRIPTION ("Turtle Beach MultiSound Driver Base");
402 MODULE_LICENSE("GPL");
405 int init_module(void)
407 return 0;
410 void cleanup_module(void)
413 #endif