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