[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 <cont...@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 + * + */ + +#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. */ -- 1.7.0.4