WSL2-Linux-Kernel/sound/oss/emu10k1/hwaccess.c

508 строки
14 KiB
C

/*
**********************************************************************
* hwaccess.c -- Hardware access layer
* Copyright 1999, 2000 Creative Labs, Inc.
*
**********************************************************************
*
* Date Author Summary of changes
* ---- ------ ------------------
* October 20, 1999 Bertrand Lee base code release
* December 9, 1999 Jon Taylor rewrote the I/O subsystem
*
**********************************************************************
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation; either version 2 of
* the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public
* License along with this program; if not, write to the Free
* Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139,
* USA.
*
**********************************************************************
*/
#include <asm/io.h>
#include "hwaccess.h"
#include "8010.h"
#include "icardmid.h"
/*************************************************************************
* Function : srToPitch *
* Input : sampleRate - sampling rate *
* Return : pitch value *
* About : convert sampling rate to pitch *
* Note : for 8010, sampling rate is at 48kHz, this function should *
* be changed. *
*************************************************************************/
u32 srToPitch(u32 sampleRate)
{
int i;
/* FIXME: These tables should be defined in a headerfile */
static u32 logMagTable[128] = {
0x00000, 0x02dfc, 0x05b9e, 0x088e6, 0x0b5d6, 0x0e26f, 0x10eb3, 0x13aa2,
0x1663f, 0x1918a, 0x1bc84, 0x1e72e, 0x2118b, 0x23b9a, 0x2655d, 0x28ed5,
0x2b803, 0x2e0e8, 0x30985, 0x331db, 0x359eb, 0x381b6, 0x3a93d, 0x3d081,
0x3f782, 0x41e42, 0x444c1, 0x46b01, 0x49101, 0x4b6c4, 0x4dc49, 0x50191,
0x5269e, 0x54b6f, 0x57006, 0x59463, 0x5b888, 0x5dc74, 0x60029, 0x623a7,
0x646ee, 0x66a00, 0x68cdd, 0x6af86, 0x6d1fa, 0x6f43c, 0x7164b, 0x73829,
0x759d4, 0x77b4f, 0x79c9a, 0x7bdb5, 0x7dea1, 0x7ff5e, 0x81fed, 0x8404e,
0x86082, 0x88089, 0x8a064, 0x8c014, 0x8df98, 0x8fef1, 0x91e20, 0x93d26,
0x95c01, 0x97ab4, 0x9993e, 0x9b79f, 0x9d5d9, 0x9f3ec, 0xa11d8, 0xa2f9d,
0xa4d3c, 0xa6ab5, 0xa8808, 0xaa537, 0xac241, 0xadf26, 0xafbe7, 0xb1885,
0xb3500, 0xb5157, 0xb6d8c, 0xb899f, 0xba58f, 0xbc15e, 0xbdd0c, 0xbf899,
0xc1404, 0xc2f50, 0xc4a7b, 0xc6587, 0xc8073, 0xc9b3f, 0xcb5ed, 0xcd07c,
0xceaec, 0xd053f, 0xd1f73, 0xd398a, 0xd5384, 0xd6d60, 0xd8720, 0xda0c3,
0xdba4a, 0xdd3b4, 0xded03, 0xe0636, 0xe1f4e, 0xe384a, 0xe512c, 0xe69f3,
0xe829f, 0xe9b31, 0xeb3a9, 0xecc08, 0xee44c, 0xefc78, 0xf148a, 0xf2c83,
0xf4463, 0xf5c2a, 0xf73da, 0xf8b71, 0xfa2f0, 0xfba57, 0xfd1a7, 0xfe8df
};
static char logSlopeTable[128] = {
0x5c, 0x5c, 0x5b, 0x5a, 0x5a, 0x59, 0x58, 0x58,
0x57, 0x56, 0x56, 0x55, 0x55, 0x54, 0x53, 0x53,
0x52, 0x52, 0x51, 0x51, 0x50, 0x50, 0x4f, 0x4f,
0x4e, 0x4d, 0x4d, 0x4d, 0x4c, 0x4c, 0x4b, 0x4b,
0x4a, 0x4a, 0x49, 0x49, 0x48, 0x48, 0x47, 0x47,
0x47, 0x46, 0x46, 0x45, 0x45, 0x45, 0x44, 0x44,
0x43, 0x43, 0x43, 0x42, 0x42, 0x42, 0x41, 0x41,
0x41, 0x40, 0x40, 0x40, 0x3f, 0x3f, 0x3f, 0x3e,
0x3e, 0x3e, 0x3d, 0x3d, 0x3d, 0x3c, 0x3c, 0x3c,
0x3b, 0x3b, 0x3b, 0x3b, 0x3a, 0x3a, 0x3a, 0x39,
0x39, 0x39, 0x39, 0x38, 0x38, 0x38, 0x38, 0x37,
0x37, 0x37, 0x37, 0x36, 0x36, 0x36, 0x36, 0x35,
0x35, 0x35, 0x35, 0x34, 0x34, 0x34, 0x34, 0x34,
0x33, 0x33, 0x33, 0x33, 0x32, 0x32, 0x32, 0x32,
0x32, 0x31, 0x31, 0x31, 0x31, 0x31, 0x30, 0x30,
0x30, 0x30, 0x30, 0x2f, 0x2f, 0x2f, 0x2f, 0x2f
};
if (sampleRate == 0)
return 0; /* Bail out if no leading "1" */
sampleRate *= 11185; /* Scale 48000 to 0x20002380 */
for (i = 31; i > 0; i--) {
if (sampleRate & 0x80000000) { /* Detect leading "1" */
return (u32) (((s32) (i - 15) << 20) +
logMagTable[0x7f & (sampleRate >> 24)] +
(0x7f & (sampleRate >> 17)) * logSlopeTable[0x7f & (sampleRate >> 24)]);
}
sampleRate = sampleRate << 1;
}
DPF(2, "srToPitch: BUG!\n");
return 0; /* Should never reach this point */
}
/*******************************************
* write/read PCI function 0 registers *
********************************************/
void emu10k1_writefn0(struct emu10k1_card *card, u32 reg, u32 data)
{
unsigned long flags;
if (reg & 0xff000000) {
u32 mask;
u8 size, offset;
size = (reg >> 24) & 0x3f;
offset = (reg >> 16) & 0x1f;
mask = ((1 << size) - 1) << offset;
data = (data << offset) & mask;
reg &= 0x7f;
spin_lock_irqsave(&card->lock, flags);
data |= inl(card->iobase + reg) & ~mask;
outl(data, card->iobase + reg);
spin_unlock_irqrestore(&card->lock, flags);
} else {
spin_lock_irqsave(&card->lock, flags);
outl(data, card->iobase + reg);
spin_unlock_irqrestore(&card->lock, flags);
}
return;
}
#ifdef DBGEMU
void emu10k1_writefn0_2(struct emu10k1_card *card, u32 reg, u32 data, int size)
{
unsigned long flags;
spin_lock_irqsave(&card->lock, flags);
if (size == 32)
outl(data, card->iobase + (reg & 0x1F));
else if (size == 16)
outw(data, card->iobase + (reg & 0x1F));
else
outb(data, card->iobase + (reg & 0x1F));
spin_unlock_irqrestore(&card->lock, flags);
return;
}
#endif /* DBGEMU */
u32 emu10k1_readfn0(struct emu10k1_card * card, u32 reg)
{
u32 val;
unsigned long flags;
if (reg & 0xff000000) {
u32 mask;
u8 size, offset;
size = (reg >> 24) & 0x3f;
offset = (reg >> 16) & 0x1f;
mask = ((1 << size) - 1) << offset;
reg &= 0x7f;
spin_lock_irqsave(&card->lock, flags);
val = inl(card->iobase + reg);
spin_unlock_irqrestore(&card->lock, flags);
return (val & mask) >> offset;
} else {
spin_lock_irqsave(&card->lock, flags);
val = inl(card->iobase + reg);
spin_unlock_irqrestore(&card->lock, flags);
return val;
}
}
void emu10k1_timer_set(struct emu10k1_card * card, u16 data)
{
unsigned long flags;
spin_lock_irqsave(&card->lock, flags);
outw(data & TIMER_RATE_MASK, card->iobase + TIMER);
spin_unlock_irqrestore(&card->lock, flags);
}
/************************************************************************
* write/read Emu10k1 pointer-offset register set, accessed through *
* the PTR and DATA registers *
*************************************************************************/
#define A_PTR_ADDRESS_MASK 0x0fff0000
void sblive_writeptr(struct emu10k1_card *card, u32 reg, u32 channel, u32 data)
{
u32 regptr;
unsigned long flags;
regptr = ((reg << 16) & A_PTR_ADDRESS_MASK) | (channel & PTR_CHANNELNUM_MASK);
if (reg & 0xff000000) {
u32 mask;
u8 size, offset;
size = (reg >> 24) & 0x3f;
offset = (reg >> 16) & 0x1f;
mask = ((1 << size) - 1) << offset;
data = (data << offset) & mask;
spin_lock_irqsave(&card->lock, flags);
outl(regptr, card->iobase + PTR);
data |= inl(card->iobase + DATA) & ~mask;
outl(data, card->iobase + DATA);
spin_unlock_irqrestore(&card->lock, flags);
} else {
spin_lock_irqsave(&card->lock, flags);
outl(regptr, card->iobase + PTR);
outl(data, card->iobase + DATA);
spin_unlock_irqrestore(&card->lock, flags);
}
}
/* ... : data, reg, ... , TAGLIST_END */
void sblive_writeptr_tag(struct emu10k1_card *card, u32 channel, ...)
{
va_list args;
unsigned long flags;
u32 reg;
va_start(args, channel);
spin_lock_irqsave(&card->lock, flags);
while ((reg = va_arg(args, u32)) != TAGLIST_END) {
u32 data = va_arg(args, u32);
u32 regptr = (((reg << 16) & A_PTR_ADDRESS_MASK)
| (channel & PTR_CHANNELNUM_MASK));
outl(regptr, card->iobase + PTR);
if (reg & 0xff000000) {
int size = (reg >> 24) & 0x3f;
int offset = (reg >> 16) & 0x1f;
u32 mask = ((1 << size) - 1) << offset;
data = (data << offset) & mask;
data |= inl(card->iobase + DATA) & ~mask;
}
outl(data, card->iobase + DATA);
}
spin_unlock_irqrestore(&card->lock, flags);
va_end(args);
return;
}
u32 sblive_readptr(struct emu10k1_card * card, u32 reg, u32 channel)
{
u32 regptr, val;
unsigned long flags;
regptr = ((reg << 16) & A_PTR_ADDRESS_MASK) | (channel & PTR_CHANNELNUM_MASK);
if (reg & 0xff000000) {
u32 mask;
u8 size, offset;
size = (reg >> 24) & 0x3f;
offset = (reg >> 16) & 0x1f;
mask = ((1 << size) - 1) << offset;
spin_lock_irqsave(&card->lock, flags);
outl(regptr, card->iobase + PTR);
val = inl(card->iobase + DATA);
spin_unlock_irqrestore(&card->lock, flags);
return (val & mask) >> offset;
} else {
spin_lock_irqsave(&card->lock, flags);
outl(regptr, card->iobase + PTR);
val = inl(card->iobase + DATA);
spin_unlock_irqrestore(&card->lock, flags);
return val;
}
}
void emu10k1_irq_enable(struct emu10k1_card *card, u32 irq_mask)
{
u32 val;
unsigned long flags;
DPF(2,"emu10k1_irq_enable()\n");
spin_lock_irqsave(&card->lock, flags);
val = inl(card->iobase + INTE) | irq_mask;
outl(val, card->iobase + INTE);
spin_unlock_irqrestore(&card->lock, flags);
return;
}
void emu10k1_irq_disable(struct emu10k1_card *card, u32 irq_mask)
{
u32 val;
unsigned long flags;
DPF(2,"emu10k1_irq_disable()\n");
spin_lock_irqsave(&card->lock, flags);
val = inl(card->iobase + INTE) & ~irq_mask;
outl(val, card->iobase + INTE);
spin_unlock_irqrestore(&card->lock, flags);
return;
}
void emu10k1_clear_stop_on_loop(struct emu10k1_card *card, u32 voicenum)
{
/* Voice interrupt */
if (voicenum >= 32)
sblive_writeptr(card, SOLEH | ((0x0100 | (voicenum - 32)) << 16), 0, 0);
else
sblive_writeptr(card, SOLEL | ((0x0100 | voicenum) << 16), 0, 0);
return;
}
static void sblive_wcwait(struct emu10k1_card *card, u32 wait)
{
volatile unsigned uCount;
u32 newtime = 0, curtime;
curtime = emu10k1_readfn0(card, WC_SAMPLECOUNTER);
while (wait--) {
uCount = 0;
while (uCount++ < TIMEOUT) {
newtime = emu10k1_readfn0(card, WC_SAMPLECOUNTER);
if (newtime != curtime)
break;
}
if (uCount >= TIMEOUT)
break;
curtime = newtime;
}
}
u16 emu10k1_ac97_read(struct ac97_codec *codec, u8 reg)
{
struct emu10k1_card *card = codec->private_data;
u16 data;
unsigned long flags;
spin_lock_irqsave(&card->lock, flags);
outb(reg, card->iobase + AC97ADDRESS);
data = inw(card->iobase + AC97DATA);
spin_unlock_irqrestore(&card->lock, flags);
return data;
}
void emu10k1_ac97_write(struct ac97_codec *codec, u8 reg, u16 value)
{
struct emu10k1_card *card = codec->private_data;
unsigned long flags;
spin_lock_irqsave(&card->lock, flags);
outb(reg, card->iobase + AC97ADDRESS);
outw(value, card->iobase + AC97DATA);
outb( AC97_EXTENDED_ID, card->iobase + AC97ADDRESS);
spin_unlock_irqrestore(&card->lock, flags);
}
/*********************************************************
* MPU access functions *
**********************************************************/
int emu10k1_mpu_write_data(struct emu10k1_card *card, u8 data)
{
unsigned long flags;
int ret;
if (card->is_audigy) {
if ((sblive_readptr(card, A_MUSTAT,0) & MUSTAT_ORDYN) == 0) {
sblive_writeptr(card, A_MUDATA, 0, data);
ret = 0;
} else
ret = -1;
} else {
spin_lock_irqsave(&card->lock, flags);
if ((inb(card->iobase + MUSTAT) & MUSTAT_ORDYN) == 0) {
outb(data, card->iobase + MUDATA);
ret = 0;
} else
ret = -1;
spin_unlock_irqrestore(&card->lock, flags);
}
return ret;
}
int emu10k1_mpu_read_data(struct emu10k1_card *card, u8 * data)
{
unsigned long flags;
int ret;
if (card->is_audigy) {
if ((sblive_readptr(card, A_MUSTAT,0) & MUSTAT_IRDYN) == 0) {
*data = sblive_readptr(card, A_MUDATA,0);
ret = 0;
} else
ret = -1;
} else {
spin_lock_irqsave(&card->lock, flags);
if ((inb(card->iobase + MUSTAT) & MUSTAT_IRDYN) == 0) {
*data = inb(card->iobase + MUDATA);
ret = 0;
} else
ret = -1;
spin_unlock_irqrestore(&card->lock, flags);
}
return ret;
}
int emu10k1_mpu_reset(struct emu10k1_card *card)
{
u8 status;
unsigned long flags;
DPF(2, "emu10k1_mpu_reset()\n");
if (card->is_audigy) {
if (card->mpuacqcount == 0) {
sblive_writeptr(card, A_MUCMD, 0, MUCMD_RESET);
sblive_wcwait(card, 8);
sblive_writeptr(card, A_MUCMD, 0, MUCMD_RESET);
sblive_wcwait(card, 8);
sblive_writeptr(card, A_MUCMD, 0, MUCMD_ENTERUARTMODE);
sblive_wcwait(card, 8);
status = sblive_readptr(card, A_MUDATA, 0);
if (status == 0xfe)
return 0;
else
return -1;
}
return 0;
} else {
if (card->mpuacqcount == 0) {
spin_lock_irqsave(&card->lock, flags);
outb(MUCMD_RESET, card->iobase + MUCMD);
spin_unlock_irqrestore(&card->lock, flags);
sblive_wcwait(card, 8);
spin_lock_irqsave(&card->lock, flags);
outb(MUCMD_RESET, card->iobase + MUCMD);
spin_unlock_irqrestore(&card->lock, flags);
sblive_wcwait(card, 8);
spin_lock_irqsave(&card->lock, flags);
outb(MUCMD_ENTERUARTMODE, card->iobase + MUCMD);
spin_unlock_irqrestore(&card->lock, flags);
sblive_wcwait(card, 8);
spin_lock_irqsave(&card->lock, flags);
status = inb(card->iobase + MUDATA);
spin_unlock_irqrestore(&card->lock, flags);
if (status == 0xfe)
return 0;
else
return -1;
}
return 0;
}
}
int emu10k1_mpu_acquire(struct emu10k1_card *card)
{
/* FIXME: This should be a macro */
++card->mpuacqcount;
return 0;
}
int emu10k1_mpu_release(struct emu10k1_card *card)
{
/* FIXME: this should be a macro */
--card->mpuacqcount;
return 0;
}