Subversion Repositories Kolibri OS

#include 

#include 

#include "geode.h"

#define DBG(format,...) dbgprintf(format,##__VA_ARGS__)

#define  BM0_IRQ            0x04

#define BITS_8_TO_16(x) ( ( (long) ((unsigned char) x - 128) ) << 8 )

#define PCI_VENDOR_ID_NS  0x100b

#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 SET                 1

int __stdcall srv_sound(ioctl_t *io);

    PCITAG  pciTag;

    Bool    is_iomapped;

    addr_t  F3BAR0;

    Bool    fAD1819A;

    int     CurrentPowerState;

    addr_t  buffer;

    addr_t  prd_dma;

    addr_t  irq_line;

    void    __stdcall (*callback)(addr_t buffer);

geode_t  geode;

    reg+= geode.F3BAR0;

#ifdef FORCED_PIO

#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

}

                              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*/

        tmp = ctrl_read_32(offset);

        timeout--;

    if (pReturnValue)

    if (!timeout)

    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;

/*  Set the bit.  We are going to access the CODEC...*/

/*Request the data*/

/*  Now we need to wait for BIT_5535_CODEC_COMMAND_NEW of the Codec control register to clear

    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*/

    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)

    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 &= CODEC_COMMAND_MASK;

    /*Set the bit.  We are going to access the CODEC...*/

    /*Write the data*/

    //OS_DbgMsg("Writing: %08X\n", CodecRegister_data);

    /*We need to wait for bit16 of the Codec control register to clear*/

    timeout = 50;

    while ((Temp & BIT_5535_CODEC_COMMAND_NEW) && timeout-- )

    if (!timeout)

                  "BIT_5535_CODEC_COMMAND_NEW did not clear!\n");

}

    u16_t val;

    DBG("Rate: %d\n", SampleRate);

    /*If Double-Rate is supported (Bit 2 on register 28h)...*/

    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;

    geode.buffer_dma = dma;

    geode.prd_dma  = (((addr_t)prd_tab) & 4095) + GetPgAddr((void*)prd_tab);

    prd_tab[0].ulPhysAddr = dma;

    prd_tab[1].ulPhysAddr = dma + 16384;

    prd_tab[2].ulPhysAddr = dma + 16384*2;

    prd_tab[3].ulPhysAddr = dma + 16384*3;

    prd_tab[4].ulPhysAddr = geode.prd_dma;

    ctrl_write_32(0x24, geode.prd_dma);

    __clear((void*)buffer,64*1024);

//    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;

    DBG("Irq line %d, mask %x\n", geode.irq_line, geode.irq_mask);

    geode.PRDTableAddress  = geode.F3BAR0+0x24;

    geode.DMAPointer       = geode.F3BAR0+0x60;

    geode.IRQControlRegister        = geode.F3BAR0+0x1C;

    geode.SMI_StatusRegister        = geode.F3BAR0+0x21;

*/

    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);

    dbgprintf("codec id 0x7C %x  0x7E %x\n", id7c, id7e);

    /*Check which codec is being used */

         (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( 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);

    snd_hw_CodecWrite (POWERDOWN_CTRL_STAT, 0x0000);

    geode.CurrentPowerState = GEODEAUDIO_D0;

//    OS_DbgMsg("<--snd_hw_InitAudioRegs\n");

static int snd_StartDMA ()

#ifdef FORCED_PIO

#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

#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);

}

    volatile u8_t status;      /*Volatile to force read-to-clear.*/

    /*Read to clear*/

#ifdef FORCED_PIO

#else

    if (geode.is_iomapped)

        status = in8((u16_t) geode.F3BAR0 + 0x21);

    else

        status = *((u8_t*)geode.F3BAR0 + 0x21);

#endif

    return status;

}

    u8_t IntID;

    IntID = snd_hw_InterruptID();

//    dbgprintf("IRQ id %x\n", IntID);

    snd_hw_ClearStat(CHANNEL0_PLAYBACK);

    if(IntID & BM0_IRQ)

      addr_t prd, offset, base;

      prd = ctrl_read_32(0x24);

      base = geode.buffer + 16384*offset;

      geode.callback(base);

//      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)

    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) ||

            {

                DBG("detect companion audio device %x\n", pciId);

                geode.pciTag = pciTag(bus,(devfn>>3)&0x1F,devfn&0x7);

                return TRUE;

            };

        };

    };

    return FALSE;

};

    u32_t retval;

    int i;

    if(action != 1)

    if(!dbg_open("/rd/1/drivers/geode.log"))

        printf("Can't open /rd/1/drivers/geode.log\nExit\n");

        return 0;

    }

    printf("AMD Geode CS5536 audio driver\n");

    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 SRV_GETVERSION         0

#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;

    switch(io->io_code)

        case SRV_GETVERSION:

            if(io->out_size==4)

            {

                *outp = API_VERSION;

                return 0;

            }

            break;

        case DEV_PLAY:

            break;

        case DEV_STOP:

        case DEV_CALLBACK:

            {

                geode.callback = (void*)(*inp);

                return 0;

            }

            break;

        case DEV_GET_POS:

            {

                u32_t  dma;

                dma = ctrl_read_32(0x60);

                dma-= geode.buffer_dma;

                *outp = (dma & 16383)>>2;

                return 0;

            }

            break;

    default:

  };

  return ERR_PARAM;

}

>

>