295367686e
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@11850 a1c6a512-1295-4272-9138-f99709370657
424 lines
10 KiB
C
424 lines
10 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2005 by Linus Nielsen Feltzing
|
|
*
|
|
* All files in this archive are subject to the GNU General Public License.
|
|
* See the file COPYING in the source tree root for full license agreement.
|
|
*
|
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
#include "system.h"
|
|
#include "kernel.h"
|
|
#include "logf.h"
|
|
#include "audio.h"
|
|
#if defined(HAVE_WM8975)
|
|
#include "wm8975.h"
|
|
#elif defined(HAVE_WM8758)
|
|
#include "wm8758.h"
|
|
#elif defined(HAVE_WM8731) || defined(HAVE_WM8721)
|
|
#include "wm8731l.h"
|
|
#elif CONFIG_CPU == PNX0101
|
|
#include "string.h"
|
|
#include "pnx0101.h"
|
|
#endif
|
|
|
|
/**
|
|
* APIs implemented in the target-specific portion:
|
|
* Public -
|
|
* pcm_init
|
|
* pcm_get_bytes_waiting
|
|
* pcm_calculate_peaks
|
|
* Semi-private -
|
|
* pcm_play_dma_start
|
|
* pcm_play_dma_stop
|
|
* pcm_play_pause_pause
|
|
* pcm_play_pause_unpause
|
|
*/
|
|
|
|
/** These items may be implemented target specifically or need to
|
|
be shared semi-privately **/
|
|
|
|
/* the registered callback function to ask for more mp3 data */
|
|
volatile pcm_more_callback_type pcm_callback_for_more = NULL;
|
|
volatile bool pcm_playing = false;
|
|
volatile bool pcm_paused = false;
|
|
|
|
void pcm_play_dma_start(const void *addr, size_t size);
|
|
void pcm_play_dma_stop(void);
|
|
void pcm_play_pause_pause(void);
|
|
void pcm_play_pause_unpause(void);
|
|
|
|
/** Functions that require targeted implementation **/
|
|
|
|
#if !defined(CPU_COLDFIRE) && (CONFIG_CPU != S3C2440)
|
|
|
|
#if (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 = HW_SAMPR_DEFAULT; /* 44.1 is default */
|
|
|
|
unsigned short* p IBSS_ATTR;
|
|
size_t p_size IBSS_ATTR;
|
|
|
|
void pcm_play_dma_start(const void *addr, size_t size)
|
|
{
|
|
p = (unsigned short*)addr;
|
|
p_size = size;
|
|
|
|
pcm_playing = true;
|
|
}
|
|
|
|
void pcm_play_dma_stop(void)
|
|
{
|
|
pcm_playing = false;
|
|
}
|
|
|
|
void pcm_play_pause_pause(void)
|
|
{
|
|
}
|
|
|
|
void pcm_play_pause_unpause(void)
|
|
{
|
|
}
|
|
|
|
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 (pcm_callback_for_more)
|
|
pcm_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;
|
|
|
|
pcm_playing = false;
|
|
pcm_paused = false;
|
|
pcm_callback_for_more = NULL;
|
|
|
|
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)
|
|
{
|
|
(void)frequency;
|
|
pcm_freq = HW_SAMPR_DEFAULT;
|
|
}
|
|
size_t pcm_get_bytes_waiting(void)
|
|
{
|
|
return p_size;
|
|
}
|
|
#endif /* CONFIG_CPU == */
|
|
|
|
/* dummy functions for those not actually supporting all this yet */
|
|
void pcm_apply_settings(bool reset)
|
|
{
|
|
(void)reset;
|
|
}
|
|
/** **/
|
|
|
|
void pcm_mute(bool mute)
|
|
{
|
|
#if defined(HAVE_WM8975) || defined(HAVE_WM8758) \
|
|
|| defined(HAVE_WM8731) || defined(HAVE_WM8721)
|
|
audiohw_mute(mute);
|
|
#endif
|
|
if (mute)
|
|
sleep(HZ/16);
|
|
}
|
|
#if !defined(CPU_PP)
|
|
/*
|
|
* This function goes directly into the DMA buffer to calculate the left and
|
|
* right peak values. To avoid missing peaks it tries to look forward two full
|
|
* peek periods (2/HZ sec, 100% overlap), although it's always possible that
|
|
* the entire period will not be visible. To reduce CPU load it only looks at
|
|
* every third sample, and this can be reduced even further if needed (even
|
|
* every tenth sample would still be pretty accurate).
|
|
*/
|
|
|
|
/* Check for a peak every PEAK_STRIDE samples */
|
|
#define PEAK_STRIDE 3
|
|
/* Up to 1/50th of a second of audio for peak calculation */
|
|
/* This should use NATIVE_FREQUENCY, or eventually an adjustable freq. value */
|
|
#define PEAK_SAMPLES (44100/50)
|
|
void pcm_calculate_peaks(int *left, int *right)
|
|
{
|
|
#if (CONFIG_CPU == S3C2440)
|
|
(void)left;
|
|
(void)right;
|
|
#else
|
|
short *addr;
|
|
short *end;
|
|
{
|
|
#if CONFIG_CPU == PNX0101
|
|
size_t samples = p_size / 4;
|
|
addr = p;
|
|
#endif
|
|
|
|
if (samples > PEAK_SAMPLES)
|
|
samples = PEAK_SAMPLES - (PEAK_STRIDE - 1);
|
|
else
|
|
samples -= MIN(PEAK_STRIDE - 1, samples);
|
|
|
|
end = &addr[samples * 2];
|
|
}
|
|
|
|
if (left && right) {
|
|
int left_peak = 0, right_peak = 0;
|
|
|
|
while (addr < end) {
|
|
int value;
|
|
if ((value = addr [0]) > left_peak)
|
|
left_peak = value;
|
|
else if (-value > left_peak)
|
|
left_peak = -value;
|
|
|
|
if ((value = addr [PEAK_STRIDE | 1]) > right_peak)
|
|
right_peak = value;
|
|
else if (-value > right_peak)
|
|
right_peak = -value;
|
|
|
|
addr = &addr[PEAK_STRIDE * 2];
|
|
}
|
|
|
|
*left = left_peak;
|
|
*right = right_peak;
|
|
}
|
|
else if (left || right) {
|
|
int peak_value = 0, value;
|
|
|
|
if (right)
|
|
addr += (PEAK_STRIDE | 1);
|
|
|
|
while (addr < end) {
|
|
if ((value = addr [0]) > peak_value)
|
|
peak_value = value;
|
|
else if (-value > peak_value)
|
|
peak_value = -value;
|
|
|
|
addr += PEAK_STRIDE * 2;
|
|
}
|
|
|
|
if (left)
|
|
*left = peak_value;
|
|
else
|
|
*right = peak_value;
|
|
}
|
|
#endif
|
|
}
|
|
#endif
|
|
#endif /* CPU_COLDFIRE */
|
|
|
|
/****************************************************************************
|
|
* Functions that do not require targeted implementation but only a targeted
|
|
* interface
|
|
*/
|
|
|
|
/* Common code to pcm_play_data and pcm_play_pause
|
|
Returns true if DMA playback was started, else false. */
|
|
bool pcm_play_data_start(pcm_more_callback_type get_more,
|
|
unsigned char *start, size_t size)
|
|
{
|
|
if (!(start && size))
|
|
{
|
|
size = 0;
|
|
if (get_more)
|
|
get_more(&start, &size);
|
|
}
|
|
|
|
if (start && size)
|
|
{
|
|
pcm_play_dma_start(start, size);
|
|
return true;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
void pcm_play_data(pcm_more_callback_type get_more,
|
|
unsigned char *start, size_t size)
|
|
{
|
|
pcm_callback_for_more = get_more;
|
|
|
|
if (pcm_play_data_start(get_more, start, size) && pcm_paused)
|
|
{
|
|
pcm_paused = false;
|
|
pcm_play_pause(false);
|
|
}
|
|
}
|
|
|
|
void pcm_play_pause(bool play)
|
|
{
|
|
bool needs_change = pcm_paused == play;
|
|
|
|
/* This needs to be done ahead of the rest to prevent infinite
|
|
recursion from pcm_play_data */
|
|
pcm_paused = !play;
|
|
|
|
if (pcm_playing && needs_change)
|
|
{
|
|
if (play)
|
|
{
|
|
if (pcm_get_bytes_waiting())
|
|
{
|
|
logf("unpause");
|
|
pcm_play_pause_unpause();
|
|
}
|
|
else
|
|
{
|
|
logf("unpause, no data waiting");
|
|
if (!pcm_play_data_start(pcm_callback_for_more, NULL, 0))
|
|
{
|
|
pcm_play_dma_stop();
|
|
logf("unpause attempted, no data");
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
logf("pause");
|
|
pcm_play_pause_pause();
|
|
}
|
|
} /* pcm_playing && needs_change */
|
|
}
|
|
|
|
void pcm_play_stop(void)
|
|
{
|
|
if (pcm_playing)
|
|
pcm_play_dma_stop();
|
|
}
|
|
|
|
bool pcm_is_playing(void)
|
|
{
|
|
return pcm_playing;
|
|
}
|
|
|
|
bool pcm_is_paused(void)
|
|
{
|
|
return pcm_paused;
|
|
}
|