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