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.1.1.1 2005/04/11 02:50:39 jack 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 MODULE_LICENSE("GPL");
 396
 397
 398 int init_module(void)
 399 {
 400         return 0;
 401 }
 402
 403 void cleanup_module(void)
 404 {
 405 }
 406 #endif