kolibrios-fun/drivers/audio/a5536/geode.c

560 lines
14 KiB
C
Raw Normal View History

#define FORCED_PIO
#include <ddk.h>
#include "pci.h"
#include <syscall.h>
#include "geode.h"
#define DBG(format,...) dbgprintf(format,##__VA_ARGS__)
#define BM0_IRQ 0x04
#define BM1_IRQ 0x08
#define BITS_8_TO_16(x) ( ( (long) ((unsigned char) x - 128) ) << 8 )
#define PCI_VENDOR_ID_NS 0x100b
#define PCI_VENDOR_ID_AMD 0x1022
#ifndef PCI_DEVICE_ID_NS_CS5535_AUDIO
#define PCI_DEVICE_ID_NS_CS5535_AUDIO 0x002e
#endif
#ifndef PCI_DEVICE_ID_AMD_CS5536_AUDIO
#define PCI_DEVICE_ID_AMD_CS5536_AUDIO 0x2093
#endif
#define ID_DEV_1 ((PCI_DEVICE_ID_NS_CS5535_AUDIO << 16)|PCI_VENDOR_ID_NS)
#define ID_DEV_2 ((PCI_DEVICE_ID_AMD_CS5536_AUDIO << 16)|PCI_VENDOR_ID_AMD)
#define SET 1
#define CLEAR 0
int __stdcall srv_sound(ioctl_t *io);
PRD_ENTRY __attribute__((aligned(16))) prd_tab[5];
typedef struct
{
PCITAG pciTag;
Bool is_iomapped;
addr_t F3BAR0;
Bool fAD1819A;
int CurrentPowerState;
addr_t buffer;
addr_t prd_dma;
addr_t irq_line;
u32_t irq_mask;
void __stdcall (*callback)(addr_t buffer);
}geode_t;
geode_t geode;
static inline void ctrl_write_32(addr_t reg, u32_t data)
{
reg+= geode.F3BAR0;
#ifdef FORCED_PIO
out32((u16_t)reg, data);
#else
if(geode.is_iomapped)
out32((u16_t)reg, data);
else
*(u32_t*)reg = data;
#endif
}
static inline u32_t ctrl_read_32(addr_t reg)
{
reg+= geode.F3BAR0;
#ifdef FORCED_PIO
return in32((u16_t)reg);
#else
if(geode.is_iomapped)
return in32((u16_t)reg);
else
return *(u32_t*)reg;
#endif
}
Bool snd_hw_WaitForBit(addr_t offset, u32_t Bit,
unsigned char Operation,
count_t timeout,
u32_t *pReturnValue)
{
volatile u32_t tmp;
tmp = ctrl_read_32(offset);
while (timeout)
{
if (Operation==CLEAR){
if (!(tmp & Bit))
break;
} else if (tmp & Bit)
break;
/*If the Bit is not clear yet, we wait for 10 milisecond and try again*/
delay(10/10);
tmp = ctrl_read_32(offset);
timeout--;
};
if (pReturnValue)
*pReturnValue=tmp;
if (!timeout)
return FALSE;
return TRUE;
}
u16_t snd_hw_CodecRead ( u8_t CodecRegister )
{
u32_t CodecRegister_data = 0;
u32_t timeout=10;
volatile u32_t val=0;
CodecRegister_data = ((u32_t)CodecRegister)<<24;
CodecRegister_data |= 0x80000000; /* High-bit set (p.106) is a CODEC reg READ.*/
/* Set the bit. We are going to access the CODEC...*/
CodecRegister_data |= BIT_5535_CODEC_COMMAND_NEW;
/*Request the data*/
ctrl_write_32(CODEC_CONTROL_REG_5535, CodecRegister_data);
/* Now we need to wait for BIT_5535_CODEC_COMMAND_NEW of the Codec control register to clear
(For subsequent Reads/Writes)*/
if (!snd_hw_WaitForBit (CODEC_CONTROL_REG_5535,
BIT_5535_CODEC_COMMAND_NEW, CLEAR, 50, NULL))
DBG("BIT_5535_CODEC_COMMAND_NEW did not clear!!\n");
/* Wait for CODEC_STATUS_NEW and confirm the read of the requested register*/
timeout = 50;
do
{
val = ctrl_read_32(CODEC_STATUS_REG_5535);
if ((val & BIT_5535_CODEC_STATUS_NEW) &&
((u32_t) CodecRegister == ((0xFF000000 & val)>>24)))
break;
else
/*Wait for 10 miliseconds and try again*/
delay(10/10);
} while ( --timeout);
if (!timeout)
DBG("Could not read the CODEC!! Returning what we got.\n");
return( (u16_t)val );
}
void snd_hw_CodecWrite( u8_t CodecRegister, u16_t CodecData )
{
u32_t CodecRegister_data;
u32_t Temp, timeout;
CodecRegister_data = ((u32_t) CodecRegister)<<24;
CodecRegister_data |= (u32_t) CodecData;
CodecRegister_data &= CODEC_COMMAND_MASK;
/*Set the bit. We are going to access the CODEC...*/
CodecRegister_data |= BIT_5535_CODEC_COMMAND_NEW;
/*Write the data*/
ctrl_write_32(CODEC_CONTROL_REG_5535, CodecRegister_data);
//OS_DbgMsg("Writing: %08X\n", CodecRegister_data);
/*We need to wait for bit16 of the Codec control register to clear*/
Temp = ctrl_read_32(CODEC_CONTROL_REG_5535);
timeout = 50;
while ((Temp & BIT_5535_CODEC_COMMAND_NEW) && timeout-- )
Temp = ctrl_read_32(CODEC_CONTROL_REG_5535);
if (!timeout)
DBG("Could not Write the CODEC!!\n"
"BIT_5535_CODEC_COMMAND_NEW did not clear!\n");
}
void snd_hw_SetCodecRate(u32_t SampleRate)
{
u16_t val;
DBG("Rate: %d\n", SampleRate);
/*If Double-Rate is supported (Bit 2 on register 28h)...*/
val=snd_hw_CodecRead(EXTENDED_AUDIO_ID);
if (val & 0x02)
{
DBG("Codec supports Double rate.\n");
val=snd_hw_CodecRead(EXT_AUDIO_CTRL_STAT);
if (SampleRate>48000)
{
snd_hw_CodecWrite(EXT_AUDIO_CTRL_STAT, (u16_t) (val|0x0002));
SampleRate/=2;
}
else
snd_hw_CodecWrite(EXT_AUDIO_CTRL_STAT, (u16_t) (val&0xFFFD));
}
if (geode.fAD1819A)
{
DBG("AD1819...\n");
snd_hw_CodecWrite(AD1819A_PCM_SR0,(u16_t)SampleRate);
}
else
snd_hw_CodecWrite(PCM_FRONT_DAC_RATE,(u16_t)SampleRate);
}
Bool init_device()
{
u32_t io_base = pciReadLong(geode.pciTag, 0x10);
if( PCI_MAP_IS_IO(io_base))
{
geode.is_iomapped = TRUE;
geode.F3BAR0 = PCIGETIO(io_base);
DBG("io mapped F3BAR0 %x\n", geode.F3BAR0);
}
else if(PCI_MAP_IS_MEM(io_base))
{
geode.is_iomapped = FALSE;
io_base = PCIGETMEMORY(io_base);
geode.F3BAR0 = MapIoMem(io_base, 128, PG_SW+PG_NOCACHE);
DBG("memory mapped F3BAR0 %x\n", geode.F3BAR0);
}
geode.buffer = KernelAlloc(64*1024);
addr_t buffer = geode.buffer;
addr_t dma = GetPgAddr(geode.buffer);
geode.prd_dma = (((addr_t)prd_tab) & 4095) + GetPgAddr((void*)prd_tab);
prd_tab[0].ulPhysAddr = dma;
prd_tab[0].SizeFlags = 16384 | PRD_EOP_BIT ;
prd_tab[1].ulPhysAddr = dma + 16384;
prd_tab[1].SizeFlags = 16384 | PRD_EOP_BIT ;
prd_tab[2].ulPhysAddr = dma + 16384*2;
prd_tab[2].SizeFlags = 16384 | PRD_EOP_BIT ;
prd_tab[3].ulPhysAddr = dma + 16384*3;
prd_tab[3].SizeFlags = 16384 | PRD_EOP_BIT ;
prd_tab[4].ulPhysAddr = geode.prd_dma;
prd_tab[4].SizeFlags = PRD_JMP_BIT ;
ctrl_write_32(0x24, geode.prd_dma);
__clear((void*)buffer,64*1024);
// u32_t tmp = ctrl_read_32(0x24);
// dbgprintf("Create primary buffer at %x dma at %x\n", geode.buffer, dma );
// dbgprintf("Set prd dma %x, read prd dma %x\n", geode.prd_dma, tmp);
geode.irq_line = pciReadLong(geode.pciTag, 0x3C) & 0xFF;
geode.irq_mask = ~(1<<geode.irq_line);
DBG("Irq line %d, mask %x\n", geode.irq_line, geode.irq_mask);
/*
geode.CommandRegister = geode.F3BAR0+0x20;
geode.PRDTableAddress = geode.F3BAR0+0x24;
geode.DMAPointer = geode.F3BAR0+0x60;
geode.IRQControlRegister = geode.F3BAR0+0x1C;
geode.InternalIRQEnableRegister = geode.F3BAR0+0x1A;
geode.SMI_StatusRegister = geode.F3BAR0+0x21;
*/
/*CODEC - RESET and volumes initalization.*/
/*Set the Warm RESET and CODEC_COMMAND_NEW bits.*/
DBG("reset codec...\n");
ctrl_write_32(CODEC_CONTROL_REG_5535, 0x00030000 );
if (!snd_hw_WaitForBit (CODEC_STATUS_REG_5535, BIT_CODEC_READY, SET, 40, NULL))
{
DBG("Primary Codec NOT Ready...Aborting\n");
return FALSE;
}
u16_t id7c, id7e;
id7c = snd_hw_CodecRead(AD1819A_VENDORID1);
id7e = snd_hw_CodecRead(AD1819A_VENDORID2);
dbgprintf("codec id 0x7C %x 0x7E %x\n", id7c, id7e);
/*Check which codec is being used */
if ( (id7c == 0x4144) &&
(id7e == 0x5303) )
{
geode.fAD1819A = TRUE;
/* Enable non-48kHz sample rates. */
snd_hw_CodecWrite (AD1819A_SER_CONF,
snd_hw_CodecRead(AD1819A_SER_CONF>>8) |
AD1819A_SER_CONF_DRQEN);
DBG("detect AD1819A audio codec\n");
}
else
{
geode.fAD1819A = FALSE;
snd_hw_CodecWrite(EXT_AUDIO_CTRL_STAT,
(snd_hw_CodecRead(EXT_AUDIO_CTRL_STAT) | 0x0001));
/* set the VRA bit to ON*/
}
/* set default volume*/
snd_hw_CodecWrite( MASTER_VOLUME, 0x0909);
snd_hw_CodecWrite( PCM_OUT_VOL, 0x0606);
snd_hw_CodecWrite( PC_BEEP_VOLUME, 0x0000);
snd_hw_CodecWrite( PHONE_VOLUME, 0x0606);
snd_hw_CodecWrite( MIC_VOLUME, 0x8048);
snd_hw_CodecWrite( LINE_IN_VOLUME, 0x0808);
snd_hw_CodecWrite( CD_VOLUME, 0x8000);
snd_hw_CodecWrite( VIDEO_VOLUME, 0x8000);
snd_hw_CodecWrite( TV_VOLUME, 0x8000);
snd_hw_CodecWrite( RECORD_SELECT, 0x0000);
snd_hw_CodecWrite( RECORD_GAIN, 0x0a0a);
snd_hw_CodecWrite( GENERAL_PURPOSE, 0x0200);
snd_hw_CodecWrite( MASTER_VOLUME_MONO, 0x0000);
snd_hw_SetCodecRate(48000);
/*Set all the power state bits to 0 (Reg 26h)*/
snd_hw_CodecWrite (POWERDOWN_CTRL_STAT, 0x0000);
geode.CurrentPowerState = GEODEAUDIO_D0;
// OS_DbgMsg("<--snd_hw_InitAudioRegs\n");
return TRUE;
}
static int snd_StartDMA ()
{
#ifdef FORCED_PIO
out8( (u16_t)(geode.F3BAR0+0x20),PCI_READS | ENABLE_BUSMASTER);
#else
if (geode.is_iomapped)
out8( (u16_t)(geode.F3BAR0+0x20),PCI_READS | ENABLE_BUSMASTER);
else
*(u8_t*)(geode.F3BAR0+0x20)= PCI_READS | ENABLE_BUSMASTER;
#endif
return 0;
};
static u8_t snd_hw_InterruptID ()
{
volatile u8_t *TempInterruptID, ID;
#ifdef FORCED_PIO
ID=(u8_t) in16((u16_t)(geode.F3BAR0 + 0x12));
#else
if (geode.is_iomapped)
ID=(u8_t) in16((u16_t)(geode.F3BAR0 + 0x12));
else
{
TempInterruptID=(u8_t*)(geode.F3BAR0 + 0x12);
ID=*TempInterruptID;
}
#endif
return (ID);
}
static u8_t snd_hw_ClearStat(int Channel)
{
volatile u8_t status; /*Volatile to force read-to-clear.*/
/*Read to clear*/
#ifdef FORCED_PIO
status = in8((u16_t) geode.F3BAR0 + 0x21);
#else
if (geode.is_iomapped)
status = in8((u16_t) geode.F3BAR0 + 0x21);
else
status = *((u8_t*)geode.F3BAR0 + 0x21);
#endif
return status;
}
void snd_interrupt()
{
u8_t IntID;
IntID = snd_hw_InterruptID();
// dbgprintf("IRQ id %x\n", IntID);
snd_hw_ClearStat(CHANNEL0_PLAYBACK);
// snd_hw_ClearStat(CHANNEL1_RECORD);
if(IntID & BM0_IRQ)
{
addr_t prd, offset, base;
prd = ctrl_read_32(0x24);
offset = (1 + (prd - geode.prd_dma)>>3) & 3;
base = geode.buffer + 16384*offset;
geode.callback(base);
__asm__ volatile("":::"ebx","esi","edi");
// dbgprintf(">>BM0_IRQ prd %x offset %x base %x\n", prd, offset, base);
};
};
Bool FindPciDevice()
{
u32_t bus, last_bus;
PCITAG tag;
if( (last_bus = PciApi(1))==-1)
return FALSE;
for(bus=0;bus<=last_bus;bus++)
{
u32_t devfn;
for(devfn=0;devfn<256;devfn++)
{
u32_t pciId=0;
pciId = PciRead32(bus,devfn, 0);
if( (pciId == ID_DEV_1) ||
(pciId == ID_DEV_2) )
{
DBG("detect companion audio device %x\n", pciId);
geode.pciTag = pciTag(bus,(devfn>>3)&0x1F,devfn&0x7);
return TRUE;
};
};
};
return FALSE;
};
u32_t drvEntry(int action, char *cmdline)
{
u32_t retval;
int i;
if(action != 1)
return 0;
if(!dbg_open("/rd/1/drivers/geode.log"))
{
printf("Can't open /rd/1/drivers/geode.log\nExit\n");
return 0;
}
if( FindPciDevice() == FALSE)
{
dbgprintf("Device not found\n");
return 0;
};
init_device();
retval = RegService("SOUND", srv_sound);
AttachIntHandler(geode.irq_line, snd_interrupt, 0);
DBG("reg service %s as: %x\n", "SOUND", retval);
return retval;
};
#define API_VERSION 0x01000100
#define SRV_GETVERSION 0
#define DEV_PLAY 1
#define DEV_STOP 2
#define DEV_CALLBACK 3
#define DEV_SET_BUFF 4
#define DEV_NOTIFY 5
#define DEV_SET_MASTERVOL 6
#define DEV_GET_MASTERVOL 7
#define DEV_GET_INFO 8
#define DEV_GET_POS 9
int __stdcall srv_sound(ioctl_t *io)
{
u32_t *inp;
u32_t *outp;
inp = io->input;
outp = io->output;
switch(io->io_code)
{
case SRV_GETVERSION:
if(io->out_size==4)
{
*outp = API_VERSION;
return 0;
}
break;
case DEV_PLAY:
return snd_StartDMA();
break;
case DEV_STOP:
break;
case DEV_CALLBACK:
if(io->inp_size==4)
{
geode.callback = (void*)(*inp);
return 0;
}
break;
case DEV_GET_POS:
if(io->out_size==4)
{
*outp = ctrl_read_32(0x60)>>2;
return 0;
}
break;
default:
return ERR_PARAM;
};
return ERR_PARAM;
}