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