1
0
Fork 0
forked from len0rd/rockbox

as3525: use DMA for recording

Flyspray: FS#11257

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@25980 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Rafaël Carré 2010-05-13 05:26:12 +00:00
parent 9abd82fc04
commit d556f26820
3 changed files with 74 additions and 112 deletions

View file

@ -517,6 +517,7 @@ CE lines
/* PCM addresses for obtaining buffers will be what DMA is using (physical) */
#define HAVE_PCM_DMA_ADDRESS
#define HAVE_PCM_REC_DMA_ADDRESS
/* Timer frequency */
#define TIMER_FREQ (24000000 / 16)

View file

@ -134,18 +134,19 @@ void pcm_postinit(void)
audiohw_postinit();
}
static unsigned mclk_divider(void)
{
/* TODO : use a table ? */
return (((AS3525_MCLK_FREQ/128) + (pcm_sampr/2)) / pcm_sampr) - 1;
}
void pcm_dma_apply_settings(void)
{
unsigned long frequency = pcm_sampr;
/* TODO : use a table ? */
const int divider = ((AS3525_MCLK_FREQ/128) + (frequency/2)) / frequency;
int cgu_audio = CGU_AUDIO; /* read register */
cgu_audio &= ~(3 << 0); /* clear i2sout MCLK_SEL */
cgu_audio |= (AS3525_MCLK_SEL << 0); /* set i2sout MCLK_SEL */
cgu_audio &= ~(511 << 2); /* clear i2sout divider */
cgu_audio |= (divider - 1) << 2; /* set new i2sout divider */
cgu_audio |= mclk_divider() << 2; /* set new i2sout divider */
CGU_AUDIO = cgu_audio; /* write back register */
}
@ -174,166 +175,128 @@ void * pcm_dma_addr(void *addr)
** Recording DMA transfer
**/
#ifdef HAVE_RECORDING
#define I2SIN_RECORDING_MASK ( I2SIN_MASK_POER | I2SIN_MASK_PUER | \
I2SIN_MASK_POHF | I2SIN_MASK_POAF | I2SIN_MASK_POF )
static int rec_locked = 0;
static unsigned int *rec_start_addr;
static size_t rec_size;
static unsigned char *rec_dma_start_addr;
static size_t rec_dma_size;
static void rec_dma_callback(void);
void pcm_rec_lock(void)
{
if(++rec_locked == 1) {
int vic_state = disable_irq_save();
VIC_INT_EN_CLEAR = INTERRUPT_I2SIN;
I2SIN_MASK = 0;
restore_irq( vic_state );
}
if(++rec_locked == 1)
VIC_INT_EN_CLEAR = INTERRUPT_DMAC;
}
void pcm_rec_unlock(void)
{
if(--rec_locked == 0) {
int vic_state = disable_irq_save();
VIC_INT_ENABLE = INTERRUPT_I2SIN;
I2SIN_MASK = I2SIN_RECORDING_MASK;
restore_irq( vic_state );
if(--rec_locked == 0)
VIC_INT_ENABLE = INTERRUPT_DMAC;
}
static void rec_dma_start(void)
{
void* addr = rec_dma_start_addr;
size_t size = rec_dma_size;
/* We are limited to 8188 DMA transfers, and the recording core asks for
* 8192 bytes. Avoid splitting 8192 bytes transfers in 8188 + 4 */
if(size > 4096)
size = 4096;
rec_dma_size -= size;
rec_dma_start_addr += size;
dma_enable_channel(1, (void*)I2SIN_DATA, addr, DMA_PERI_I2SIN,
DMAC_FLOWCTRL_DMAC_PERI_TO_MEM, false, true, size >> 2, DMA_S4,
rec_dma_callback);
}
static void rec_dma_callback(void)
{
if(!rec_dma_size)
{
register pcm_more_callback_type2 more_ready = pcm_callback_more_ready;
if (!more_ready || more_ready(0) < 0)
{
/* Finished recording */
pcm_rec_dma_stop();
pcm_rec_dma_stopped_callback();
return;
}
}
rec_dma_start();
}
void pcm_rec_dma_record_more(void *start, size_t size)
{
rec_start_addr = start;
rec_size = size;
dump_dcache_range(start, size);
rec_dma_start_addr = start;
rec_dma_size = size;
}
void pcm_rec_dma_stop(void)
{
int vic_state = disable_irq_save();
VIC_INT_EN_CLEAR = INTERRUPT_I2SIN;
I2SIN_MASK = 0;
restore_irq( vic_state );
dma_disable_channel(1);
rec_dma_size = 0;
dma_release();
I2SOUT_CONTROL &= ~(1<<5); /* source = i2soutif fifo */
I2SIN_CONTROL &= ~(1<<11); /* disable dma */
CGU_AUDIO &= ~((1<<23)|(1<<11));
CGU_PERI &= ~(CGU_I2SIN_APB_CLOCK_ENABLE|CGU_I2SOUT_APB_CLOCK_ENABLE);
}
void INT_I2SIN(void)
{
register int status;
register pcm_more_callback_type2 more_ready;
status = I2SIN_STATUS;
if ( status & ((1<<6)|(1<<0)) ) /* errors */
panicf("i2sin error: 0x%x = %s %s", status,
(status & (1<<6)) ? "push" : "",
(status & (1<<0)) ? "pop" : ""
);
/* called at half full so it's safe to pull 16 FIFO reads in one chunk */
if( rec_size >= 16*4 )
{
/* unrolled loop */
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
*rec_start_addr++ = *I2SIN_DATA;
rec_size -= 16*4; /* 16x4byte reads */
}
/* read out any odd samples left */
while (((I2SIN_RAW_STATUS & (1<<5)) == 0) && rec_size)
{
/* 14 bits per sample = 1 32 bits word */
*rec_start_addr++ = *I2SIN_DATA;
rec_size -= 4;
}
I2SIN_CLEAR = status;
if(!rec_size)
{
more_ready = pcm_callback_more_ready;
if(!more_ready || more_ready(0) < 0)
{
/* Finished recording */
pcm_rec_dma_stop();
pcm_rec_dma_stopped_callback();
}
}
}
void pcm_rec_dma_start(void *addr, size_t size)
{
rec_start_addr = addr;
rec_size = size;
dump_dcache_range(addr, size);
rec_dma_start_addr = addr;
rec_dma_size = size;
dma_retain();
CGU_PERI |= CGU_I2SIN_APB_CLOCK_ENABLE|CGU_I2SOUT_APB_CLOCK_ENABLE;
CGU_AUDIO |= ((1<<23)|(1<<11));
I2SOUT_CONTROL |= 1<<5; /* source = loopback from i2sin fifo */
/* 14 bits samples, i2c clk src = I2SOUTIF, sdata src = AFE,
* data valid at positive edge of SCLK */
I2SIN_CONTROL = (1<<5) | (1<<2);
I2SIN_CONTROL |= (1<<11)|(1<<5); /* enable dma, 14bits samples */
unsigned long tmp;
while ( ( I2SIN_RAW_STATUS & ( 1<<5 ) ) == 0 )
tmp = *I2SIN_DATA; /* FLUSH FIFO */
I2SIN_CLEAR = (1<<6)|(1<<0); /* push error, pop error */
I2SIN_MASK = I2SIN_RECORDING_MASK;
VIC_INT_ENABLE = INTERRUPT_I2SIN;
rec_dma_start();
}
void pcm_rec_dma_close(void)
{
pcm_rec_dma_stop();
}
void pcm_rec_dma_init(void)
{
unsigned long frequency = pcm_sampr;
/* TODO : use a table ? */
const int divider = ((AS3525_MCLK_FREQ/128) + (frequency/2)) / frequency;
int cgu_audio = CGU_AUDIO; /* read register */
cgu_audio &= ~(3 << 12); /* clear i2sin MCLK_SEL */
cgu_audio |= (AS3525_MCLK_SEL << 12); /* set i2sin MCLK_SEL */
cgu_audio &= ~(511 << 14); /* clear i2sin divider */
cgu_audio |= (divider - 1) << 14; /* set new i2sin divider */
cgu_audio |= mclk_divider() << 14; /* set new i2sin divider */
CGU_AUDIO = cgu_audio; /* write back register */
/* i2c clk src = I2SOUTIF, sdata src = AFE,
* data valid at positive edge of SCLK */
I2SIN_CONTROL = (1<<2);
}
const void * pcm_rec_dma_get_peak_buffer(void)
{
return (const void*)rec_start_addr;
return rec_dma_start_addr;
}
#endif /* HAVE_RECORDING */

View file

@ -262,7 +262,6 @@ clean_dcache_range:
bx lr @
.size clean_dcache_range, .-clean_dcache_range
#if 0 /* unused */
/*
* Dump DCache for this range
* will *NOT* do write back except for buffer edges not on a line boundary
@ -318,7 +317,6 @@ clean_dcache_range:
mcr p15, 0, r0, c7, c10, 4 @ Drain write buffer
bx lr @
.size dump_dcache_range, .-dump_dcache_range
#endif /* unused function */
/*
* Cleans entire DCache