diff mbox

Add AACI audio playback support to the versatilepb platform

Message ID 8912a7abe07b630be39a43fe518899eb.squirrel@webmail.elasticsheep.com
State New
Headers show

Commit Message

contact@elasticsheep.com Oct. 14, 2010, 1:29 p.m. UTC
[PATCH] Add AACI audio playback support to the versatilepb platform

The PL041 driver provides an interface to an ACLink bus.
The LM4549 driver emulates a DAC connected on the ACLink bus.

Test environment:
linux-2.6.26
alsa-lib-1.0.22
alsa-utils-1.0.22

Signed-off-by: Mathieu Sonet <contact@elasticsheep.com>
---
 Makefile.target  |    1 +
 hw/aclink.c      |  121 ++++++++++++++++
 hw/aclink.h      |   56 +++++++
 hw/lm4549.c      |  368 ++++++++++++++++++++++++++++++++++++++++++++++
 hw/pl041.c       |  425
++++++++++++++++++++++++++++++++++++++++++++++++++++++
 hw/pl041.h       |  119 +++++++++++++++
 hw/pl041.hx      |   55 +++++++
 hw/versatilepb.c |    6 +
 8 files changed, 1151 insertions(+), 0 deletions(-)
 create mode 100644 hw/aclink.c
 create mode 100644 hw/aclink.h
 create mode 100644 hw/lm4549.c
 create mode 100644 hw/pl041.c
 create mode 100644 hw/pl041.h
 create mode 100644 hw/pl041.hx

Comments

malc Oct. 14, 2010, 2:55 p.m. UTC | #1
On Thu, 14 Oct 2010, contact@elasticsheep.com wrote:

> [PATCH] Add AACI audio playback support to the versatilepb platform
> 
> The PL041 driver provides an interface to an ACLink bus.
> The LM4549 driver emulates a DAC connected on the ACLink bus.
> 
> Test environment:
> linux-2.6.26
> alsa-lib-1.0.22
> alsa-utils-1.0.22
> 
> Signed-off-by: Mathieu Sonet <contact@elasticsheep.com>
> ---
>  Makefile.target  |    1 +
>  hw/aclink.c      |  121 ++++++++++++++++
>  hw/aclink.h      |   56 +++++++
>  hw/lm4549.c      |  368 ++++++++++++++++++++++++++++++++++++++++++++++
>  hw/pl041.c       |  425
> ++++++++++++++++++++++++++++++++++++++++++++++++++++++
>  hw/pl041.h       |  119 +++++++++++++++
>  hw/pl041.hx      |   55 +++++++
>  hw/versatilepb.c |    6 +
>  8 files changed, 1151 insertions(+), 0 deletions(-)
>  create mode 100644 hw/aclink.c
>  create mode 100644 hw/aclink.h
>  create mode 100644 hw/lm4549.c
>  create mode 100644 hw/pl041.c
>  create mode 100644 hw/pl041.h
>  create mode 100644 hw/pl041.hx
> 
> diff --git a/Makefile.target b/Makefile.target
> index 7c1f30c..eec028d 100644
> --- a/Makefile.target
> +++ b/Makefile.target
> @@ -270,6 +270,7 @@ obj-arm-y += versatile_pci.o
>  obj-arm-y += realview_gic.o realview.o arm_sysctl.o arm11mpcore.o a9mpcore.o
>  obj-arm-y += armv7m.o armv7m_nvic.o stellaris.o pl022.o stellaris_enet.o
>  obj-arm-y += pl061.o
> +obj-arm-y += pl041.o aclink.o lm4549.o
>  obj-arm-y += arm-semi.o
>  obj-arm-y += pxa2xx.o pxa2xx_pic.o pxa2xx_gpio.o pxa2xx_timer.o pxa2xx_dma.o
>  obj-arm-y += pxa2xx_lcd.o pxa2xx_mmci.o pxa2xx_pcmcia.o pxa2xx_keypad.o
> diff --git a/hw/aclink.c b/hw/aclink.c
> new file mode 100644
> index 0000000..cc2d38c
> --- /dev/null
> +++ b/hw/aclink.c
> @@ -0,0 +1,121 @@
> +/*
> + * ACLink Interface
> + *
> + * Copyright (c) 2010
> + * Written by Mathieu Sonet - www.elasticsheep.com
> + *
> + * This code is licenced under the GPL.
> + *
> + * *****************************************************************
> + *
> + * This file defines the ACLink bus interface to exchange data
> + * between an host and a codec.
> + *
> + */
> +
> +#include "aclink.h"
> +
> +/*** Types ***/
> +
> +struct ACLinkBus {
> +    BusState qbus;
> +    ACLinkControllerInfo* controller_info;
> +    uint32_t bitclk;
> +};
> +
> +struct BusInfo aclink_bus_info = {
> +    .name = "aclink",
> +    .size = sizeof(ACLinkBus),
> +};
> +
> +/*** Functions ***/
> +
> +ACLinkBus *aclink_create_bus(DeviceState *parent, const char *name)
> +{
> +    BusState *bus;
> +    bus = qbus_create(&aclink_bus_info, parent, name);
> +    return FROM_QBUS(ACLinkBus, bus);
> +}
> +
> +void aclink_set_controller_info(ACLinkBus *bus, ACLinkControllerInfo *info)
> +{
> +    bus->controller_info = info;
> +}
> +
> +static int aclink_device_init(DeviceState *dev, DeviceInfo *base_info)
> +{
> +    ACLinkDeviceInfo *info = container_of(base_info, ACLinkDeviceInfo,
> qdev);
> +    ACLinkDevice *s = ACLINK_DEVICE_FROM_QDEV(dev);
> +    ACLinkBus *bus;
> +
> +    bus = FROM_QBUS(ACLinkBus, qdev_get_parent_bus(dev));
> +    if (QLIST_FIRST(&bus->qbus.children) != dev
> +        || QLIST_NEXT(dev, sibling) != NULL) {
> +        hw_error("Too many devices on the ACLINK bus");
> +    }
> +
> +    s->info = info;
> +    return info->init(s);
> +}
> +
> +void aclink_register_device(ACLinkDeviceInfo *info)
> +{
> +    assert(info->qdev.size >= sizeof(ACLinkDevice));
> +    info->qdev.init = aclink_device_init;
> +    info->qdev.bus_info = &aclink_bus_info;
> +    qdev_register(&info->qdev);
> +}
> +
> +DeviceState *aclink_create_device(ACLinkBus *bus, const char *name)
> +{
> +    DeviceState *dev;
> +    dev = qdev_create(&bus->qbus, name);
> +    qdev_init_nofail(dev);
> +    return dev;
> +}
> +
> +static ACLinkDevice* aclink_get_device(ACLinkBus *bus)
> +{
> +    DeviceState *dev = QLIST_FIRST(&bus->qbus.children);
> +    if (!dev) {
> +        return NULL;
> +    }
> +    return ACLINK_DEVICE_FROM_QDEV(dev);
> +}
> +
> +void aclink_bitclk_enable(ACLinkDevice *dev, uint32_t on)
> +{
> +    ACLinkBus *bus = FROM_QBUS(ACLinkBus, qdev_get_parent_bus(&dev->qdev));
> +    uint32_t has_changed;
> +
> +    on = (on > 0) ? 1 : 0;
> +    has_changed = (bus->bitclk != on) ? 1 : 0;
> +
> +    bus->bitclk = on;
> +    if (has_changed) {
> +        bus->controller_info->bitclk_state_changed(bus->qbus.parent);
> +    }
> +}
> +
> +uint32_t aclink_bitclk_is_enabled(ACLinkBus *bus)
> +{
> +    return bus->bitclk;
> +}
> +
> +void aclink_sdataout_slot12(ACLinkBus *bus, uint32_t slot1, uint32_t slot2)
> +{
> +    ACLinkDevice *device = aclink_get_device(bus);
> +    device->info->sdataout_slot12(device, slot1, slot2);
> +}
> +
> +void aclink_sdataout_slot34(ACLinkBus *bus, uint32_t slot3, uint32_t slot4)
> +{
> +    ACLinkDevice *device = aclink_get_device(bus);
> +    device->info->sdataout_slot34(device, slot3, slot4);
> +}
> +
> +void aclink_sdatain_slot12(ACLinkDevice *dev, uint32_t slot1, uint32_t
> slot2)
> +{
> +    ACLinkBus *bus = FROM_QBUS(ACLinkBus, qdev_get_parent_bus(&dev->qdev));
> +    bus->controller_info->sdatain_slot12(bus->qbus.parent, slot1, slot2);
> +}
> diff --git a/hw/aclink.h b/hw/aclink.h
> new file mode 100644
> index 0000000..eddf759
> --- /dev/null
> +++ b/hw/aclink.h
> @@ -0,0 +1,56 @@
> +/*
> + * ACLink Interface
> + *
> + * Copyright (c) 2010
> + * Written by Mathieu Sonet - www.elasticsheep.com
> + *
> + */

This is incomplete and actually disallows any use.

