forked from len0rd/rockbox
Iriver iFP7xx sound support.
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@10552 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Tomasz Malesinski
parent
0623841091
commit
4e5f4ee5e0
4 changed files with 197 additions and 6 deletions
|
|
@ -33,6 +33,8 @@
|
|||
#include "tlv320.h"
|
||||
#elif defined(HAVE_WM8731) || defined(HAVE_WM8721)
|
||||
#include "wm8731l.h"
|
||||
#elif CONFIG_CPU == PNX0101
|
||||
#include "pnx0101.h"
|
||||
#endif
|
||||
#include "system.h"
|
||||
#include "logf.h"
|
||||
|
|
@ -55,9 +57,9 @@ static bool pcm_paused;
|
|||
/* the registered callback function to ask for more mp3 data */
|
||||
static void (*callback_for_more)(unsigned char**, size_t*) IDATA_ATTR = NULL;
|
||||
|
||||
#if (CONFIG_CPU == PNX0101 || CONFIG_CPU == S3C2440)
|
||||
#if (CONFIG_CPU == S3C2440)
|
||||
|
||||
/* TODO: Implement for iFP7xx
|
||||
/* TODO: Implement for Gigabeat
|
||||
For now, just implement some dummy functions.
|
||||
*/
|
||||
|
||||
|
|
@ -526,6 +528,168 @@ void pcm_init(void)
|
|||
dma_stop();
|
||||
}
|
||||
|
||||
#elif (CONFIG_CPU == PNX0101)
|
||||
|
||||
#define DMA_BUF_SAMPLES 0x100
|
||||
|
||||
short __attribute__((section(".dmabuf"))) dma_buf_left[DMA_BUF_SAMPLES];
|
||||
short __attribute__((section(".dmabuf"))) dma_buf_right[DMA_BUF_SAMPLES];
|
||||
|
||||
static int pcm_freq = 44100; /* 44.1 is default */
|
||||
|
||||
unsigned short* p IBSS_ATTR;
|
||||
size_t p_size IBSS_ATTR;
|
||||
|
||||
static void dma_start(const void *addr, size_t size)
|
||||
{
|
||||
p = (unsigned short*)addr;
|
||||
p_size = size;
|
||||
|
||||
pcm_playing = true;
|
||||
}
|
||||
|
||||
static void dma_stop(void)
|
||||
{
|
||||
pcm_playing = false;
|
||||
}
|
||||
|
||||
static inline void fill_dma_buf(int offset)
|
||||
{
|
||||
short *l, *r, *lend;
|
||||
|
||||
l = dma_buf_left + offset;
|
||||
lend = l + DMA_BUF_SAMPLES / 2;
|
||||
r = dma_buf_right + offset;
|
||||
|
||||
if (pcm_playing && !pcm_paused)
|
||||
{
|
||||
do
|
||||
{
|
||||
int count;
|
||||
unsigned short *tmp_p;
|
||||
count = MIN(p_size / 4, (size_t)(lend - l));
|
||||
tmp_p = p;
|
||||
p_size -= count * 4;
|
||||
|
||||
if ((int)l & 3)
|
||||
{
|
||||
*l++ = *tmp_p++;
|
||||
*r++ = *tmp_p++;
|
||||
count--;
|
||||
}
|
||||
while (count >= 4)
|
||||
{
|
||||
asm("ldmia %0!, {r0, r1, r2, r3}\n\t"
|
||||
"and r4, r0, %3\n\t"
|
||||
"orr r4, r4, r1, lsl #16\n\t"
|
||||
"and r5, r2, %3\n\t"
|
||||
"orr r5, r5, r3, lsl #16\n\t"
|
||||
"stmia %1!, {r4, r5}\n\t"
|
||||
"bic r4, r1, %3\n\t"
|
||||
"orr r4, r4, r0, lsr #16\n\t"
|
||||
"bic r5, r3, %3\n\t"
|
||||
"orr r5, r5, r2, lsr #16\n\t"
|
||||
"stmia %2!, {r4, r5}"
|
||||
: "+r" (tmp_p), "+r" (l), "+r" (r)
|
||||
: "r" (0xffff)
|
||||
: "r0", "r1", "r2", "r3", "r4", "r5", "memory");
|
||||
count -= 4;
|
||||
}
|
||||
while (count > 0)
|
||||
{
|
||||
*l++ = *tmp_p++;
|
||||
*r++ = *tmp_p++;
|
||||
count--;
|
||||
}
|
||||
p = tmp_p;
|
||||
if (l >= lend)
|
||||
return;
|
||||
else if (callback_for_more)
|
||||
callback_for_more((unsigned char**)&p,
|
||||
&p_size);
|
||||
}
|
||||
while (p_size);
|
||||
pcm_playing = false;
|
||||
}
|
||||
|
||||
if (l < lend)
|
||||
{
|
||||
memset(l, 0, sizeof(short) * (lend - l));
|
||||
memset(r, 0, sizeof(short) * (lend - l));
|
||||
}
|
||||
}
|
||||
|
||||
static void audio_irq(void)
|
||||
{
|
||||
unsigned long st = DMAINTSTAT & ~DMAINTEN;
|
||||
int i;
|
||||
for (i = 0; i < 2; i++)
|
||||
if (st & (1 << i))
|
||||
{
|
||||
fill_dma_buf((i == 1) ? 0 : DMA_BUF_SAMPLES / 2);
|
||||
DMAINTSTAT = 1 << i;
|
||||
}
|
||||
}
|
||||
|
||||
unsigned long physical_address(void *p)
|
||||
{
|
||||
unsigned long adr = (unsigned long)p;
|
||||
return (MMUBLOCK((adr >> 21) & 0xf) << 21) | (adr & ((1 << 21) - 1));
|
||||
}
|
||||
|
||||
void pcm_init(void)
|
||||
{
|
||||
int i;
|
||||
callback_for_more = NULL;
|
||||
pcm_playing = false;
|
||||
pcm_paused = false;
|
||||
|
||||
memset(dma_buf_left, 0, sizeof(dma_buf_left));
|
||||
memset(dma_buf_right, 0, sizeof(dma_buf_right));
|
||||
|
||||
for (i = 0; i < 8; i++)
|
||||
{
|
||||
DMASRC(i) = 0;
|
||||
DMADEST(i) = 0;
|
||||
DMALEN(i) = 0x1ffff;
|
||||
DMAR0C(i) = 0;
|
||||
DMAR10(i) = 0;
|
||||
DMAR1C(i) = 0;
|
||||
}
|
||||
|
||||
DMAINTSTAT = 0xc000ffff;
|
||||
DMAINTEN = 0xc000ffff;
|
||||
|
||||
DMASRC(0) = physical_address(dma_buf_left);
|
||||
DMADEST(0) = 0x80200280;
|
||||
DMALEN(0) = 0xff;
|
||||
DMAR1C(0) = 0;
|
||||
DMAR0C(0) = 0x40408;
|
||||
|
||||
DMASRC(1) = physical_address(dma_buf_right);
|
||||
DMADEST(1) = 0x80200284;
|
||||
DMALEN(1) = 0xff;
|
||||
DMAR1C(1) = 0;
|
||||
DMAR0C(1) = 0x40409;
|
||||
|
||||
irq_set_int_handler(0x1b, audio_irq);
|
||||
irq_enable_int(0x1b);
|
||||
|
||||
DMAINTSTAT = 1;
|
||||
DMAINTSTAT = 2;
|
||||
DMAINTEN &= ~3;
|
||||
DMAR10(0) |= 1;
|
||||
DMAR10(1) |= 1;
|
||||
}
|
||||
|
||||
void pcm_set_frequency(unsigned int frequency)
|
||||
{
|
||||
pcm_freq=frequency;
|
||||
}
|
||||
size_t pcm_get_bytes_waiting(void)
|
||||
{
|
||||
return p_size;
|
||||
}
|
||||
#endif
|
||||
|
||||
void pcm_play_stop(void)
|
||||
|
|
@ -699,7 +863,7 @@ bool pcm_is_paused(void) {
|
|||
|
||||
void pcm_calculate_peaks(int *left, int *right)
|
||||
{
|
||||
#if (CONFIG_CPU == PNX0101 || CONFIG_CPU == S3C2440)
|
||||
#if (CONFIG_CPU == S3C2440)
|
||||
(void)left;
|
||||
(void)right;
|
||||
#else
|
||||
|
|
@ -710,7 +874,8 @@ void pcm_calculate_peaks(int *left, int *right)
|
|||
size_t samples = (BCR0 & 0xffffff) / 4;
|
||||
addr = (short *) (SAR0 & ~3);
|
||||
#elif defined(HAVE_WM8975) || defined(HAVE_WM8758) \
|
||||
|| defined(HAVE_WM8731) || defined(HAVE_WM8721)
|
||||
|| defined(HAVE_WM8731) || defined(HAVE_WM8721) \
|
||||
|| (CONFIG_CPU == PNX0101)
|
||||
size_t samples = p_size / 4;
|
||||
addr = p;
|
||||
#endif
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue