File: /usr/src/linux/drivers/sound/msnd.c
1 /*********************************************************************
2 *
3 * msnd.c - Driver Base
4 *
5 * Turtle Beach MultiSound Sound Card Driver for Linux
6 *
7 * Copyright (C) 1998 Andrew Veliath
8 *
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.
13 *
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.
18 *
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.
22 *
23 * $Id: msnd.c,v 1.17 1999/03/21 16:50:09 andrewtv Exp $
24 *
25 ********************************************************************/
26
27 #include <linux/version.h>
28 #if LINUX_VERSION_CODE < 0x020101
29 # define LINUX20
30 #endif
31 #include <linux/module.h>
32 #include <linux/kernel.h>
33 #include <linux/slab.h>
34 #include <linux/vmalloc.h>
35 #include <linux/types.h>
36 #include <linux/delay.h>
37 #include <linux/mm.h>
38 #ifdef LINUX20
39 # include <linux/major.h>
40 # include <linux/fs.h>
41 # include <linux/sound.h>
42 # include <asm/segment.h>
43 # include "sound_config.h"
44 #else
45 # include <linux/init.h>
46 # include <asm/io.h>
47 # include <asm/uaccess.h>
48 # include <linux/spinlock.h>
49 #endif
50 #include <asm/irq.h>
51 #include "msnd.h"
52
53 #define LOGNAME "msnd"
54
55 #define MSND_MAX_DEVS 4
56
57 static multisound_dev_t *devs[MSND_MAX_DEVS];
58 static int num_devs;
59
60 int __init msnd_register(multisound_dev_t *dev)
61 {
62 int i;
63
64 for (i = 0; i < MSND_MAX_DEVS; ++i)
65 if (devs[i] == NULL)
66 break;
67
68 if (i == MSND_MAX_DEVS)
69 return -ENOMEM;
70
71 devs[i] = dev;
72 ++num_devs;
73
74 MOD_INC_USE_COUNT;
75
76 return 0;
77 }
78
79 void msnd_unregister(multisound_dev_t *dev)
80 {
81 int i;
82
83 for (i = 0; i < MSND_MAX_DEVS; ++i)
84 if (devs[i] == dev)
85 break;
86
87 if (i == MSND_MAX_DEVS) {
88 printk(KERN_WARNING LOGNAME ": Unregistering unknown device\n");
89 return;
90 }
91
92 devs[i] = NULL;
93 --num_devs;
94
95 MOD_DEC_USE_COUNT;
96 }
97
98 int msnd_get_num_devs(void)
99 {
100 return num_devs;
101 }
102
103 multisound_dev_t *msnd_get_dev(int j)
104 {
105 int i;
106
107 for (i = 0; i < MSND_MAX_DEVS && j; ++i)
108 if (devs[i] != NULL)
109 --j;
110
111 if (i == MSND_MAX_DEVS || j != 0)
112 return NULL;
113
114 return devs[i];
115 }
116
117 void msnd_init_queue(unsigned long base, int start, int size)
118 {
119 isa_writew(PCTODSP_BASED(start), base + JQS_wStart);
120 isa_writew(PCTODSP_OFFSET(size) - 1, base + JQS_wSize);
121 isa_writew(0, base + JQS_wHead);
122 isa_writew(0, base + JQS_wTail);
123 }
124
125 void msnd_fifo_init(msnd_fifo *f)
126 {
127 f->data = NULL;
128 }
129
130 void msnd_fifo_free(msnd_fifo *f)
131 {
132 if (f->data) {
133 vfree(f->data);
134 f->data = NULL;
135 }
136 }
137
138 int msnd_fifo_alloc(msnd_fifo *f, size_t n)
139 {
140 msnd_fifo_free(f);
141 f->data = (char *)vmalloc(n);
142 f->n = n;
143 f->tail = 0;
144 f->head = 0;
145 f->len = 0;
146
147 if (!f->data)
148 return -ENOMEM;
149
150 return 0;
151 }
152
153 void msnd_fifo_make_empty(msnd_fifo *f)
154 {
155 f->len = f->tail = f->head = 0;
156 }
157
158 int msnd_fifo_write(msnd_fifo *f, const char *buf, size_t len, int user)
159 {
160 int count = 0;
161
162 if (f->len == f->n)
163 return 0;
164
165 while ((count < len) && (f->len != f->n)) {
166
167 int nwritten;
168
169 if (f->head <= f->tail) {
170 nwritten = len - count;
171 if (nwritten > f->n - f->tail)
172 nwritten = f->n - f->tail;
173 }
174 else {
175 nwritten = f->head - f->tail;
176 if (nwritten > len - count)
177 nwritten = len - count;
178 }
179
180 if (user) {
181 if (copy_from_user(f->data + f->tail, buf, nwritten))
182 return -EFAULT;
183 } else
184 isa_memcpy_fromio(f->data + f->tail, (unsigned long) buf, nwritten);
185
186 count += nwritten;
187 buf += nwritten;
188 f->len += nwritten;
189 f->tail += nwritten;
190 f->tail %= f->n;
191 }
192
193 return count;
194 }
195
196 int msnd_fifo_read(msnd_fifo *f, char *buf, size_t len, int user)
197 {
198 int count = 0;
199
200 if (f->len == 0)
201 return f->len;
202
203 while ((count < len) && (f->len > 0)) {
204
205 int nread;
206
207 if (f->tail <= f->head) {
208 nread = len - count;
209 if (nread > f->n - f->head)
210 nread = f->n - f->head;
211 }
212 else {
213 nread = f->tail - f->head;
214 if (nread > len - count)
215 nread = len - count;
216 }
217
218 if (user) {
219 if (copy_to_user(buf, f->data + f->head, nread))
220 return -EFAULT;
221 } else
222 isa_memcpy_toio((unsigned long) buf, f->data + f->head, nread);
223
224 count += nread;
225 buf += nread;
226 f->len -= nread;
227 f->head += nread;
228 f->head %= f->n;
229 }
230
231 return count;
232 }
233
234 int msnd_wait_TXDE(multisound_dev_t *dev)
235 {
236 register unsigned int io = dev->io;
237 register int timeout = 1000;
238
239 while(timeout-- > 0)
240 if (inb(io + HP_ISR) & HPISR_TXDE)
241 return 0;
242
243 return -EIO;
244 }
245
246 int msnd_wait_HC0(multisound_dev_t *dev)
247 {
248 register unsigned int io = dev->io;
249 register int timeout = 1000;
250
251 while(timeout-- > 0)
252 if (!(inb(io + HP_CVR) & HPCVR_HC))
253 return 0;
254
255 return -EIO;
256 }
257
258 int msnd_send_dsp_cmd(multisound_dev_t *dev, BYTE cmd)
259 {
260 unsigned long flags;
261
262 spin_lock_irqsave(&dev->lock, flags);
263 if (msnd_wait_HC0(dev) == 0) {
264 outb(cmd, dev->io + HP_CVR);
265 spin_unlock_irqrestore(&dev->lock, flags);
266 return 0;
267 }
268 spin_unlock_irqrestore(&dev->lock, flags);
269
270 printk(KERN_DEBUG LOGNAME ": Send DSP command timeout\n");
271
272 return -EIO;
273 }
274
275 int msnd_send_word(multisound_dev_t *dev, unsigned char high,
276 unsigned char mid, unsigned char low)
277 {
278 register unsigned int io = dev->io;
279
280 if (msnd_wait_TXDE(dev) == 0) {
281 outb(high, io + HP_TXH);
282 outb(mid, io + HP_TXM);
283 outb(low, io + HP_TXL);
284 return 0;
285 }
286
287 printk(KERN_DEBUG LOGNAME ": Send host word timeout\n");
288
289 return -EIO;
290 }
291
292 int msnd_upload_host(multisound_dev_t *dev, char *bin, int len)
293 {
294 int i;
295
296 if (len % 3 != 0) {
297 printk(KERN_WARNING LOGNAME ": Upload host data not multiple of 3!\n");
298 return -EINVAL;
299 }
300
301 for (i = 0; i < len; i += 3)
302 if (msnd_send_word(dev, bin[i], bin[i + 1], bin[i + 2]) != 0)
303 return -EIO;
304
305 inb(dev->io + HP_RXL);
306 inb(dev->io + HP_CVR);
307
308 return 0;
309 }
310
311 int msnd_enable_irq(multisound_dev_t *dev)
312 {
313 unsigned long flags;
314
315 if (dev->irq_ref++)
316 return 0;
317
318 printk(KERN_DEBUG LOGNAME ": Enabling IRQ\n");
319
320 spin_lock_irqsave(&dev->lock, flags);
321 if (msnd_wait_TXDE(dev) == 0) {
322 outb(inb(dev->io + HP_ICR) | HPICR_TREQ, dev->io + HP_ICR);
323 if (dev->type == msndClassic)
324 outb(dev->irqid, dev->io + HP_IRQM);
325 outb(inb(dev->io + HP_ICR) & ~HPICR_TREQ, dev->io + HP_ICR);
326 outb(inb(dev->io + HP_ICR) | HPICR_RREQ, dev->io + HP_ICR);
327 enable_irq(dev->irq);
328 msnd_init_queue(dev->DSPQ, dev->dspq_data_buff, dev->dspq_buff_size);
329 spin_unlock_irqrestore(&dev->lock, flags);
330 return 0;
331 }
332 spin_unlock_irqrestore(&dev->lock, flags);
333
334 printk(KERN_DEBUG LOGNAME ": Enable IRQ failed\n");
335
336 return -EIO;
337 }
338
339 int msnd_disable_irq(multisound_dev_t *dev)
340 {
341 unsigned long flags;
342
343 if (--dev->irq_ref > 0)
344 return 0;
345
346 if (dev->irq_ref < 0)
347 printk(KERN_DEBUG LOGNAME ": IRQ ref count is %d\n", dev->irq_ref);
348
349 printk(KERN_DEBUG LOGNAME ": Disabling IRQ\n");
350
351 spin_lock_irqsave(&dev->lock, flags);
352 if (msnd_wait_TXDE(dev) == 0) {
353 outb(inb(dev->io + HP_ICR) & ~HPICR_RREQ, dev->io + HP_ICR);
354 if (dev->type == msndClassic)
355 outb(HPIRQ_NONE, dev->io + HP_IRQM);
356 disable_irq(dev->irq);
357 spin_unlock_irqrestore(&dev->lock, flags);
358 return 0;
359 }
360 spin_unlock_irqrestore(&dev->lock, flags);
361
362 printk(KERN_DEBUG LOGNAME ": Disable IRQ failed\n");
363
364 return -EIO;
365 }
366
367 #ifndef LINUX20
368 EXPORT_SYMBOL(msnd_register);
369 EXPORT_SYMBOL(msnd_unregister);
370 EXPORT_SYMBOL(msnd_get_num_devs);
371 EXPORT_SYMBOL(msnd_get_dev);
372
373 EXPORT_SYMBOL(msnd_init_queue);
374
375 EXPORT_SYMBOL(msnd_fifo_init);
376 EXPORT_SYMBOL(msnd_fifo_free);
377 EXPORT_SYMBOL(msnd_fifo_alloc);
378 EXPORT_SYMBOL(msnd_fifo_make_empty);
379 EXPORT_SYMBOL(msnd_fifo_write);
380 EXPORT_SYMBOL(msnd_fifo_read);
381
382 EXPORT_SYMBOL(msnd_wait_TXDE);
383 EXPORT_SYMBOL(msnd_wait_HC0);
384 EXPORT_SYMBOL(msnd_send_dsp_cmd);
385 EXPORT_SYMBOL(msnd_send_word);
386 EXPORT_SYMBOL(msnd_upload_host);
387
388 EXPORT_SYMBOL(msnd_enable_irq);
389 EXPORT_SYMBOL(msnd_disable_irq);
390 #endif
391
392 #ifdef MODULE
393 MODULE_AUTHOR ("Andrew Veliath <andrewtv@usa.net>");
394 MODULE_DESCRIPTION ("Turtle Beach MultiSound Driver Base");
395
396 int init_module(void)
397 {
398 return 0;
399 }
400
401 void cleanup_module(void)
402 {
403 }
404 #endif
405