#include <KernelExport.h>
#include <OS.h>
#include "io.h"
#include "auviareg.h"
#include "debug.h"
#include <PCI.h>
extern pci_module_info *pci;
uint8
auvia_reg_read_8(device_config *config, int regno)
{
return pci->read_io_8(config->nabmbar + regno);
}
uint16
auvia_reg_read_16(device_config *config, int regno)
{
return pci->read_io_16(config->nabmbar + regno);
}
uint32
auvia_reg_read_32(device_config *config, int regno)
{
return pci->read_io_32(config->nabmbar + regno);
}
void
auvia_reg_write_8(device_config *config, int regno, uint8 value)
{
pci->write_io_8(config->nabmbar + regno, value);
}
void
auvia_reg_write_16(device_config *config, int regno, uint16 value)
{
pci->write_io_16(config->nabmbar + regno, value);
}
void
auvia_reg_write_32(device_config *config, int regno, uint32 value)
{
pci->write_io_32(config->nabmbar + regno, value);
}
#define AUVIA_TIMEOUT 200
static int
auvia_codec_waitready(device_config *config)
{
int i;
for(i = 0; (i < AUVIA_TIMEOUT) && (pci->read_io_32(config->nabmbar
+ AUVIA_CODEC_CTL) & AUVIA_CODEC_BUSY) ; i++)
spin(1);
if(i>=AUVIA_TIMEOUT) {
return B_ERROR;
}
return B_OK;
}
static int
auvia_codec_waitvalid(device_config *config)
{
int i;
for(i = 0; (i < AUVIA_TIMEOUT) && !(pci->read_io_32(config->nabmbar
+ AUVIA_CODEC_CTL) & AUVIA_CODEC_PRIVALID) ; i++)
spin(1);
if(i>=AUVIA_TIMEOUT) {
return B_ERROR;
}
return B_OK;
}
uint16
auvia_codec_read(device_config *config, int regno)
{
if(auvia_codec_waitready(config)!=B_OK) {
PRINT(("codec busy (1)\n"));
return -1;
}
pci->write_io_32(config->nabmbar + AUVIA_CODEC_CTL,
AUVIA_CODEC_PRIVALID | AUVIA_CODEC_READ | AUVIA_CODEC_INDEX(regno));
if(auvia_codec_waitready(config)!=B_OK) {
PRINT(("codec busy (2)\n"));
return -1;
}
if(auvia_codec_waitvalid(config)!=B_OK) {
PRINT(("codec invalid (3)\n"));
return -1;
}
return pci->read_io_16(config->nabmbar + AUVIA_CODEC_CTL);
}
void
auvia_codec_write(device_config *config, int regno, uint16 value)
{
if(auvia_codec_waitready(config)!=B_OK) {
PRINT(("codec busy (4)\n"));
return;
}
pci->write_io_32(config->nabmbar + AUVIA_CODEC_CTL,
AUVIA_CODEC_PRIVALID | AUVIA_CODEC_INDEX(regno) | value);
}