/*************************************************************************** * __________ __ ___. * Open \______ \ ____ ____ | | _\_ |__ _______ ___ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ * \/ \/ \/ \/ \/ * $Id$ * * Copyright (C) 2006 by Michael Sevakis * Copyright (C) 2008 by Rob Purchase * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version 2 * of the License, or (at your option) any later version. * * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY * KIND, either express or implied. * ****************************************************************************/ #include #include "system.h" #include "kernel.h" #include "logf.h" #include "audio.h" #include "sound.h" #include "i2s.h" #include "pcm.h" #include "pcm-internal.h" struct dma_data { /* NOTE: The order of size and p is important if you use assembler optimised fiq handler, so don't change it. */ uint16_t *p; size_t size; #if NUM_CORES > 1 unsigned core; #endif int locked; int state; }; /**************************************************************************** ** Playback DMA transfer **/ struct dma_data dma_play_data SHAREDBSS_ATTR = { /* Initialize to a locked, stopped state */ .p = NULL, .size = 0, #if NUM_CORES > 1 .core = 0x00, #endif .locked = 0, .state = 0 }; const void * pcm_play_dma_get_peak_buffer(int *count) { unsigned long addr = (unsigned long)dma_play_data.p; size_t cnt = dma_play_data.size; *count = cnt >> 2; return (void *)((addr + 2) & ~3); } void pcm_play_dma_init(void) { DAVC = 0x0; /* Digital Volume = max */ #ifdef COWON_D2 /* Set DAI clock divided from PLL0 (192MHz). The best approximation of 256*44.1kHz is 11.291MHz. */ BCLKCTR &= ~DEV_DAI; PCLK_DAI = (1<<28) | 61682; /* DCO mode */ BCLKCTR |= DEV_DAI; /* Enable DAI block in Master mode, 256fs->32fs, 16bit LSB */ DAMR = 0x3c8e80; #elif defined(IAUDIO_7) BCLKCTR &= ~DEV_DAI; PCLK_DAI = (0x800a << 16) | (PCLK_DAI & 0xffff); BCLKCTR |= DEV_DAI; /* Master mode, 256->64fs, 16bit LSB*/ DAMR = 0x3cce20; #elif defined(LOGIK_DAX) /* TODO */ #elif defined(SANSA_M200) /* TODO */ #elif defined(SANSA_C100) /* TODO */ #else #error "Target isn't supported" #endif /* Set DAI interrupts as FIQs */ IRQSEL = ~(DAI_RX_IRQ_MASK | DAI_TX_IRQ_MASK); /* Initialize default register values. */ audiohw_init(); dma_play_data.size = 0; #if NUM_CORES > 1 dma_play_data.core = 0; /* no core in control */ #endif } void pcm_play_dma_postinit(void) { audiohw_postinit(); } void pcm_dma_apply_settings(void) { } static void play_start_pcm(void) { DAMR &= ~(1<<14); /* disable tx */ dma_play_data.state = 1; if (dma_play_data.size >= 16) { DADO_L(0) = *dma_play_data.p++; DADO_R(0) = *dma_play_data.p++; DADO_L(1) = *dma_play_data.p++; DADO_R(1) = *dma_play_data.p++; DADO_L(2) = *dma_play_data.p++; DADO_R(2) = *dma_play_data.p++; DADO_L(3) = *dma_play_data.p++; DADO_R(3) = *dma_play_data.p++; dma_play_data.size -= 16; } DAMR |= (1<<14); /* enable tx */ } static void play_stop_pcm(void) { DAMR &= ~(1<<14); /* disable tx */ dma_play_data.state = 0; } void pcm_play_dma_start(const void *addr, size_t size) { dma_play_data.p = (uint16_t*)addr; dma_play_data.size = size; #if NUM_CORES > 1 /* This will become more important later - and different ! */ dma_play_data.core = processor_id(); /* save initiating core */ #endif IEN |= DAI_TX_IRQ_MASK; play_start_pcm(); } void pcm_play_dma_stop(void) { play_stop_pcm(); dma_play_data.size = 0; #if NUM_CORES > 1 dma_play_data.core = 0; /* no core in control */ #endif } void pcm_play_lock(void) { int status = disable_fiq_save(); if (++dma_play_data.locked == 1) { IEN &= ~DAI_TX_IRQ_MASK; } restore_fiq(status); } void pcm_play_unlock(void) { int status = disable_fiq_save(); if (--dma_play_data.locked == 0 && dma_play_data.state != 0) { IEN |= DAI_TX_IRQ_MASK; } restore_fiq(status); } void pcm_play_dma_pause(bool pause) { if (pause) { play_stop_pcm(); } else { play_start_pcm(); } } size_t pcm_get_bytes_waiting(void) { return dma_play_data.size & ~3; } #ifdef HAVE_RECORDING /* TODO: implement */ void pcm_rec_dma_init(void) { } void pcm_rec_dma_close(void) { } void pcm_rec_dma_start(void *addr, size_t size) { (void) addr; (void) size; } void pcm_rec_dma_stop(void) { } void pcm_rec_lock(void) { } void pcm_rec_unlock(void) { } const void * pcm_rec_dma_get_peak_buffer(void) { return NULL; } #endif #if defined(CPU_TCC77X) || defined(CPU_TCC780X) void fiq_handler(void) ICODE_ATTR __attribute__((naked)); void fiq_handler(void) { /* r10 contains DADO_L0 base address (set in crt0.S to minimise code in the * FIQ handler. r11 contains address of p (also set in crt0.S). Most other * addresses we need are generated by using offsets with these two. * r8 and r9 contains local copies of p and size respectively. * r0-r3 and r12 is a working register. */ asm volatile ( "stmfd sp!, { r0-r4, lr } \n" /* stack scratch regs and lr */ "mov r4, #0 \n" /* Was the callback called? */ #if defined(CPU_TCC780X) "mov r8, #0xc000 \n" /* DAI_TX_IRQ_MASK | DAI_RX_IRQ_MASK */ "ldr r9, =0xf3001004 \n" /* CREQ */ #elif defined(CPU_TCC77X) "mov r8, #0x0030 \n" /* DAI_TX_IRQ_MASK | DAI_RX_IRQ_MASK */ "ldr r9, =0x80000104 \n" /* CREQ */ #endif "str r8, [r9] \n" /* clear DAI IRQs */ "ldmia r11, { r8-r9 } \n" /* r8 = p, r9 = size */ "cmp r9, #0x10 \n" /* is size <16? */ "blt .more_data \n" /* if so, ask pcmbuf for more data */ ".fill_fifo: \n" "ldr r12, [r8], #4 \n" /* load two samples */ "str r12, [r10, #0x0] \n" /* write top sample to DADO_L0 */ "mov r12, r12, lsr #16 \n" /* put right sample at the bottom */ "str r12, [r10, #0x4] \n" /* write low sample to DADO_R0*/ "ldr r12, [r8], #4 \n" /* load two samples */ "str r12, [r10, #0x8] \n" /* write top sample to DADO_L1 */ "mov r12, r12, lsr #16 \n" /* put right sample at the bottom */ "str r12, [r10, #0xc] \n" /* write low sample to DADO_R1*/ "ldr r12, [r8], #4 \n" /* load two samples */ "str r12, [r10, #0x10] \n" /* write top sample to DADO_L2 */ "mov r12, r12, lsr #16 \n" /* put right sample at the bottom */ "str r12, [r10, #0x14] \n" /* write low sample to DADO_R2*/ "ldr r12, [r8], #4 \n" /* load two samples */ "str r12, [r10, #0x18] \n" /* write top sample to DADO_L3 */ "mov r12, r12, lsr #16 \n" /* put right sample at the bottom */ "str r12, [r10, #0x1c] \n" /* write low sample to DADO_R3*/ "sub r9, r9, #0x10 \n" /* 4 words written */ "stmia r11, { r8-r9 } \n" /* save p and size */ "cmp r4, #0 \n" /* Callback called? */ "beq .exit \n" /* "mov r4, #0 \n" If get_more could be called multiple times! */ "ldr r2, =pcm_play_dma_started\n" "ldr r2, [r2] \n" "cmp r2, #0 \n" "blxne r2 \n" ".exit: \n" "ldmfd sp!, { r0-r4, lr } \n" "subs pc, lr, #4 \n" /* FIQ specific return sequence */ ".more_data: \n" "mov r4, #1 \n" /* Remember we got more data in this FIQ */ "ldr r2, =pcm_play_get_more_callback \n" "mov r0, r11 \n" /* r0 = &p */ "add r1, r11, #4 \n" /* r1 = &size */ "blx r2 \n" /* call pcm_play_get_more_callback */ "ldmia r11, { r8-r9 } \n" /* load new p and size */ "cmp r9, #0x10 \n" /* did we actually get enough data? */ "bpl .fill_fifo \n" /* not stop and enough? refill */ "b .exit \n" ".ltorg \n" ); } #else /* C version for reference */ void fiq_handler(void) ICODE_ATTR; void fiq_handler(void) { register bool new_buffer = false; if (dma_play_data.size < 16) { /* p is empty, get some more data */ new_buffer = true; pcm_play_get_more_callback((void**)&dma_play_data.p, &dma_play_data.size); } if (dma_play_data.size >= 16) { DADO_L(0) = *dma_play_data.p++; DADO_R(0) = *dma_play_data.p++; DADO_L(1) = *dma_play_data.p++; DADO_R(1) = *dma_play_data.p++; DADO_L(2) = *dma_play_data.p++; DADO_R(2) = *dma_play_data.p++; DADO_L(3) = *dma_play_data.p++; DADO_R(3) = *dma_play_data.p++; dma_play_data.size -= 16; } /* Clear FIQ status */ CREQ = DAI_TX_IRQ_MASK | DAI_RX_IRQ_MASK; if (new_buffer) pcm_play_dma_started_callback(); } #endif /* TODO: required by wm8731 codec */ void i2s_reset(void) { /* DAMR = 0; */ }