> +
> +#ifndef ACLINK_H
> +#define ACLINK_H
> +
> +#include "qdev.h"
> +
> +typedef struct ACLinkBus ACLinkBus;
> +typedef struct ACLinkDevice ACLinkDevice;
> +
> +/* Controller */
> +typedef struct {
> +    void (*sdatain_slot12)(DeviceState *dev, uint32_t slot1, uint32_t
> slot2);
> +    void (*bitclk_state_changed)(DeviceState *dev);
> +} ACLinkControllerInfo;
> +
> +/* Device  */
> +typedef struct {
> +    DeviceInfo qdev;
> +    int (*init)(ACLinkDevice *dev);
> +    void (*sdataout_slot12)(ACLinkDevice *dev, uint32_t slot1, uint32_t
> slot2);
> +    void (*sdataout_slot34)(ACLinkDevice *dev, uint32_t slot3, uint32_t
> slot4);
> +} ACLinkDeviceInfo;
> +
> +struct ACLinkDevice {
> +    DeviceState qdev;
> +    ACLinkDeviceInfo *info;
> +};
> +
> +#define ACLINK_DEVICE_FROM_QDEV(dev) DO_UPCAST(ACLinkDevice, qdev, dev)
> +#define FROM_ACLINK_DEVICE(type, dev) DO_UPCAST(type, aclinkdev, dev)
> +
> +ACLinkBus *aclink_create_bus(DeviceState *parent, const char *name);
> +void aclink_set_controller_info(ACLinkBus *bus, ACLinkControllerInfo *info);
> +
> +DeviceState *aclink_create_device(ACLinkBus *bus, const char *name);
> +void aclink_register_device(ACLinkDeviceInfo *info);
> +
> +/* Common interface */
> +uint32_t aclink_bitclk_is_enabled(ACLinkBus *bus);
> +
> +/* Controller => device interface */
> +void aclink_sdataout_slot12(ACLinkBus *bus, uint32_t slot1, uint32_t slot2);
> +void aclink_sdataout_slot34(ACLinkBus *bus, uint32_t slot3, uint32_t slot4);
> +
> +/* Device => controller interface */
> +void aclink_sdatain_slot12(ACLinkDevice *bus, uint32_t slot1, uint32_t
> slot2);
> +void aclink_bitclk_enable(ACLinkDevice *dev, uint32_t on);
> +
> +#endif
> diff --git a/hw/lm4549.c b/hw/lm4549.c
> new file mode 100644
> index 0000000..9439b61
> --- /dev/null
> +++ b/hw/lm4549.c
> @@ -0,0 +1,368 @@
> +/*
> + * LM4549 Audio Codec Interface
> + *
> + * Copyright (c) 2010
> + * Written by Mathieu Sonet - www.elasticsheep.com
> + *
> + * This code is licenced under the GPL.
> + *
> + * *****************************************************************
> + *
> + * This driver emulates the LM4549 codec connected on an ACLINK bus.
> + *
> + */
> +
> +#include "sysbus.h"
> +#include "aclink.h"
> +
> +#include "audio/audio.h"
> +
> +/* #define LM4549_DEBUG  1 */
> +/* #define LM4549_DUMP_DAC_INPUT 1 */
> +
> +#ifdef LM4549_DEBUG
> +#define DPRINTF(fmt, ...) \
> +do { printf("lm4549: " fmt , ## __VA_ARGS__); } while (0)
> +#else
> +#define DPRINTF(fmt, ...) do {} while(0)
> +#endif
> +
> +#if defined(LM4549_DUMP_DAC_INPUT)
> +#include <stdio.h>
> +static FILE* fp_dac_input = NULL;
> +#endif
> +
> +/*** Prototypes ***/
> +void lm4549_sdataout_slot12(ACLinkDevice *dev, uint32_t slot1, uint32_t
> slot2);
> +void lm4549_sdataout_slot34(ACLinkDevice *dev, uint32_t slot3, uint32_t
> slot4);
> +
> +/*** LM4549 register list ***/
> +
> +enum {
> +    LM4549_Reset                    = 0x00,
> +    LM4549_Master_Volume            = 0x02,
> +    LM4549_Line_Out_Volume          = 0x04,
> +    LM4549_Master_Volume_Mono       = 0x06,
> +    LM4549_PC_Beep_Volume           = 0x0A,
> +    LM4549_Phone_Volume             = 0x0C,
> +    LM4549_Mic_Volume               = 0x0E,
> +    LM4549_Line_In_Volume           = 0x10,
> +    LM4549_CD_Volume                = 0x12,
> +    LM4549_Video_Volume             = 0x14,
> +    LM4549_Aux_Volume               = 0x16,
> +    LM4549_PCM_Out_Volume           = 0x18,
> +    LM4549_Record_Select            = 0x1A,
> +    LM4549_Record_Gain              = 0x1C,
> +    LM4549_General_Purpose          = 0x20,
> +    LM4549_3D_Control               = 0x22,
> +    LM4549_Powerdown_Ctrl_Stat      = 0x26,
> +    LM4549_Extended_Audio_ID        = 0x28,
> +    LM4549_Extended_Audio_Stat_Ctrl = 0x2A,
> +    LM4549_PCM_Front_DAC_Rate       = 0x2C,
> +    LM4549_PCM_ADC_Rate             = 0x32,
> +    LM4549_Vendor_ID1               = 0x7C,
> +    LM4549_Vendor_ID2               = 0x7E
> +};
> +
> +/*** LM4549 device state ***/
> +typedef struct {
> +    struct {
> +        uint16_t value;
> +        uint16_t default_value;
> +        uint16_t read_only;
> +    } data[128];
> +} lm4549_registers;
> +
> +typedef struct {
> +    ACLinkDevice aclinkdev;
> +    lm4549_registers codec_regs;
> +    QEMUSoundCard card;
> +    SWVoiceOut *voice;
> +
> +#define BUFFER_SIZE (512)
> +    uint32_t buffer[BUFFER_SIZE];
> +    uint32_t buffer_level;
> +} lm4549_state;
> +
> +/*** Functions ***/
> +
> +static void lm4549_store_init(lm4549_state *s, uint32_t offset, uint32_t
> value, uint32_t is_read_only)
> +{
> +    lm4549_registers *r = &s->codec_regs;
> +
> +    if (offset > 128)
> +        DPRINTF("lm4549_store: Out of bound offset 0x%x\n", (int)offset);
> +
> +    r->data[offset].value = value & 0xFFFF;
> +    r->data[offset].default_value = value & 0xFFFF;
> +    r->data[offset].read_only = (is_read_only > 0) ? 1 : 0;
> +}
> +
> +static void lm4549_store_reset(lm4549_state *s)
> +{
> +    lm4549_registers *r = &s->codec_regs;
> +    int i;
> +
> +    for(i = 0; i < 128; i++) {
> +        r->data[i].value = r->data[i].default_value;
> +    }
> +}
> +
> +static void lm4549_store(lm4549_state *s, uint32_t offset, uint16_t value)
> +{
> +    lm4549_registers *r = &s->codec_regs;
> +
> +    if (offset > 128) {
> +        DPRINTF("lm4549_store: Out of bound offset 0x%x\n", (int)offset);
> +    }
> +
> +    if (r->data[offset].read_only) {
> +        DPRINTF("lm4549_store: Read-only offset 0x%x\n", (int)offset);
> +        return;
> +    }
> +
> +    r->data[offset].value = value & 0xFFFF;
> +}
> +
> +static uint16_t lm4549_load(lm4549_state *s, uint32_t offset)
> +{
> +    lm4549_registers *r = &s->codec_regs;
> +
> +    if (offset > 128) {
> +        hw_error("lm4549_load: Out of bound offset 0x%x\n", (int)offset);
> +    }
> +
> +    return r->data[offset].value;
> +}
> +
> +static void lm4549_audio_transfer(lm4549_state *s)
> +{
> +    uint32_t written_bytes, written_samples;
> +    uint32_t i;
> +
> +    /* Activate the voice */
> +    AUD_set_active_out(s->voice, 1);
> +
> +    /* Try to write the buffer content */
> +    written_bytes = AUD_write(s->voice, s->buffer, s->buffer_level *
> sizeof(uint32_t));
> +    written_samples = written_bytes >> 2;
> +
> +#if defined(LM4549_DUMP_DAC_INPUT)
> +    fwrite(s->buffer, sizeof(uint8_t), written_bytes, fp_dac_input);
> +#endif
> +
> +    if (written_samples == s->buffer_level) {
> +        s->buffer_level = 0;
> +    }
> +    else {
> +        s->buffer_level -= written_samples;
> +
> +        if (s->buffer_level > 0) {
> +            /* Move the data back to the start of the buffer */
> +            for (i = 0; i < s->buffer_level; i++) {
> +                s->buffer[i] = s->buffer[i + written_samples];
> +            }
> +        }
> +
> +        /* Regulate the data throughput by disabling further transfer
> from the ACLink controller */
> +        aclink_bitclk_enable(&s->aclinkdev, 0);
> +    }
> +}
> +
> +static void lm4549_audio_out_callback(void *opaque, int free)
> +{
> +    lm4549_state *s = (lm4549_state*)opaque;
> +    static uint32_t prev_buffer_level = 0;
> +
> +#ifdef LM4549_DEBUG
> +    int size = AUD_get_buffer_size_out(s->voice);
> +    DPRINTF("lm4549_audio_out_callback size = %i free = %i\n", size, free);
> +#endif
> +
> +    /* Detect that no more date are coming from the ACLink => disable the
> voice */
> +    if (s->buffer_level == prev_buffer_level) {
> +        AUD_set_active_out(s->voice, 0);
> +    }
> +    prev_buffer_level = s->buffer_level;
> +
> +    /* Check if a buffer transfer is pending */
> +    if (s->buffer_level == BUFFER_SIZE) {
> +        lm4549_audio_transfer(s);
> +    }
> +
> +    /* Enable the bitclk to get data again */
> +    aclink_bitclk_enable(&s->aclinkdev, 1);
> +}
> +
> +static uint32_t lm4549_read(ACLinkDevice *dev, target_phys_addr_t offset)
> +{
> +    lm4549_state *s = FROM_ACLINK_DEVICE(lm4549_state, dev);
> +    uint32_t value = 0;
> +
> +    /* Read the stored value */
> +    value = lm4549_load(s, offset);
> +    DPRINTF("lm4549_read [0x%02x] = 0x%04x\n", offset, value);
> +
> +    return value;
> +}
> +
> +static void lm4549_write(ACLinkDevice *dev, target_phys_addr_t offset,
> uint32_t value)
> +{
> +    lm4549_state *s = FROM_ACLINK_DEVICE(lm4549_state, dev);
> +
> +    DPRINTF("lm4549_write [0x%02x] = 0x%04x\n", offset, value);
> +
> +    /* Store the new value */
> +    lm4549_store(s, offset, value);
> +
> +    switch(offset) {
> +    case LM4549_Reset:
> +        lm4549_store_reset(s);
> +        break;
> +    case LM4549_PCM_Front_DAC_Rate:
> +        DPRINTF("DAC rate change = %i\n", lm4549_load(s, offset));
> +
> +        /* Close the current voice */
> +        AUD_close_out(&s->card, s->voice);
> +        s->voice = NULL;
> +
> +        /* Open a voice with the new sample rate */
> +        struct audsettings as;
> +        as.freq = lm4549_load(s, offset);
> +        as.nchannels = 2;
> +        as.fmt = AUD_FMT_S16;
> +        as.endianness = 0;
> +
> +        s->voice = AUD_open_out(
> +            &s->card,
> +            s->voice,
> +            "lm4549.out",
> +            dev,
> +            lm4549_audio_out_callback,
> +            &as
> +        );


Any particular reason for closing and the re-opening the voice? (AUD_open_ should
do the closing automatically)

> +        break;
> +    }
> +}
> +
> +void lm4549_sdataout_slot12(ACLinkDevice *dev, uint32_t slot1, uint32_t
> slot2)
> +{
> +#define SLOT1_RW    (1 << 19)
> +    uint16_t control = (slot1 >> 12) & 0x7F;
> +    uint16_t data = (slot2 >> 4) & 0xFFFF;
> +    uint32_t value = 0;
> +
> +    if ((slot1 & SLOT1_RW) == 0) {
> +        /* Write operation */
> +        lm4549_write(dev, control, data);
> +    }
> +    else {
> +        /* Read operation */
> +        value = lm4549_read(dev, control);
> +
> +        /* Write the return value in SDATAIN */
> +        aclink_sdatain_slot12(dev, slot1 & ~SLOT1_RW, value << 4);
> +    }
> +}
> +
> +void lm4549_sdataout_slot34(ACLinkDevice *dev, uint32_t slot3, uint32_t
> slot4)
> +{
> +    lm4549_state *s = FROM_ACLINK_DEVICE(lm4549_state, dev);
> +    uint32_t sample = ((slot3 >> 4) & 0xFFFF) + (((slot4 >> 4) & 0xFFFF)
> << 16);
> +
> +    if (s->buffer_level >= BUFFER_SIZE) {
> +        hw_error("sdataout slot34: overrun\n");
> +    }
> +
> +    /* Store the sample in the buffer */
> +    s->buffer[s->buffer_level++] = sample;
> +
> +    if (s->buffer_level == BUFFER_SIZE) {
> +        /* Trigger the transfer of the buffer to the audio host */
> +        lm4549_audio_transfer(s);
> +    }
> +}
> +
> +static int lm4549_init(ACLinkDevice *dev)
> +{
> +    lm4549_state *s = FROM_ACLINK_DEVICE(lm4549_state, dev);
> +
> +    /* Init the register store */
> +    lm4549_store_init(s, LM4549_Reset,                     0x0d50, 0);
> +    lm4549_store_init(s, LM4549_Master_Volume,             0x8008, 0);
> +    lm4549_store_init(s, LM4549_Line_Out_Volume,           0x8000, 0);
> +    lm4549_store_init(s, LM4549_Master_Volume_Mono,        0x8000, 0);
> +    lm4549_store_init(s, LM4549_PC_Beep_Volume,            0x0000, 0);
> +    lm4549_store_init(s, LM4549_Phone_Volume,              0x8008, 0);
> +    lm4549_store_init(s, LM4549_Mic_Volume,                0x8008, 0);
> +    lm4549_store_init(s, LM4549_Line_In_Volume,            0x8808, 0);
> +    lm4549_store_init(s, LM4549_CD_Volume,                 0x8808, 0);
> +    lm4549_store_init(s, LM4549_Video_Volume,              0x8808, 0);
> +    lm4549_store_init(s, LM4549_Aux_Volume,                0x8808, 0);
> +    lm4549_store_init(s, LM4549_PCM_Out_Volume,            0x8808, 0);
> +    lm4549_store_init(s, LM4549_Record_Select,             0x0000, 0);
> +    lm4549_store_init(s, LM4549_Record_Gain,               0x8000, 0);
> +    lm4549_store_init(s, LM4549_General_Purpose,           0x0000, 0);
> +    lm4549_store_init(s, LM4549_3D_Control,                0x0101, 0);
> +    lm4549_store_init(s, LM4549_Powerdown_Ctrl_Stat,       0x0000, 0);
> +    lm4549_store_init(s, LM4549_Extended_Audio_ID,         0x0001, 1);
> +    lm4549_store_init(s, LM4549_Extended_Audio_Stat_Ctrl,  0x0000, 0);
> +    lm4549_store_init(s, LM4549_PCM_Front_DAC_Rate,        0xBB80, 0);
> +    lm4549_store_init(s, LM4549_PCM_ADC_Rate,              0xBB80, 0);
> +    lm4549_store_init(s, LM4549_Vendor_ID1,                0x4e53, 1);
> +    lm4549_store_init(s, LM4549_Vendor_ID2,                0x4331, 1);
> +
> +    /* Enable the ACLink clock */
> +    aclink_bitclk_enable(dev, 1);
> +
> +    /* Register an audio card */
> +    AUD_register_card("lm4549", &s->card);
> +
> +    /* Open a default voice */
> +    struct audsettings as;

Please do not use C99's intermixed declaration and code.

> +    as.freq = 48000;
> +    as.nchannels = 2;
> +    as.fmt = AUD_FMT_S16;
> +    as.endianness = 0;
> +
> +    s->voice = AUD_open_out(
> +        &s->card,
> +        s->voice,
> +        "lm4549.out",
> +        s,
> +        lm4549_audio_out_callback,
> +        &as
> +    );
> +
> +    AUD_set_volume_out(s->voice, 0, 255, 255);
> +
> +    /* Reset the input buffer */
> +    memset(s->buffer, 0x00, sizeof(s->buffer));
> +    s->buffer_level = 0;
> +
> +#if defined(LM4549_DUMP_DAC_INPUT)
> +    fp_dac_input = fopen("lm4549_dac_input.pcm", "wb");
> +    if (!fp_dac_input) {
> +        hw_error("Unable to open lm4549_dac_input.pcm for writing\n");
> +    }
> +#endif
> +
> +    return 0;
> +}
> +
> +static ACLinkDeviceInfo lm4549_info = {
> +    .qdev = {
> +        .name = "lm4549",
> +        .size = sizeof(lm4549_state)
> +    },
> +    .init = lm4549_init,
> +    .sdataout_slot12 = lm4549_sdataout_slot12,
> +    .sdataout_slot34 = lm4549_sdataout_slot34,
> +};
> +
> +static void lm4549_register_device(void)
> +{
> +    aclink_register_device(&lm4549_info);
> +}
> +
> +device_init(lm4549_register_device)
> diff --git a/hw/pl041.c b/hw/pl041.c
> new file mode 100644
> index 0000000..fb7c311
> --- /dev/null
> +++ b/hw/pl041.c
> @@ -0,0 +1,425 @@
> +/*
> + * Arm PrimeCell PL041 Advanced Audio Codec Interface
> + *
> + * Copyright (c) 2010
> + * Written by Mathieu Sonet - www.elasticsheep.com
> + *
> + * This code is licenced under the GPL.
> + *
> + * *****************************************************************
> + *
> + * This driver emulates the ARM AACI interface.
> + * It connects the system bus to an ACLink bus on which an audio
> + * codec can be connected.
> + *
> + */
> +
> +#include "sysbus.h"
> +
> +#include "pl041.h"
> +#include "aclink.h"
> +
> +/*** Debug macros ***/
> +
> +/* #define PL041_DEBUG_LEVEL 1 */
> +
> +#if defined(PL041_DEBUG_LEVEL) && (PL041_DEBUG_LEVEL >= 1)
> +#define DBG_L1(fmt, ...) \
> +do { printf("pl041: " fmt , ## __VA_ARGS__); } while (0)
> +#else
> +#define DBG_L1(fmt, ...) \
> +do { } while (0)
> +#endif
> +
> +#if defined(PL041_DEBUG_LEVEL) && (PL041_DEBUG_LEVEL >= 2)
> +#define DBG_L2(fmt, ...) \
> +do { printf("pl041: " fmt , ## __VA_ARGS__); } while (0)
> +#else
> +#define DBG_L2(fmt, ...) \
> +do { } while (0)
> +#endif
> +
> +/*** Constants ***/
> +
> +#define FIFO_DEPTH  16
> +
> +/*** Types ***/
> +
> +typedef struct {
> +    uint32_t size;
> +    uint32_t half;
> +    uint32_t level;
> +    uint32_t data[FIFO_DEPTH];
> +} pl041_fifo;
> +
> +typedef struct {
> +    SysBusDevice busdev;
> +    qemu_irq irq;
> +    pl041_regfile regs;
> +    pl041_fifo fifo1;
> +    ACLinkBus *aclink;
> +} pl041_state;
> +
> +/*** Globals ***/
> +
> +static const unsigned char pl041_id[8] =
> +{ 0x41, 0x10, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1 };
> +
> +#if defined(PL041_DEBUG_LEVEL)
> +#define REGISTER(name, offset) #name,
> +static const char* pl041_regs_name[] = {
> +    #include "pl041.hx"
> +};
> +#undef REGISTER
> +#endif
> +
> +/*** Local prototypes ***/
> +
> +static void pl041_isr1_update(pl041_state *s);
> +
> +/*** Functions ***/
> +
> +#if defined(PL041_DEBUG_LEVEL)
> +static const char* get_reg_name(target_phys_addr_t offset)
> +{
> +    if (offset <= PL041_dr4_3) {
> +        return pl041_regs_name[offset >> 2];
> +    }
> +
> +    return "unknown";
> +}
> +#endif
> +
> +static void pl041_fifo1_push(pl041_state *s, uint32_t value)
> +{
> +    pl041_fifo* f = &s->fifo1;
> +
> +    /* Check the FIFO level */
> +    if (f->level >= f->size) {
> +        hw_error("fifo1 push: overrun\n");
> +    }
> +
> +    /* Push the value in the FIFO */
> +    if (f->level < f->size) {
> +        s->fifo1.data[f->level++] = value;
> +    }
> +
> +    /* Update the status register */
> +    if (f->level > 0) {
> +        s->regs.sr1 &= ~(TXUNDERRUN | TXFE);
> +    }
> +
> +    if (f->level >= (f->size >> 1)) {
> +        s->regs.sr1 &= ~TXHE;
> +    }
> +
> +    if (f->level >= f->size) {
> +        s->regs.sr1 |= TXFF;
> +    }
> +
> +    DBG_L1("fifo1_push sr1 = 0x%08x\n", s->regs.sr1);
> +}
> +
> +static void pl041_fifo1_transmit(pl041_state *s)
> +{
> +    pl041_fifo* f = &s->fifo1;
> +    uint32_t slots = s->regs.txcr1 & TXSLOT_MASK;
> +    uint32_t written_samples;
> +
> +    /* Check if FIFO1 transmit is enabled */
> +    if ((s->regs.txcr1 & TXEN) && (slots & (TXSLOT3 | TXSLOT4))) {
> +        if (f->level >= f->half) {
> +            int i;
> +
> +            DBG_L1("Transfer FIFO level = %i\n", f->level);
> +
> +            /* Try to transfer the whole FIFO */
> +            for(i = 0; i < f->level; i++) {
> +                uint32_t sample = f->data[i];
> +                uint32_t slot3, slot4;
> +
> +                /* Check the sample width */
> +                switch(s->regs.txcr1 & TSIZE_MASK) {
> +                case TSIZE_16BITS:
> +                    /* 20-bit left justification */
> +                    slot3 = (sample & 0xFFFF) << 4;
> +                    slot4 = ((sample >> 16) & 0xFFFF) << 4;
> +                    break;
> +                case TSIZE_18BITS:
> +                case TSIZE_20BITS:
> +                case TSIZE_12BITS:
> +                default:
> +                    hw_error("Unsupported TSize\n");
> +                    break;
> +                }
> +
> +                /* Stop sending if the clock is disabled */
> +                if (aclink_bitclk_is_enabled(s->aclink) == 0) {
> +                    DBG_L1("bitclk is disabled => pause the transfer\n");
> +                    break;
> +                }
> +
> +                /* Transmit a sample on the ACLINK bus */
> +                aclink_sdataout_slot34(s->aclink, slot3, slot4);
> +            }
> +
> +            written_samples = i;
> +            if (written_samples > 0) {
> +                /* Update the FIFO level */
> +                f->level -= written_samples;
> +
> +                /* Move back the pending samples to the start of the FIFO */
> +                for(i = 0; i < f->level; i++)
> +                    f->data[i] = f->data[written_samples + i];
> +
> +                /* Update the status register */
> +                s->regs.sr1 &= ~TXFF;
> +
> +                if (f->level <= (f->size >> 1))
> +                    s->regs.sr1 |= TXHE;
> +
> +                if (f->level == 0)
> +                {
> +                    s->regs.sr1 |= TXFE | TXUNDERRUN;
> +                    DBG_L1("Empty FIFO\n");
> +                }
> +            }
> +        }
> +    }
> +}
> +
> +static void pl041_isr1_update(pl041_state *s)
> +{
> +    uint32_t mask = 0;
> +
> +    /* Update ISR1 */
> +    if (s->regs.sr1 & TXUNDERRUN) {
> +        s->regs.isr1 |= URINTR;
> +    }
> +    else {
> +        s->regs.isr1 &= ~URINTR;
> +    }
> +
> +    if (s->regs.sr1 & TXHE) {
> +        s->regs.isr1 |= TXINTR;
> +    }
> +    else {
> +        s->regs.isr1 &= ~TXINTR;
> +    }
> +
> +    if (!(s->regs.sr1 & TXBUSY) && (s->regs.sr1 & TXFE)) {
> +        s->regs.isr1 |= TXCINTR;
> +    }
> +    else {
> +        s->regs.isr1 &= ~TXCINTR;
> +    }
> +
> +    /* Set the irq mask */
> +    if (s->regs.ie1 & TXUIE) {
> +        mask |= URINTR;
> +    }
> +
> +    if (s->regs.ie1 & TXIE) {
> +        mask |= TXINTR;
> +    }
> +
> +    if (s->regs.ie1 & TXCIE) {
> +        mask |= TXCINTR;
> +    }
> +
> +    /* Update the irq state */
> +    qemu_set_irq(s->irq, ((s->regs.isr1 & mask) > 0) ? 1 : 0);
> +    DBG_L2("Set interrupt sr1 = 0x%08x isr1 = 0x%08x masked = 0x%08x\n",
> s->regs.sr1, s->regs.isr1, s->regs.isr1 & mask);
> +}
> +
> +static void pl041_sdatain_slot12(DeviceState *dev, uint32_t slot1,
> uint32_t slot2)
> +{
> +    pl041_state *s = (pl041_state *)dev;
> +
> +    DBG_L1("pl041_sdatain_slot12 0x%08x 0x%08x\n", slot1, slot2);
> +
> +    s->regs.sl1rx = slot1;
> +    s->regs.sl2rx = slot2;
> +
> +    s->regs.slfr &= ~SL1RXBUSY | ~SL2RXBUSY;
> +    s->regs.slfr |= SL1RXVALID | SL2RXVALID;
> +}
> +
> +static void pl041_bitclk_state_changed(DeviceState *dev)
> +{
> +    pl041_state *s = (pl041_state *)dev;
> +
> +    /* Check if the bitclk signal is enabled */
> +    if (aclink_bitclk_is_enabled(s->aclink) == 1) {
> +        DBG_L1("bitclk enabled\n");
> +
> +        /* Trigger pending transfers */
> +        pl041_fifo1_transmit(s);
> +        pl041_isr1_update(s);
> +    }
> +    else {
> +        DBG_L1("bitclk disabled\n");
> +    }
> +}
> +
> +static uint32_t pl041_read(void *opaque, target_phys_addr_t offset)
> +{
> +    pl041_state *s = (pl041_state *)opaque;
> +    int val;
> +
> +    if (offset >= 0xfe0 && offset < 0x1000) {
> +        DBG_L1("pl041_read [0x%08x]\n", offset);
> +        return pl041_id[(offset - 0xfe0) >> 2];
> +    }
> +
> +    if (offset < 0x110) {
> +        val = *((uint32_t*)&s->regs + (offset >> 2));
> +    }
> +    else {
> +        hw_error("pl041_read: Bad offset %x\n", (int)offset);
> +    }
> +
> +    switch (offset) {
> +    case PL041_allints:
> +        val = s->regs.isr1 & 0x7F;
> +        break;
> +    }
> +
> +    DBG_L1("pl041_read [0x%08x] %s => 0x%08x\n", offset,
> get_reg_name(offset), val);
> +
> +    return val;
> +}
> +
> +static void pl041_write(void *opaque, target_phys_addr_t offset,
> +                        uint32_t value)
> +{
> +    pl041_state *s = (pl041_state *)opaque;
> +
> +    DBG_L1("pl041_write [0x%08x] %s <= 0x%08x\n", offset,
> get_reg_name(offset), value);
> +
> +    /* Write the register */
> +    if (offset < 0x110) {
> +        *((uint32_t*)&s->regs + (offset >> 2)) = value;
> +    }
> +    else {
> +        hw_error("pl041_write: Bad offset %x\n", (int)offset);
> +    }
> +
> +    /* Execute the actions */
> +    switch (offset) {
> +#if defined(PL041_DEBUG_LEVEL) && (PL041_DEBUG_LEVEL >= 1)
> +    case PL041_txcr1:
> +    {
> +        uint32_t txen = s->regs.txcr1 & TXEN;
> +        uint32_t slots = (s->regs.txcr1 & TXSLOT_MASK) >> TXSLOT_MASK_BIT;
> +        uint32_t tsize = (s->regs.txcr1 & TSIZE_MASK) >> TSIZE_MASK_BIT;
> +        uint32_t compact_mode = (s->regs.txcr1 & TXCOMPACT) ? 1 : 0;
> +        uint32_t txfen = (s->regs.txcr1 & TXFEN) > 0 ? 1 : 0;
> +        DBG_L1("=> txen = %i slots = 0x%01x tsize = %i compact = %i txfen
> = %i\n", txen, slots,  tsize, compact_mode, txfen);
> +        break;
> +    }
> +#endif
> +    case PL041_sl1tx:
> +        s->regs.slfr &= ~SL1TXEMPTY;
> +        aclink_sdataout_slot12(s->aclink, s->regs.sl1tx, s->regs.sl2tx);
> +        break;
> +
> +    case PL041_sl2tx:
> +        s->regs.sl2tx = value;
> +        s->regs.slfr &= ~SL2TXEMPTY;
> +        break;
> +
> +    case PL041_intclr:
> +        DBG_L1("=> Clear interrupt intclr = 0x%08x isr1 = 0x%08x\n",
> s->regs.intclr, s->regs.isr1);
> +
> +        if (s->regs.intclr & TXUEC1) {
> +            s->regs.sr1 &= ~TXUNDERRUN;
> +        }
> +        break;
> +
> +#if defined(PL041_DEBUG_LEVEL)
> +    case PL041_maincr:
> +    {
> +        char debug[] = " AACIFE  SL1RXEN  SL1TXEN";
> +        if (!(value & AACIFE)) debug[0] = '!';
> +        if (!(value & SL1RXEN)) debug[8] = '!';
> +        if (!(value & SL1TXEN)) debug[17] = '!';
> +        DBG_L1("%s\n", debug);
> +        break;
> +    }
> +#endif
> +
> +    case PL041_dr1_0:
> +    case PL041_dr1_1:
> +    case PL041_dr1_2:
> +    case PL041_dr1_3:
> +        pl041_fifo1_push(s, value);
> +        break;
> +    }
> +
> +    /* Transmit the FIFO content */
> +    pl041_fifo1_transmit(s);
> +
> +    /* Update the ISR1 register */
> +    pl041_isr1_update(s);
> +}
> +
> +static void pl041_reset(pl041_state *s)
> +{
> +    memset(&s->regs, 0x00, sizeof(pl041_regfile));
> +
> +    s->regs.slfr = SL1TXEMPTY | SL2TXEMPTY | SL12TXEMPTY;
> +    s->regs.sr1 = TXFE | RXFE | TXHE;
> +    s->regs.isr1 = 0;
> +
> +    s->fifo1.size = FIFO_DEPTH;
> +    s->fifo1.half = FIFO_DEPTH >> 1;
> +    s->fifo1.level = 0;
> +    memset(s->fifo1.data, 0x00, sizeof(s->fifo1.data));
> +}
> +
> +static CPUReadMemoryFunc * const pl041_readfn[] = {
> +   pl041_read,
> +   pl041_read,
> +   pl041_read
> +};
> +
> +static CPUWriteMemoryFunc * const pl041_writefn[] = {
> +   pl041_write,
> +   pl041_write,
> +   pl041_write
> +};
> +
> +static ACLinkControllerInfo pl041_controller_info = {
> +    .sdatain_slot12 = pl041_sdatain_slot12,
> +    .bitclk_state_changed = pl041_bitclk_state_changed,
> +};
> +
> +static int pl041_init(SysBusDevice *dev)
> +{
> +    pl041_state *s = FROM_SYSBUS(pl041_state, dev);
> +    int iomemtype;
> +
> +    DBG_L1("pl041_init\n");
> +
> +    /* Connect the device to the sysbus */
> +    iomemtype = cpu_register_io_memory(pl041_readfn, pl041_writefn, s);
> +    sysbus_init_mmio(dev, 0x1000, iomemtype);
> +    sysbus_init_irq(dev, &s->irq);
> +
> +    /* Create the ACLink bus */
> +    s->aclink = aclink_create_bus(&dev->qdev, "aclink");
> +    aclink_set_controller_info(s->aclink, &pl041_controller_info);
> +
> +    /* Reset the device */
> +    pl041_reset(s);
> +
> +    return 0;
> +}
> +
> +static void pl041_register_devices(void)
> +{
> +    sysbus_register_dev("pl041", sizeof(pl041_state), pl041_init);
> +}
> +
> +device_init(pl041_register_devices)
> diff --git a/hw/pl041.h b/hw/pl041.h
> new file mode 100644
> index 0000000..aae87bd
> --- /dev/null
> +++ b/hw/pl041.h
> @@ -0,0 +1,119 @@
> +/*
> + * Arm PrimeCell PL041 Advanced Audio Codec Interface
> + *
> + * Copyright (c) 2010
> + * Written by Mathieu Sonet - www.elasticsheep.com
> + *
> + * This code is licenced under the GPL.
> + */
> +
> +/* Register file */
> +#define REGISTER(name, offset) uint32_t name;
> +typedef struct {
> +    #include "pl041.hx"
> +} pl041_regfile;
> +#undef REGISTER
> +
> +/* Register addresses */
> +#define REGISTER(name, offset) PL041_##name = offset,
> +enum {
> +    #include "pl041.hx"
> +};
> +#undef REGISTER
> +
> +/* Register bits */
> +
> +/* IEx */
> +#define TXCIE           (1 << 0)
> +#define RXTIE           (1 << 1)
> +#define TXIE            (1 << 2)
> +#define RXIE            (1 << 3)
> +#define RXOIE           (1 << 4)
> +#define TXUIE           (1 << 5)
> +#define RXTOIE          (1 << 6)
> +
> +/* TXCRx */
> +#define TXEN            (1 << 0)
> +#define TXSLOT1         (1 << 1)
> +#define TXSLOT2         (1 << 2)
> +#define TXSLOT3         (1 << 3)
> +#define TXSLOT4         (1 << 4)
> +#define TXCOMPACT       (1 << 15)
> +#define TXFEN           (1 << 16)
> +
> +#define TXSLOT_MASK_BIT (1)
> +#define TXSLOT_MASK     (0xFFF << TXSLOT_MASK_BIT)
> +
> +#define TSIZE_MASK_BIT  (13)
> +#define TSIZE_MASK      (0x3 << TSIZE_MASK_BIT)
> +
> +#define TSIZE_16BITS    (0x0 << TSIZE_MASK_BIT)
> +#define TSIZE_18BITS    (0x1 << TSIZE_MASK_BIT)
> +#define TSIZE_20BITS    (0x2 << TSIZE_MASK_BIT)
> +#define TSIZE_12BITS    (0x3 << TSIZE_MASK_BIT)
> +
> +/* SRx */
> +#define RXFE         (1 << 0)
> +#define TXFE         (1 << 1)
> +#define RXHF         (1 << 2)
> +#define TXHE         (1 << 3)
> +#define RXFF         (1 << 4)
> +#define TXFF         (1 << 5)
> +#define RXBUSY       (1 << 6)
> +#define TXBUSY       (1 << 7)
> +#define RXOVERRUN    (1 << 8)
> +#define TXUNDERRUN   (1 << 9)
> +#define RXTIMEOUT    (1 << 10)
> +#define RXTOFE       (1 << 11)
> +
> +/* ISRx */
> +#define TXCINTR      (1 << 0)
> +#define RXTOINTR     (1 << 1)
> +#define TXINTR       (1 << 2)
> +#define RXINTR       (1 << 3)
> +#define ORINTR       (1 << 4)
> +#define URINTR       (1 << 5)
> +#define RXTOFEINTR   (1 << 6)
> +
> +/* SLFR */
> +#define SL1RXBUSY    (1 << 0)
> +#define SL1TXBUSY    (1 << 1)
> +#define SL2RXBUSY    (1 << 2)
> +#define SL2TXBUSY    (1 << 3)
> +#define SL12RXBUSY   (1 << 4)
> +#define SL12TXBUSY   (1 << 5)
> +#define SL1RXVALID   (1 << 6)
> +#define SL1TXEMPTY   (1 << 7)
> +#define SL2RXVALID   (1 << 8)
> +#define SL2TXEMPTY   (1 << 9)
> +#define SL12RXVALID  (1 << 10)
> +#define SL12TXEMPTY  (1 << 11)
> +#define RAWGPIOINT   (1 << 12)
> +#define RWIS         (1 << 13)
> +
> +/* MAINCR */
> +#define AACIFE       (1 << 0)
> +#define LOOPBACK     (1 << 1)
> +#define LOWPOWER     (1 << 2)
> +#define SL1RXEN      (1 << 3)
> +#define SL1TXEN      (1 << 4)
> +#define SL2RXEN      (1 << 5)
> +#define SL2TXEN      (1 << 6)
> +#define SL12RXEN     (1 << 7)
> +#define SL12TXEN     (1 << 8)
> +#define DMAENABLE    (1 << 9)
> +
> +/* INTCLR */
> +#define WISC         (1 << 0)
> +#define RXOEC1       (1 << 1)
> +#define RXOEC2       (1 << 2)
> +#define RXOEC3       (1 << 3)
> +#define RXOEC4       (1 << 4)
> +#define TXUEC1       (1 << 5)
> +#define TXUEC2       (1 << 6)
> +#define TXUEC3       (1 << 7)
> +#define TXUEC4       (1 << 8)
> +#define RXTOFEC1     (1 << 9)
> +#define RXTOFEC2     (1 << 10)
> +#define RXTOFEC3     (1 << 11)
> +#define RXTOFEC4     (1 << 12)
> diff --git a/hw/pl041.hx b/hw/pl041.hx
> new file mode 100644
> index 0000000..65383c6
> --- /dev/null
> +++ b/hw/pl041.hx
> @@ -0,0 +1,55 @@
> +/*
> + * Arm PrimeCell PL041 Advanced Audio Codec Interface
> + *
> + * Copyright (c) 2010
> + * Written by Mathieu Sonet - www.elasticsheep.com
> + *
> + * This code is licenced under the GPL.
> + */
> +
> +/* PL041 register file description */
> +
> +REGISTER( rxcr1,   0x00 )
> +REGISTER( txcr1,   0x04 )
> +REGISTER( sr1,     0x08 )
> +REGISTER( isr1,    0x0C )
> +REGISTER( ie1,     0x10 )
> +REGISTER( rxcr2,   0x14 )
> +REGISTER( txcr2,   0x18 )
> +REGISTER( sr2,     0x1C )
> +REGISTER( isr2,    0x20 )
> +REGISTER( ie2,     0x24 )
> +REGISTER( rxcr3,   0x28 )
> +REGISTER( txcr3,   0x2C )
> +REGISTER( sr3,     0x30 )
> +REGISTER( isr3,    0x34 )
> +REGISTER( ie3,     0x38 )
> +REGISTER( rxcr4,   0x3C )
> +REGISTER( txcr4,   0x40 )
> +REGISTER( sr4,     0x44 )
> +REGISTER( isr4,    0x48 )
> +REGISTER( ie4,     0x4C )
> +REGISTER( sl1rx,   0x50 )
> +REGISTER( sl1tx,   0x54 )
> +REGISTER( sl2rx,   0x58 )
> +REGISTER( sl2tx,   0x5C )
> +REGISTER( sl12rx,  0x60 )
> +REGISTER( sl12tx,  0x64 )
> +REGISTER( slfr,    0x68 )
> +REGISTER( slistat, 0x6C )
> +REGISTER( slien,   0x70 )
> +REGISTER( intclr,  0x74 )
> +REGISTER( maincr,  0x78 )
> +REGISTER( reset,   0x7C )
> +REGISTER( sync,    0x80 )
> +REGISTER( allints, 0x84 )
> +REGISTER( mainfr,  0x88 )
> +REGISTER( unused,  0x8C )
> +REGISTER( dr1_0,   0x90 )
> +REGISTER( dr1_1,   0x94 )
> +REGISTER( dr1_2,   0x98 )
> +REGISTER( dr1_3,   0x9C )
> +REGISTER( dr1_4,   0xA0 )
> +REGISTER( dr1_5,   0xA4 )
> +REGISTER( dr1_6,   0xA8 )
> +REGISTER( dr1_7,   0xAC )
> diff --git a/hw/versatilepb.c b/hw/versatilepb.c
> index 391f5b8..89d775d 100644
> --- a/hw/versatilepb.c
> +++ b/hw/versatilepb.c
> @@ -16,6 +16,7 @@
>  #include "pci.h"
>  #include "usb-ohci.h"
>  #include "boards.h"
> +#include "aclink.h"
> 
>  /* Primary interrupt controller.  */
> 
> @@ -245,6 +246,11 @@ static void versatile_init(ram_addr_t ram_size,
>      /* Add PL031 Real Time Clock. */
>      sysbus_create_simple("pl031", 0x101e8000, pic[10]);
> 
> +    /* Add PL041 AACI Interface and connect the LM4549 codec */
> +    dev = sysbus_create_varargs("pl041", 0x10004000, sic[24]);
> +    ACLinkBus* bus = (ACLinkBus*)qdev_get_child_bus(dev, "aclink");
> +    aclink_create_device(bus, "lm4549");
> +
>      /* Memory map for Versatile/PB:  */
>      /* 0x10000000 System registers.  */
>      /* 0x10001000 PCI controller config registers.  */
>
diff mbox

Patch

diff --git a/Makefile.target b/Makefile.target
index 7c1f30c..eec028d 100644
--- a/Makefile.target
+++ b/Makefile.target
@@ -270,6 +270,7 @@  obj-arm-y += versatile_pci.o
 obj-arm-y += realview_gic.o realview.o arm_sysctl.o arm11mpcore.o a9mpcore.o
 obj-arm-y += armv7m.o armv7m_nvic.o stellaris.o pl022.o stellaris_enet.o
 obj-arm-y += pl061.o
+obj-arm-y += pl041.o aclink.o lm4549.o
 obj-arm-y += arm-semi.o
 obj-arm-y += pxa2xx.o pxa2xx_pic.o pxa2xx_gpio.o pxa2xx_timer.o pxa2xx_dma.o
 obj-arm-y += pxa2xx_lcd.o pxa2xx_mmci.o pxa2xx_pcmcia.o pxa2xx_keypad.o
diff --git a/hw/aclink.c b/hw/aclink.c
new file mode 100644
index 0000000..cc2d38c
--- /dev/null
+++ b/hw/aclink.c
@@ -0,0 +1,121 @@ 
+/*
+ * ACLink Interface
+ *
+ * Copyright (c) 2010
+ * Written by Mathieu Sonet - www.elasticsheep.com
+ *
+ * This code is licenced under the GPL.
+ *
+ * *****************************************************************
+ *
+ * This file defines the ACLink bus interface to exchange data
+ * between an host and a codec.
+ *
+ */
+
+#include "aclink.h"
+
+/*** Types ***/
+
+struct ACLinkBus {
+    BusState qbus;
+    ACLinkControllerInfo* controller_info;
+    uint32_t bitclk;
+};
+
+struct BusInfo aclink_bus_info = {
+    .name = "aclink",
+    .size = sizeof(ACLinkBus),
+};
+
+/*** Functions ***/
+
+ACLinkBus *aclink_create_bus(DeviceState *parent, const char *name)
+{
+    BusState *bus;
+    bus = qbus_create(&aclink_bus_info, parent, name);
+    return FROM_QBUS(ACLinkBus, bus);
+}
+
+void aclink_set_controller_info(ACLinkBus *bus, ACLinkControllerInfo *info)
+{
+    bus->controller_info = info;
+}
+
+static int aclink_device_init(DeviceState *dev, DeviceInfo *base_info)
+{
+    ACLinkDeviceInfo *info = container_of(base_info, ACLinkDeviceInfo,
qdev);
+    ACLinkDevice *s = ACLINK_DEVICE_FROM_QDEV(dev);
+    ACLinkBus *bus;
+
+    bus = FROM_QBUS(ACLinkBus, qdev_get_parent_bus(dev));
+    if (QLIST_FIRST(&bus->qbus.children) != dev
+        || QLIST_NEXT(dev, sibling) != NULL) {
+        hw_error("Too many devices on the ACLINK bus");
+    }
+
+    s->info = info;
+    return info->init(s);
+}
+
+void aclink_register_device(ACLinkDeviceInfo *info)
+{
+    assert(info->qdev.size >= sizeof(ACLinkDevice));
+    info->qdev.init = aclink_device_init;
+    info->qdev.bus_info = &aclink_bus_info;
+    qdev_register(&info->qdev);
+}
+
+DeviceState *aclink_create_device(ACLinkBus *bus, const char *name)
+{
+    DeviceState *dev;
+    dev = qdev_create(&bus->qbus, name);
+    qdev_init_nofail(dev);
+    return dev;
+}
+
+static ACLinkDevice* aclink_get_device(ACLinkBus *bus)
+{
+    DeviceState *dev = QLIST_FIRST(&bus->qbus.children);
+    if (!dev) {
+        return NULL;
+    }
+    return ACLINK_DEVICE_FROM_QDEV(dev);
+}
+
+void aclink_bitclk_enable(ACLinkDevice *dev, uint32_t on)
+{
+    ACLinkBus *bus = FROM_QBUS(ACLinkBus, qdev_get_parent_bus(&dev->qdev));
+    uint32_t has_changed;
+
+    on = (on > 0) ? 1 : 0;
+    has_changed = (bus->bitclk != on) ? 1 : 0;
+
+    bus->bitclk = on;
+    if (has_changed) {
+        bus->controller_info->bitclk_state_changed(bus->qbus.parent);
+    }
+}
+
+uint32_t aclink_bitclk_is_enabled(ACLinkBus *bus)
+{
+    return bus->bitclk;
+}
+
+void aclink_sdataout_slot12(ACLinkBus *bus, uint32_t slot1, uint32_t slot2)
+{
+    ACLinkDevice *device = aclink_get_device(bus);
+    device->info->sdataout_slot12(device, slot1, slot2);
+}
+
+void aclink_sdataout_slot34(ACLinkBus *bus, uint32_t slot3, uint32_t slot4)
+{
+    ACLinkDevice *device = aclink_get_device(bus);
+    device->info->sdataout_slot34(device, slot3, slot4);
+}
+
+void aclink_sdatain_slot12(ACLinkDevice *dev, uint32_t slot1, uint32_t
slot2)
+{
+    ACLinkBus *bus = FROM_QBUS(ACLinkBus, qdev_get_parent_bus(&dev->qdev));
+    bus->controller_info->sdatain_slot12(bus->qbus.parent, slot1, slot2);
+}
diff --git a/hw/aclink.h b/hw/aclink.h
new file mode 100644
index 0000000..eddf759
--- /dev/null
+++ b/hw/aclink.h
@@ -0,0 +1,56 @@ 
+/*
+ * ACLink Interface
+ *
+ * Copyright (c) 2010
+ * Written by Mathieu Sonet - www.elasticsheep.com
+ *
+ */
+
+#ifndef ACLINK_H
+#define ACLINK_H
+
+#include "qdev.h"
+
+typedef struct ACLinkBus ACLinkBus;
+typedef struct ACLinkDevice ACLinkDevice;
+
+/* Controller */
+typedef struct {
+    void (*sdatain_slot12)(DeviceState *dev, uint32_t slot1, uint32_t
slot2);
+    void (*bitclk_state_changed)(DeviceState *dev);
+} ACLinkControllerInfo;
+
+/* Device  */
+typedef struct {
+    DeviceInfo qdev;
+    int (*init)(ACLinkDevice *dev);
+    void (*sdataout_slot12)(ACLinkDevice *dev, uint32_t slot1, uint32_t
slot2);
+    void (*sdataout_slot34)(ACLinkDevice *dev, uint32_t slot3, uint32_t
slot4);
+} ACLinkDeviceInfo;
+
+struct ACLinkDevice {
+    DeviceState qdev;
+    ACLinkDeviceInfo *info;
+};
+
+#define ACLINK_DEVICE_FROM_QDEV(dev) DO_UPCAST(ACLinkDevice, qdev, dev)
+#define FROM_ACLINK_DEVICE(type, dev) DO_UPCAST(type, aclinkdev, dev)
+
+ACLinkBus *aclink_create_bus(DeviceState *parent, const char *name);
+void aclink_set_controller_info(ACLinkBus *bus, ACLinkControllerInfo *info);
+
+DeviceState *aclink_create_device(ACLinkBus *bus, const char *name);
+void aclink_register_device(ACLinkDeviceInfo *info);
+
+/* Common interface */
+uint32_t aclink_bitclk_is_enabled(ACLinkBus *bus);
+
+/* Controller => device interface */
+void aclink_sdataout_slot12(ACLinkBus *bus, uint32_t slot1, uint32_t slot2);
+void aclink_sdataout_slot34(ACLinkBus *bus, uint32_t slot3, uint32_t slot4);
+
+/* Device => controller interface */
+void aclink_sdatain_slot12(ACLinkDevice *bus, uint32_t slot1, uint32_t
slot2);
+void aclink_bitclk_enable(ACLinkDevice *dev, uint32_t on);
+
+#endif
diff --git a/hw/lm4549.c b/hw/lm4549.c
new file mode 100644
index 0000000..9439b61
--- /dev/null
+++ b/hw/lm4549.c
@@ -0,0 +1,368 @@ 
+/*
+ * LM4549 Audio Codec Interface
+ *
+ * Copyright (c) 2010
+ * Written by Mathieu Sonet - www.elasticsheep.com
+ *
+ * This code is licenced under the GPL.
+ *
+ * *****************************************************************
+ *
+ * This driver emulates the LM4549 codec connected on an ACLINK bus.
+ *
+ */
+
+#include "sysbus.h"
+#include "aclink.h"
+
+#include "audio/audio.h"
+
+/* #define LM4549_DEBUG  1 */
+/* #define LM4549_DUMP_DAC_INPUT 1 */
+
+#ifdef LM4549_DEBUG
+#define DPRINTF(fmt, ...) \
+do { printf("lm4549: " fmt , ## __VA_ARGS__); } while (0)
+#else
+#define DPRINTF(fmt, ...) do {} while(0)
+#endif
+
+#if defined(LM4549_DUMP_DAC_INPUT)
+#include <stdio.h>
+static FILE* fp_dac_input = NULL;
+#endif
+
+/*** Prototypes ***/
+void lm4549_sdataout_slot12(ACLinkDevice *dev, uint32_t slot1, uint32_t
slot2);
+void lm4549_sdataout_slot34(ACLinkDevice *dev, uint32_t slot3, uint32_t
slot4);
+
+/*** LM4549 register list ***/
+
+enum {
+    LM4549_Reset                    = 0x00,
+    LM4549_Master_Volume            = 0x02,
+    LM4549_Line_Out_Volume          = 0x04,
+    LM4549_Master_Volume_Mono       = 0x06,
+    LM4549_PC_Beep_Volume           = 0x0A,
+    LM4549_Phone_Volume             = 0x0C,
+    LM4549_Mic_Volume               = 0x0E,
+    LM4549_Line_In_Volume           = 0x10,
+    LM4549_CD_Volume                = 0x12,
+    LM4549_Video_Volume             = 0x14,
+    LM4549_Aux_Volume               = 0x16,
+    LM4549_PCM_Out_Volume           = 0x18,
+    LM4549_Record_Select            = 0x1A,
+    LM4549_Record_Gain              = 0x1C,
+    LM4549_General_Purpose          = 0x20,
+    LM4549_3D_Control               = 0x22,
+    LM4549_Powerdown_Ctrl_Stat      = 0x26,
+    LM4549_Extended_Audio_ID        = 0x28,
+    LM4549_Extended_Audio_Stat_Ctrl = 0x2A,
+    LM4549_PCM_Front_DAC_Rate       = 0x2C,
+    LM4549_PCM_ADC_Rate             = 0x32,
+    LM4549_Vendor_ID1               = 0x7C,
+    LM4549_Vendor_ID2               = 0x7E
+};
+
+/*** LM4549 device state ***/
+typedef struct {
+    struct {
+        uint16_t value;
+        uint16_t default_value;
+        uint16_t read_only;
+    } data[128];
+} lm4549_registers;
+
+typedef struct {
+    ACLinkDevice aclinkdev;
+    lm4549_registers codec_regs;
+    QEMUSoundCard card;
+    SWVoiceOut *voice;
+
+#define BUFFER_SIZE (512)
+    uint32_t buffer[BUFFER_SIZE];
+    uint32_t buffer_level;
+} lm4549_state;
+
+/*** Functions ***/
+
+static void lm4549_store_init(lm4549_state *s, uint32_t offset, uint32_t
value, uint32_t is_read_only)
+{
+    lm4549_registers *r = &s->codec_regs;
+
+    if (offset > 128)
+        DPRINTF("lm4549_store: Out of bound offset 0x%x\n", (int)offset);
+
+    r->data[offset].value = value & 0xFFFF;
+    r->data[offset].default_value = value & 0xFFFF;
+    r->data[offset].read_only = (is_read_only > 0) ? 1 : 0;
+}
+
+static void lm4549_store_reset(lm4549_state *s)
+{
+    lm4549_registers *r = &s->codec_regs;
+    int i;
+
+    for(i = 0; i < 128; i++) {
+        r->data[i].value = r->data[i].default_value;
+    }
+}
+
+static void lm4549_store(lm4549_state *s, uint32_t offset, uint16_t value)
+{
+    lm4549_registers *r = &s->codec_regs;
+
+    if (offset > 128) {
+        DPRINTF("lm4549_store: Out of bound offset 0x%x\n", (int)offset);
+    }
+
+    if (r->data[offset].read_only) {
+        DPRINTF("lm4549_store: Read-only offset 0x%x\n", (int)offset);
+        return;
+    }
+
+    r->data[offset].value = value & 0xFFFF;
+}
+
+static uint16_t lm4549_load(lm4549_state *s, uint32_t offset)
+{
+    lm4549_registers *r = &s->codec_regs;
+
+    if (offset > 128) {
+        hw_error("lm4549_load: Out of bound offset 0x%x\n", (int)offset);
+    }
+
+    return r->data[offset].value;
+}
+
+static void lm4549_audio_transfer(lm4549_state *s)
+{
+    uint32_t written_bytes, written_samples;
+    uint32_t i;
+
+    /* Activate the voice */
+    AUD_set_active_out(s->voice, 1);
+
+    /* Try to write the buffer content */
+    written_bytes = AUD_write(s->voice, s->buffer, s->buffer_level *
sizeof(uint32_t));
+    written_samples = written_bytes >> 2;
+
+#if defined(LM4549_DUMP_DAC_INPUT)
+    fwrite(s->buffer, sizeof(uint8_t), written_bytes, fp_dac_input);
+#endif
+
+    if (written_samples == s->buffer_level) {
+        s->buffer_level = 0;
+    }
+    else {
+        s->buffer_level -= written_samples;
+
+        if (s->buffer_level > 0) {
+            /* Move the data back to the start of the buffer */
+            for (i = 0; i < s->buffer_level; i++) {
+                s->buffer[i] = s->buffer[i + written_samples];
+            }
+        }
+
+        /* Regulate the data throughput by disabling further transfer
from the ACLink controller */
+        aclink_bitclk_enable(&s->aclinkdev, 0);
+    }
+}
+
+static void lm4549_audio_out_callback(void *opaque, int free)
+{
+    lm4549_state *s = (lm4549_state*)opaque;
+    static uint32_t prev_buffer_level = 0;
+
+#ifdef LM4549_DEBUG
+    int size = AUD_get_buffer_size_out(s->voice);
+    DPRINTF("lm4549_audio_out_callback size = %i free = %i\n", size, free);
+#endif
+
+    /* Detect that no more date are coming from the ACLink => disable the
voice */
+    if (s->buffer_level == prev_buffer_level) {
+        AUD_set_active_out(s->voice, 0);
+    }
+    prev_buffer_level = s->buffer_level;
+
+    /* Check if a buffer transfer is pending */
+    if (s->buffer_level == BUFFER_SIZE) {
+        lm4549_audio_transfer(s);
+    }
+
+    /* Enable the bitclk to get data again */
+    aclink_bitclk_enable(&s->aclinkdev, 1);
+}
+
+static uint32_t lm4549_read(ACLinkDevice *dev, target_phys_addr_t offset)
+{
+    lm4549_state *s = FROM_ACLINK_DEVICE(lm4549_state, dev);
+    uint32_t value = 0;
+
+    /* Read the stored value */
+    value = lm4549_load(s, offset);
+    DPRINTF("lm4549_read [0x%02x] = 0x%04x\n", offset, value);
+
+    return value;
+}
+
+static void lm4549_write(ACLinkDevice *dev, target_phys_addr_t offset,
uint32_t value)
+{
+    lm4549_state *s = FROM_ACLINK_DEVICE(lm4549_state, dev);
+
+    DPRINTF("lm4549_write [0x%02x] = 0x%04x\n", offset, value);
+
+    /* Store the new value */
+    lm4549_store(s, offset, value);
+
+    switch(offset) {
+    case LM4549_Reset:
+        lm4549_store_reset(s);
+        break;
+    case LM4549_PCM_Front_DAC_Rate:
+        DPRINTF("DAC rate change = %i\n", lm4549_load(s, offset));
+
+        /* Close the current voice */
+        AUD_close_out(&s->card, s->voice);
+        s->voice = NULL;
+
+        /* Open a voice with the new sample rate */
+        struct audsettings as;
+        as.freq = lm4549_load(s, offset);
+        as.nchannels = 2;
+        as.fmt = AUD_FMT_S16;
+        as.endianness = 0;
+
+        s->voice = AUD_open_out(
+            &s->card,
+            s->voice,
+            "lm4549.out",
+            dev,
+            lm4549_audio_out_callback,
+            &as
+        );
+        break;
+    }
+}
+
+void lm4549_sdataout_slot12(ACLinkDevice *dev, uint32_t slot1, uint32_t
slot2)
+{
+#define SLOT1_RW    (1 << 19)
+    uint16_t control = (slot1 >> 12) & 0x7F;
+    uint16_t data = (slot2 >> 4) & 0xFFFF;
+    uint32_t value = 0;
+
+    if ((slot1 & SLOT1_RW) == 0) {
+        /* Write operation */
+        lm4549_write(dev, control, data);
+    }
+    else {
+        /* Read operation */
+        value = lm4549_read(dev, control);
+
+        /* Write the return value in SDATAIN */
+        aclink_sdatain_slot12(dev, slot1 & ~SLOT1_RW, value << 4);
+    }
+}
+
+void lm4549_sdataout_slot34(ACLinkDevice *dev, uint32_t slot3, uint32_t
slot4)
+{
+    lm4549_state *s = FROM_ACLINK_DEVICE(lm4549_state, dev);
+    uint32_t sample = ((slot3 >> 4) & 0xFFFF) + (((slot4 >> 4) & 0xFFFF)
<< 16);
+
+    if (s->buffer_level >= BUFFER_SIZE) {
+        hw_error("sdataout slot34: overrun\n");
+    }
+
+    /* Store the sample in the buffer */
+    s->buffer[s->buffer_level++] = sample;
+
+    if (s->buffer_level == BUFFER_SIZE) {
+        /* Trigger the transfer of the buffer to the audio host */
+        lm4549_audio_transfer(s);
+    }
+}
+
+static int lm4549_init(ACLinkDevice *dev)
+{
+    lm4549_state *s = FROM_ACLINK_DEVICE(lm4549_state, dev);
+
+    /* Init the register store */
+    lm4549_store_init(s, LM4549_Reset,                     0x0d50, 0);
+    lm4549_store_init(s, LM4549_Master_Volume,             0x8008, 0);
+    lm4549_store_init(s, LM4549_Line_Out_Volume,           0x8000, 0);
+    lm4549_store_init(s, LM4549_Master_Volume_Mono,        0x8000, 0);
+    lm4549_store_init(s, LM4549_PC_Beep_Volume,            0x0000, 0);
+    lm4549_store_init(s, LM4549_Phone_Volume,              0x8008, 0);
+    lm4549_store_init(s, LM4549_Mic_Volume,                0x8008, 0);
+    lm4549_store_init(s, LM4549_Line_In_Volume,            0x8808, 0);
+    lm4549_store_init(s, LM4549_CD_Volume,                 0x8808, 0);
+    lm4549_store_init(s, LM4549_Video_Volume,              0x8808, 0);
+    lm4549_store_init(s, LM4549_Aux_Volume,                0x8808, 0);
+    lm4549_store_init(s, LM4549_PCM_Out_Volume,            0x8808, 0);
+    lm4549_store_init(s, LM4549_Record_Select,             0x0000, 0);
+    lm4549_store_init(s, LM4549_Record_Gain,               0x8000, 0);
+    lm4549_store_init(s, LM4549_General_Purpose,           0x0000, 0);
+    lm4549_store_init(s, LM4549_3D_Control,                0x0101, 0);
+    lm4549_store_init(s, LM4549_Powerdown_Ctrl_Stat,       0x0000, 0);
+    lm4549_store_init(s, LM4549_Extended_Audio_ID,         0x0001, 1);
+    lm4549_store_init(s, LM4549_Extended_Audio_Stat_Ctrl,  0x0000, 0);
+    lm4549_store_init(s, LM4549_PCM_Front_DAC_Rate,        0xBB80, 0);
+    lm4549_store_init(s, LM4549_PCM_ADC_Rate,              0xBB80, 0);
+    lm4549_store_init(s, LM4549_Vendor_ID1,                0x4e53, 1);
+    lm4549_store_init(s, LM4549_Vendor_ID2,                0x4331, 1);
+
+    /* Enable the ACLink clock */
+    aclink_bitclk_enable(dev, 1);
+
+    /* Register an audio card */
+    AUD_register_card("lm4549", &s->card);
+
+    /* Open a default voice */
+    struct audsettings as;
+    as.freq = 48000;
+    as.nchannels = 2;
+    as.fmt = AUD_FMT_S16;
+    as.endianness = 0;
+
+    s->voice = AUD_open_out(
+        &s->card,
+        s->voice,
+        "lm4549.out",
+        s,
+        lm4549_audio_out_callback,
+        &as
+    );
+
+    AUD_set_volume_out(s->voice, 0, 255, 255);
+
+    /* Reset the input buffer */
+    memset(s->buffer, 0x00, sizeof(s->buffer));
+    s->buffer_level = 0;
+
+#if defined(LM4549_DUMP_DAC_INPUT)
+    fp_dac_input = fopen("lm4549_dac_input.pcm", "wb");
+    if (!fp_dac_input) {
+        hw_error("Unable to open lm4549_dac_input.pcm for writing\n");
+    }
+#endif
+
+    return 0;
+}
+
+static ACLinkDeviceInfo lm4549_info = {
+    .qdev = {
+        .name = "lm4549",
+        .size = sizeof(lm4549_state)
+    },
+    .init = lm4549_init,
+    .sdataout_slot12 = lm4549_sdataout_slot12,
+    .sdataout_slot34 = lm4549_sdataout_slot34,
+};
+
+static void lm4549_register_device(void)
+{
+    aclink_register_device(&lm4549_info);
+}
+
+device_init(lm4549_register_device)
diff --git a/hw/pl041.c b/hw/pl041.c
new file mode 100644
index 0000000..fb7c311
--- /dev/null
+++ b/hw/pl041.c
@@ -0,0 +1,425 @@ 
+/*
+ * Arm PrimeCell PL041 Advanced Audio Codec Interface
+ *
+ * Copyright (c) 2010
+ * Written by Mathieu Sonet - www.elasticsheep.com
+ *
+ * This code is licenced under the GPL.
+ *
+ * *****************************************************************
+ *
+ * This driver emulates the ARM AACI interface.
+ * It connects the system bus to an ACLink bus on which an audio
+ * codec can be connected.
+ *
+ */
+
+#include "sysbus.h"
+
+#include "pl041.h"
+#include "aclink.h"
+
+/*** Debug macros ***/
+
+/* #define PL041_DEBUG_LEVEL 1 */
+
+#if defined(PL041_DEBUG_LEVEL) && (PL041_DEBUG_LEVEL >= 1)
+#define DBG_L1(fmt, ...) \
+do { printf("pl041: " fmt , ## __VA_ARGS__); } while (0)
+#else
+#define DBG_L1(fmt, ...) \
+do { } while (0)
+#endif
+
+#if defined(PL041_DEBUG_LEVEL) && (PL041_DEBUG_LEVEL >= 2)
+#define DBG_L2(fmt, ...) \
+do { printf("pl041: " fmt , ## __VA_ARGS__); } while (0)
+#else
+#define DBG_L2(fmt, ...) \
+do { } while (0)
+#endif
+
+/*** Constants ***/
+
+#define FIFO_DEPTH  16
+
+/*** Types ***/
+
+typedef struct {
+    uint32_t size;
+    uint32_t half;
+    uint32_t level;
+    uint32_t data[FIFO_DEPTH];
+} pl041_fifo;
+
+typedef struct {
+    SysBusDevice busdev;
+    qemu_irq irq;
+    pl041_regfile regs;
+    pl041_fifo fifo1;
+    ACLinkBus *aclink;
+} pl041_state;
+
+/*** Globals ***/
+
+static const unsigned char pl041_id[8] =
+{ 0x41, 0x10, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1 };
+
+#if defined(PL041_DEBUG_LEVEL)
+#define REGISTER(name, offset) #name,
+static const char* pl041_regs_name[] = {
+    #include "pl041.hx"
+};
+#undef REGISTER
+#endif
+
+/*** Local prototypes ***/
+
+static void pl041_isr1_update(pl041_state *s);
+
+/*** Functions ***/
+
+#if defined(PL041_DEBUG_LEVEL)
+static const char* get_reg_name(target_phys_addr_t offset)
+{
+    if (offset <= PL041_dr4_3) {
+        return pl041_regs_name[offset >> 2];
+    }
+
+    return "unknown";
+}
+#endif
+
+static void pl041_fifo1_push(pl041_state *s, uint32_t value)
+{
+    pl041_fifo* f = &s->fifo1;
+
+    /* Check the FIFO level */
+    if (f->level >= f->size) {
+        hw_error("fifo1 push: overrun\n");
+    }
+
+    /* Push the value in the FIFO */
+    if (f->level < f->size) {
+        s->fifo1.data[f->level++] = value;
+    }
+
+    /* Update the status register */
+    if (f->level > 0) {
+        s->regs.sr1 &= ~(TXUNDERRUN | TXFE);
+    }
+
+    if (f->level >= (f->size >> 1)) {
+        s->regs.sr1 &= ~TXHE;
+    }
+
+    if (f->level >= f->size) {
+        s->regs.sr1 |= TXFF;
+    }
+
+    DBG_L1("fifo1_push sr1 = 0x%08x\n", s->regs.sr1);
+}
+
+static void pl041_fifo1_transmit(pl041_state *s)
+{
+    pl041_fifo* f = &s->fifo1;
+    uint32_t slots = s->regs.txcr1 & TXSLOT_MASK;
+    uint32_t written_samples;
+
+    /* Check if FIFO1 transmit is enabled */
+    if ((s->regs.txcr1 & TXEN) && (slots & (TXSLOT3 | TXSLOT4))) {
+        if (f->level >= f->half) {
+            int i;
+
+            DBG_L1("Transfer FIFO level = %i\n", f->level);
+
+            /* Try to transfer the whole FIFO */
+            for(i = 0; i < f->level; i++) {
+                uint32_t sample = f->data[i];
+                uint32_t slot3, slot4;
+
+                /* Check the sample width */
+                switch(s->regs.txcr1 & TSIZE_MASK) {
+                case TSIZE_16BITS:
+                    /* 20-bit left justification */
+                    slot3 = (sample & 0xFFFF) << 4;
+                    slot4 = ((sample >> 16) & 0xFFFF) << 4;
+                    break;
+                case TSIZE_18BITS:
+                case TSIZE_20BITS:
+                case TSIZE_12BITS:
+                default:
+                    hw_error("Unsupported TSize\n");
+                    break;
+                }
+
+                /* Stop sending if the clock is disabled */
+                if (aclink_bitclk_is_enabled(s->aclink) == 0) {
+                    DBG_L1("bitclk is disabled => pause the transfer\n");
+                    break;
+                }
+
+                /* Transmit a sample on the ACLINK bus */
+                aclink_sdataout_slot34(s->aclink, slot3, slot4);
+            }
+
+            written_samples = i;
+            if (written_samples > 0) {
+                /* Update the FIFO level */
+                f->level -= written_samples;
+
+                /* Move back the pending samples to the start of the FIFO */
+                for(i = 0; i < f->level; i++)
+                    f->data[i] = f->data[written_samples + i];
+
+                /* Update the status register */
+                s->regs.sr1 &= ~TXFF;
+
+                if (f->level <= (f->size >> 1))
+                    s->regs.sr1 |= TXHE;
+
+                if (f->level == 0)
+                {
+                    s->regs.sr1 |= TXFE | TXUNDERRUN;
+                    DBG_L1("Empty FIFO\n");
+                }
+            }
+        }
+    }
+}
+
+static void pl041_isr1_update(pl041_state *s)
+{
+    uint32_t mask = 0;
+
+    /* Update ISR1 */
+    if (s->regs.sr1 & TXUNDERRUN) {
+        s->regs.isr1 |= URINTR;
+    }
+    else {
+        s->regs.isr1 &= ~URINTR;
+    }
+
+    if (s->regs.sr1 & TXHE) {
+        s->regs.isr1 |= TXINTR;
+    }
+    else {
+        s->regs.isr1 &= ~TXINTR;
+    }
+
+    if (!(s->regs.sr1 & TXBUSY) && (s->regs.sr1 & TXFE)) {
+        s->regs.isr1 |= TXCINTR;
+    }
+    else {
+        s->regs.isr1 &= ~TXCINTR;
+    }
+
+    /* Set the irq mask */
+    if (s->regs.ie1 & TXUIE) {
+        mask |= URINTR;
+    }
+
+    if (s->regs.ie1 & TXIE) {
+        mask |= TXINTR;
+    }
+
+    if (s->regs.ie1 & TXCIE) {
+        mask |= TXCINTR;
+    }
+
+    /* Update the irq state */
+    qemu_set_irq(s->irq, ((s->regs.isr1 & mask) > 0) ? 1 : 0);
+    DBG_L2("Set interrupt sr1 = 0x%08x isr1 = 0x%08x masked = 0x%08x\n",
s->regs.sr1, s->regs.isr1, s->regs.isr1 & mask);
+}
+
+static void pl041_sdatain_slot12(DeviceState *dev, uint32_t slot1,
uint32_t slot2)
+{
+    pl041_state *s = (pl041_state *)dev;
+
+    DBG_L1("pl041_sdatain_slot12 0x%08x 0x%08x\n", slot1, slot2);
+
+    s->regs.sl1rx = slot1;
+    s->regs.sl2rx = slot2;
+
+    s->regs.slfr &= ~SL1RXBUSY | ~SL2RXBUSY;
+    s->regs.slfr |= SL1RXVALID | SL2RXVALID;
+}
+
+static void pl041_bitclk_state_changed(DeviceState *dev)
+{
+    pl041_state *s = (pl041_state *)dev;
+
+    /* Check if the bitclk signal is enabled */
+    if (aclink_bitclk_is_enabled(s->aclink) == 1) {
+        DBG_L1("bitclk enabled\n");
+
+        /* Trigger pending transfers */
+        pl041_fifo1_transmit(s);
+        pl041_isr1_update(s);
+    }
+    else {
+        DBG_L1("bitclk disabled\n");
+    }
+}
+
+static uint32_t pl041_read(void *opaque, target_phys_addr_t offset)
+{
+    pl041_state *s = (pl041_state *)opaque;
+    int val;
+
+    if (offset >= 0xfe0 && offset < 0x1000) {
+        DBG_L1("pl041_read [0x%08x]\n", offset);
+        return pl041_id[(offset - 0xfe0) >> 2];
+    }
+
+    if (offset < 0x110) {
+        val = *((uint32_t*)&s->regs + (offset >> 2));
+    }
+    else {
+        hw_error("pl041_read: Bad offset %x\n", (int)offset);
+    }
+
+    switch (offset) {
+    case PL041_allints:
+        val = s->regs.isr1 & 0x7F;
+        break;
+    }
+
+    DBG_L1("pl041_read [0x%08x] %s => 0x%08x\n", offset,
get_reg_name(offset), val);
+
+    return val;
+}
+
+static void pl041_write(void *opaque, target_phys_addr_t offset,
+                        uint32_t value)
+{
+    pl041_state *s = (pl041_state *)opaque;
+
+    DBG_L1("pl041_write [0x%08x] %s <= 0x%08x\n", offset,
get_reg_name(offset), value);
+
+    /* Write the register */
+    if (offset < 0x110) {
+        *((uint32_t*)&s->regs + (offset >> 2)) = value;
+    }
+    else {
+        hw_error("pl041_write: Bad offset %x\n", (int)offset);
+    }
+
+    /* Execute the actions */
+    switch (offset) {
+#if defined(PL041_DEBUG_LEVEL) && (PL041_DEBUG_LEVEL >= 1)
+    case PL041_txcr1:
+    {
+        uint32_t txen = s->regs.txcr1 & TXEN;
+        uint32_t slots = (s->regs.txcr1 & TXSLOT_MASK) >> TXSLOT_MASK_BIT;
+        uint32_t tsize = (s->regs.txcr1 & TSIZE_MASK) >> TSIZE_MASK_BIT;
+        uint32_t compact_mode = (s->regs.txcr1 & TXCOMPACT) ? 1 : 0;
+        uint32_t txfen = (s->regs.txcr1 & TXFEN) > 0 ? 1 : 0;
+        DBG_L1("=> txen = %i slots = 0x%01x tsize = %i compact = %i txfen
= %i\n", txen, slots,  tsize, compact_mode, txfen);
+        break;
+    }
+#endif
+    case PL041_sl1tx:
+        s->regs.slfr &= ~SL1TXEMPTY;
+        aclink_sdataout_slot12(s->aclink, s->regs.sl1tx, s->regs.sl2tx);
+        break;
+
+    case PL041_sl2tx:
+        s->regs.sl2tx = value;
+        s->regs.slfr &= ~SL2TXEMPTY;
+        break;
+
+    case PL041_intclr:
+        DBG_L1("=> Clear interrupt intclr = 0x%08x isr1 = 0x%08x\n",
s->regs.intclr, s->regs.isr1);
+
+        if (s->regs.intclr & TXUEC1) {
+            s->regs.sr1 &= ~TXUNDERRUN;
+        }
+        break;
+
+#if defined(PL041_DEBUG_LEVEL)
+    case PL041_maincr:
+    {
+        char debug[] = " AACIFE  SL1RXEN  SL1TXEN";
+        if (!(value & AACIFE)) debug[0] = '!';
+        if (!(value & SL1RXEN)) debug[8] = '!';
+        if (!(value & SL1TXEN)) debug[17] = '!';
+        DBG_L1("%s\n", debug);
+        break;
+    }
+#endif
+
+    case PL041_dr1_0:
+    case PL041_dr1_1:
+    case PL041_dr1_2:
+    case PL041_dr1_3:
+        pl041_fifo1_push(s, value);
+        break;
+    }
+
+    /* Transmit the FIFO content */
+    pl041_fifo1_transmit(s);
+
+    /* Update the ISR1 register */
+    pl041_isr1_update(s);
+}
+
+static void pl041_reset(pl041_state *s)
+{
+    memset(&s->regs, 0x00, sizeof(pl041_regfile));
+
+    s->regs.slfr = SL1TXEMPTY | SL2TXEMPTY | SL12TXEMPTY;
+    s->regs.sr1 = TXFE | RXFE | TXHE;
+    s->regs.isr1 = 0;
+
+    s->fifo1.size = FIFO_DEPTH;
+    s->fifo1.half = FIFO_DEPTH >> 1;
+    s->fifo1.level = 0;
+    memset(s->fifo1.data, 0x00, sizeof(s->fifo1.data));
+}
+
+static CPUReadMemoryFunc * const pl041_readfn[] = {
+   pl041_read,
+   pl041_read,
+   pl041_read
+};
+
+static CPUWriteMemoryFunc * const pl041_writefn[] = {
+   pl041_write,
+   pl041_write,
+   pl041_write
+};
+
+static ACLinkControllerInfo pl041_controller_info = {
+    .sdatain_slot12 = pl041_sdatain_slot12,
+    .bitclk_state_changed = pl041_bitclk_state_changed,
+};
+
+static int pl041_init(SysBusDevice *dev)
+{
+    pl041_state *s = FROM_SYSBUS(pl041_state, dev);
+    int iomemtype;
+
+    DBG_L1("pl041_init\n");
+
+    /* Connect the device to the sysbus */
+    iomemtype = cpu_register_io_memory(pl041_readfn, pl041_writefn, s);
+    sysbus_init_mmio(dev, 0x1000, iomemtype);
+    sysbus_init_irq(dev, &s->irq);
+
+    /* Create the ACLink bus */
+    s->aclink = aclink_create_bus(&dev->qdev, "aclink");
+    aclink_set_controller_info(s->aclink, &pl041_controller_info);
+
+    /* Reset the device */
+    pl041_reset(s);
+
+    return 0;
+}
+
+static void pl041_register_devices(void)
+{
+    sysbus_register_dev("pl041", sizeof(pl041_state), pl041_init);
+}
+
+device_init(pl041_register_devices)
diff --git a/hw/pl041.h b/hw/pl041.h
new file mode 100644
index 0000000..aae87bd
--- /dev/null
+++ b/hw/pl041.h
@@ -0,0 +1,119 @@ 
+/*
+ * Arm PrimeCell PL041 Advanced Audio Codec Interface
+ *
+ * Copyright (c) 2010
+ * Written by Mathieu Sonet - www.elasticsheep.com
+ *
+ * This code is licenced under the GPL.
+ */
+
+/* Register file */
+#define REGISTER(name, offset) uint32_t name;
+typedef struct {
+    #include "pl041.hx"
+} pl041_regfile;
+#undef REGISTER
+
+/* Register addresses */
+#define REGISTER(name, offset) PL041_##name = offset,
+enum {
+    #include "pl041.hx"
+};
+#undef REGISTER
+
+/* Register bits */
+
+/* IEx */
+#define TXCIE           (1 << 0)
+#define RXTIE           (1 << 1)
+#define TXIE            (1 << 2)
+#define RXIE            (1 << 3)
+#define RXOIE           (1 << 4)
+#define TXUIE           (1 << 5)
+#define RXTOIE          (1 << 6)
+
+/* TXCRx */
+#define TXEN            (1 << 0)
+#define TXSLOT1         (1 << 1)
+#define TXSLOT2         (1 << 2)
+#define TXSLOT3         (1 << 3)
+#define TXSLOT4         (1 << 4)
+#define TXCOMPACT       (1 << 15)
+#define TXFEN           (1 << 16)
+
+#define TXSLOT_MASK_BIT (1)
+#define TXSLOT_MASK     (0xFFF << TXSLOT_MASK_BIT)
+
+#define TSIZE_MASK_BIT  (13)
+#define TSIZE_MASK      (0x3 << TSIZE_MASK_BIT)
+
+#define TSIZE_16BITS    (0x0 << TSIZE_MASK_BIT)
+#define TSIZE_18BITS    (0x1 << TSIZE_MASK_BIT)
+#define TSIZE_20BITS    (0x2 << TSIZE_MASK_BIT)
+#define TSIZE_12BITS    (0x3 << TSIZE_MASK_BIT)
+
+/* SRx */
+#define RXFE         (1 << 0)
+#define TXFE         (1 << 1)
+#define RXHF         (1 << 2)
+#define TXHE         (1 << 3)
+#define RXFF         (1 << 4)
+#define TXFF         (1 << 5)
+#define RXBUSY       (1 << 6)
+#define TXBUSY       (1 << 7)
+#define RXOVERRUN    (1 << 8)
+#define TXUNDERRUN   (1 << 9)
+#define RXTIMEOUT    (1 << 10)
+#define RXTOFE       (1 << 11)
+
+/* ISRx */
+#define TXCINTR      (1 << 0)
+#define RXTOINTR     (1 << 1)
+#define TXINTR       (1 << 2)
+#define RXINTR       (1 << 3)
+#define ORINTR       (1 << 4)
+#define URINTR       (1 << 5)
+#define RXTOFEINTR   (1 << 6)
+
+/* SLFR */
+#define SL1RXBUSY    (1 << 0)
+#define SL1TXBUSY    (1 << 1)
+#define SL2RXBUSY    (1 << 2)
+#define SL2TXBUSY    (1 << 3)
+#define SL12RXBUSY   (1 << 4)
+#define SL12TXBUSY   (1 << 5)
+#define SL1RXVALID   (1 << 6)
+#define SL1TXEMPTY   (1 << 7)
+#define SL2RXVALID   (1 << 8)
+#define SL2TXEMPTY   (1 << 9)
+#define SL12RXVALID  (1 << 10)
+#define SL12TXEMPTY  (1 << 11)
+#define RAWGPIOINT   (1 << 12)
+#define RWIS         (1 << 13)
+
+/* MAINCR */
+#define AACIFE       (1 << 0)
+#define LOOPBACK     (1 << 1)
+#define LOWPOWER     (1 << 2)
+#define SL1RXEN      (1 << 3)
+#define SL1TXEN      (1 << 4)
+#define SL2RXEN      (1 << 5)
+#define SL2TXEN      (1 << 6)
+#define SL12RXEN     (1 << 7)
+#define SL12TXEN     (1 << 8)
+#define DMAENABLE    (1 << 9)
+
+/* INTCLR */
+#define WISC         (1 << 0)
+#define RXOEC1       (1 << 1)
+#define RXOEC2       (1 << 2)
+#define RXOEC3       (1 << 3)
+#define RXOEC4       (1 << 4)
+#define TXUEC1       (1 << 5)
+#define TXUEC2       (1 << 6)
+#define TXUEC3       (1 << 7)
+#define TXUEC4       (1 << 8)
+#define RXTOFEC1     (1 << 9)
+#define RXTOFEC2     (1 << 10)
+#define RXTOFEC3     (1 << 11)
+#define RXTOFEC4     (1 << 12)
diff --git a/hw/pl041.hx b/hw/pl041.hx
new file mode 100644
index 0000000..65383c6
--- /dev/null
+++ b/hw/pl041.hx
@@ -0,0 +1,55 @@ 
+/*
+ * Arm PrimeCell PL041 Advanced Audio Codec Interface
+ *
+ * Copyright (c) 2010
+ * Written by Mathieu Sonet - www.elasticsheep.com
+ *
+ * This code is licenced under the GPL.
+ */
+
+/* PL041 register file description */
+
+REGISTER( rxcr1,   0x00 )
+REGISTER( txcr1,   0x04 )
+REGISTER( sr1,     0x08 )
+REGISTER( isr1,    0x0C )
+REGISTER( ie1,     0x10 )
+REGISTER( rxcr2,   0x14 )
+REGISTER( txcr2,   0x18 )
+REGISTER( sr2,     0x1C )
+REGISTER( isr2,    0x20 )
+REGISTER( ie2,     0x24 )
+REGISTER( rxcr3,   0x28 )
+REGISTER( txcr3,   0x2C )
+REGISTER( sr3,     0x30 )
+REGISTER( isr3,    0x34 )
+REGISTER( ie3,     0x38 )
+REGISTER( rxcr4,   0x3C )
+REGISTER( txcr4,   0x40 )
+REGISTER( sr4,     0x44 )
+REGISTER( isr4,    0x48 )
+REGISTER( ie4,     0x4C )
+REGISTER( sl1rx,   0x50 )
+REGISTER( sl1tx,   0x54 )
+REGISTER( sl2rx,   0x58 )
+REGISTER( sl2tx,   0x5C )
+REGISTER( sl12rx,  0x60 )
+REGISTER( sl12tx,  0x64 )
+REGISTER( slfr,    0x68 )
+REGISTER( slistat, 0x6C )
+REGISTER( slien,   0x70 )
+REGISTER( intclr,  0x74 )
+REGISTER( maincr,  0x78 )
+REGISTER( reset,   0x7C )
+REGISTER( sync,    0x80 )
+REGISTER( allints, 0x84 )
+REGISTER( mainfr,  0x88 )
+REGISTER( unused,  0x8C )
+REGISTER( dr1_0,   0x90 )
+REGISTER( dr1_1,   0x94 )
+REGISTER( dr1_2,   0x98 )
+REGISTER( dr1_3,   0x9C )
+REGISTER( dr1_4,   0xA0 )
+REGISTER( dr1_5,   0xA4 )
+REGISTER( dr1_6,   0xA8 )
+REGISTER( dr1_7,   0xAC )
diff --git a/hw/versatilepb.c b/hw/versatilepb.c
index 391f5b8..89d775d 100644
--- a/hw/versatilepb.c
+++ b/hw/versatilepb.c
@@ -16,6 +16,7 @@ 
 #include "pci.h"
 #include "usb-ohci.h"
 #include "boards.h"
+#include "aclink.h"

 /* Primary interrupt controller.  */

@@ -245,6 +246,11 @@  static void versatile_init(ram_addr_t ram_size,
     /* Add PL031 Real Time Clock. */
     sysbus_create_simple("pl031", 0x101e8000, pic[10]);

+    /* Add PL041 AACI Interface and connect the LM4549 codec */
+    dev = sysbus_create_varargs("pl041", 0x10004000, sic[24]);
+    ACLinkBus* bus = (ACLinkBus*)qdev_get_child_bus(dev, "aclink");
+    aclink_create_device(bus, "lm4549");
+
     /* Memory map for Versatile/PB:  */
     /* 0x10000000 System registers.  */
     /* 0x10001000 PCI controller config registers.  */