release/src-rt-6.x.4708/linux/linux-2.6.36/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  ********************************************************************/
  24
  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>
  33
  34 #include <asm/io.h>
  35 #include <asm/uaccess.h>
  36 #include <linux/spinlock.h>
  37 #include <asm/irq.h>
  38 #include "msnd.h"
  39
  40 #define LOGNAME                 "msnd"
  41
  42 #define MSND_MAX_DEVS           4
  43
  44 static multisound_dev_t         *devs[MSND_MAX_DEVS];
  45 static int                      num_devs;
  46
  47 int msnd_register(multisound_dev_t *dev)
  48 {
  49         int i;
  50
  51         for (i = 0; i < MSND_MAX_DEVS; ++i)
  52                 if (devs[i] == NULL)
  53                         break;
  54
  55         if (i == MSND_MAX_DEVS)
  56                 return -ENOMEM;
  57
  58         devs[i] = dev;
  59         ++num_devs;
  60         return 0;
  61 }
  62
  63 void msnd_unregister(multisound_dev_t *dev)
  64 {
  65         int i;
  66
  67         for (i = 0; i < MSND_MAX_DEVS; ++i)
  68                 if (devs[i] == dev)
  69                         break;
  70
  71         if (i == MSND_MAX_DEVS) {
  72                 printk(KERN_WARNING LOGNAME ": Unregistering unknown device\n");
  73                 return;
  74         }
  75
  76         devs[i] = NULL;
  77         --num_devs;
  78 }
  79
  80 void msnd_init_queue(void __iomem *base, int start, int size)
  81 {
  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);
  86 }
  87
  88 void msnd_fifo_init(msnd_fifo *f)
  89 {
  90         f->data = NULL;
  91 }
  92
  93 void msnd_fifo_free(msnd_fifo *f)
  94 {
  95         vfree(f->data);
  96         f->data = NULL;
  97 }
  98
  99 int msnd_fifo_alloc(msnd_fifo *f, size_t n)
 100 {
 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;
 107
 108         if (!f->data)
 109                 return -ENOMEM;
 110
 111         return 0;
 112 }
 113
 114 void msnd_fifo_make_empty(msnd_fifo *f)
 115 {
 116         f->len = f->tail = f->head = 0;
 117 }
 118
 119 int msnd_fifo_write_io(msnd_fifo *f, char __iomem *buf, size_t len)
 120 {
 121         int count = 0;
 122
 123         while ((count < len) && (f->len != f->n)) {
 124
 125                 int nwritten;
 126
 127                 if (f->head <= f->tail) {
 128                         nwritten = len - count;
 129                         if (nwritten > f->n - f->tail)
 130                                 nwritten = f->n - f->tail;
 131                 }
 132                 else {
 133                         nwritten = f->head - f->tail;
 134                         if (nwritten > len - count)
 135                                 nwritten = len - count;
 136                 }
 137
 138                 memcpy_fromio(f->data + f->tail, buf, nwritten);
 139
 140                 count += nwritten;
 141                 buf += nwritten;
 142                 f->len += nwritten;
 143                 f->tail += nwritten;
 144                 f->tail %= f->n;
 145         }
 146
 147         return count;
 148 }
 149
 150 int msnd_fifo_write(msnd_fifo *f, const char *buf, size_t len)
 151 {
 152         int count = 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                 memcpy(f->data + f->tail, buf, nwritten);
 170
 171                 count += nwritten;
 172                 buf += nwritten;
 173                 f->len += nwritten;
 174                 f->tail += nwritten;
 175                 f->tail %= f->n;
 176         }
 177
 178         return count;
 179 }
 180
 181 int msnd_fifo_read_io(msnd_fifo *f, char __iomem *buf, size_t len)
 182 {
 183         int count = 0;
 184
 185         while ((count < len) && (f->len > 0)) {
 186
 187                 int nread;
 188
 189                 if (f->tail <= f->head) {
 190                         nread = len - count;
 191                         if (nread > f->n - f->head)
 192                                 nread = f->n - f->head;
 193                 }
 194                 else {
 195                         nread = f->tail - f->head;
 196                         if (nread > len - count)
 197                                 nread = len - count;
 198                 }
 199
 200                 memcpy_toio(buf, f->data + f->head, nread);
 201
 202                 count += nread;
 203                 buf += nread;
 204                 f->len -= nread;
 205                 f->head += nread;
 206                 f->head %= f->n;
 207         }
 208
 209         return count;
 210 }
 211
 212 int msnd_fifo_read(msnd_fifo *f, char *buf, size_t len)
 213 {
 214         int count = 0;
 215
 216         while ((count < len) && (f->len > 0)) {
 217
 218                 int nread;
 219
 220                 if (f->tail <= f->head) {
 221                         nread = len - count;
 222                         if (nread > f->n - f->head)
 223                                 nread = f->n - f->head;
 224                 }
 225                 else {
 226                         nread = f->tail - f->head;
 227                         if (nread > len - count)
 228                                 nread = len - count;
 229                 }
 230
 231                 memcpy(buf, f->data + f->head, nread);
 232
 233                 count += nread;
 234                 buf += nread;
 235                 f->len -= nread;
 236                 f->head += nread;
 237                 f->head %= f->n;
 238         }
 239
 240         return count;
 241 }
 242
 243 static int msnd_wait_TXDE(multisound_dev_t *dev)
 244 {
 245         register unsigned int io = dev->io;
 246         register int timeout = 1000;
 247
 248         while(timeout-- > 0)
 249                 if (msnd_inb(io + HP_ISR) & HPISR_TXDE)
 250                         return 0;
 251
 252         return -EIO;
 253 }
 254
 255 static int msnd_wait_HC0(multisound_dev_t *dev)
 256 {
 257         register unsigned int io = dev->io;
 258         register int timeout = 1000;
 259
 260         while(timeout-- > 0)
 261                 if (!(msnd_inb(io + HP_CVR) & HPCVR_HC))
 262                         return 0;
 263
 264         return -EIO;
 265 }
 266
 267 int msnd_send_dsp_cmd(multisound_dev_t *dev, BYTE cmd)
 268 {
 269         unsigned long flags;
 270
 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;
 276         }
 277         spin_unlock_irqrestore(&dev->lock, flags);
 278
 279         printk(KERN_DEBUG LOGNAME ": Send DSP command timeout\n");
 280
 281         return -EIO;
 282 }
 283
 284 int msnd_send_word(multisound_dev_t *dev, unsigned char high,
 285                    unsigned char mid, unsigned char low)
 286 {
 287         register unsigned int io = dev->io;
 288
 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;
 294         }
 295
 296         printk(KERN_DEBUG LOGNAME ": Send host word timeout\n");
 297
 298         return -EIO;
 299 }
 300
 301 int msnd_upload_host(multisound_dev_t *dev, char *bin, int len)
 302 {
 303         int i;
 304
 305         if (len % 3 != 0) {
 306                 printk(KERN_WARNING LOGNAME ": Upload host data not multiple of 3!\n");
 307                 return -EINVAL;
 308         }
 309
 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;
 313
 314         msnd_inb(dev->io + HP_RXL);
 315         msnd_inb(dev->io + HP_CVR);
 316
 317         return 0;
 318 }
 319
 320 int msnd_enable_irq(multisound_dev_t *dev)
 321 {
 322         unsigned long flags;
 323
 324         if (dev->irq_ref++)
 325                 return 0;
 326
 327         printk(KERN_DEBUG LOGNAME ": Enabling IRQ\n");
 328
 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;
 340         }
 341         spin_unlock_irqrestore(&dev->lock, flags);
 342
 343         printk(KERN_DEBUG LOGNAME ": Enable IRQ failed\n");
 344
 345         return -EIO;
 346 }
 347
 348 int msnd_disable_irq(multisound_dev_t *dev)
 349 {
 350         unsigned long flags;
 351
 352         if (--dev->irq_ref > 0)
 353                 return 0;
 354
 355         if (dev->irq_ref < 0)
 356                 printk(KERN_DEBUG LOGNAME ": IRQ ref count is %d\n", dev->irq_ref);
 357
 358         printk(KERN_DEBUG LOGNAME ": Disabling IRQ\n");
 359
 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;
 368         }
 369         spin_unlock_irqrestore(&dev->lock, flags);
 370
 371         printk(KERN_DEBUG LOGNAME ": Disable IRQ failed\n");
 372
 373         return -EIO;
 374 }
 375
 376 #ifndef LINUX20
 377 EXPORT_SYMBOL(msnd_register);
 378 EXPORT_SYMBOL(msnd_unregister);
 379
 380 EXPORT_SYMBOL(msnd_init_queue);
 381
 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);
 390
 391 EXPORT_SYMBOL(msnd_send_dsp_cmd);
 392 EXPORT_SYMBOL(msnd_send_word);
 393 EXPORT_SYMBOL(msnd_upload_host);
 394
 395 EXPORT_SYMBOL(msnd_enable_irq);
 396 EXPORT_SYMBOL(msnd_disable_irq);
 397 #endif
 398
 399 #ifdef MODULE
 400 MODULE_AUTHOR                           ("Andrew Veliath <andrewtv@usa.net>");
 401 MODULE_DESCRIPTION                      ("Turtle Beach MultiSound Driver Base");
 402 MODULE_LICENSE("GPL");
 403
 404
 405 int init_module(void)
 406 {
 407         return 0;
 408 }
 409
 410 void cleanup_module(void)
 411 {
 412 }
 413 #endif