2005-06-26 19:41:29 +00:00
|
|
|
/***************************************************************************
|
|
|
|
* __________ __ ___.
|
|
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
|
|
* \/ \/ \/ \/ \/
|
|
|
|
* $Id$
|
|
|
|
*
|
|
|
|
* Copyright (C) 2005 Miika Pekkarinen
|
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*
|
|
|
|
****************************************************************************/
|
2007-02-17 21:54:17 +00:00
|
|
|
#include "config.h"
|
2007-02-17 22:25:23 +00:00
|
|
|
#include <stdbool.h>
|
2005-07-24 15:32:28 +00:00
|
|
|
#include <inttypes.h>
|
2005-06-27 21:12:09 +00:00
|
|
|
#include <string.h>
|
2006-03-21 23:20:17 +00:00
|
|
|
#include <sound.h>
|
2005-06-26 19:41:29 +00:00
|
|
|
#include "dsp.h"
|
2006-01-29 15:37:03 +00:00
|
|
|
#include "eq.h"
|
2005-07-16 12:25:28 +00:00
|
|
|
#include "kernel.h"
|
2005-06-26 19:41:29 +00:00
|
|
|
#include "playback.h"
|
|
|
|
#include "system.h"
|
2005-07-24 15:32:28 +00:00
|
|
|
#include "settings.h"
|
2005-08-11 18:56:20 +00:00
|
|
|
#include "replaygain.h"
|
2006-11-15 20:26:33 +00:00
|
|
|
#include "misc.h"
|
2005-07-24 15:32:28 +00:00
|
|
|
#include "debug.h"
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2005-08-11 18:56:20 +00:00
|
|
|
/* 16-bit samples are scaled based on these constants. The shift should be
|
2005-07-16 12:25:28 +00:00
|
|
|
* no more than 15.
|
|
|
|
*/
|
|
|
|
#define WORD_SHIFT 12
|
|
|
|
#define WORD_FRACBITS 27
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2005-07-16 12:25:28 +00:00
|
|
|
#define NATIVE_DEPTH 16
|
2007-03-25 04:03:44 +00:00
|
|
|
/* If the buffer sizes change, check the assembly code! */
|
2007-02-07 00:51:50 +00:00
|
|
|
#define SAMPLE_BUF_COUNT 256
|
|
|
|
#define RESAMPLE_BUF_COUNT (256 * 4) /* Enough for 11,025 Hz -> 44,100 Hz*/
|
2006-04-17 21:04:57 +00:00
|
|
|
#define DEFAULT_GAIN 0x01000000
|
2007-03-25 04:03:44 +00:00
|
|
|
#define SAMPLE_BUF_LEFT_CHANNEL 0
|
|
|
|
#define SAMPLE_BUF_RIGHT_CHANNEL (SAMPLE_BUF_COUNT/2)
|
|
|
|
#define RESAMPLE_BUF_LEFT_CHANNEL 0
|
|
|
|
#define RESAMPLE_BUF_RIGHT_CHANNEL (RESAMPLE_BUF_COUNT/2)
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/* enums to index conversion properly with stereo mode and other settings */
|
2007-02-19 02:49:26 +00:00
|
|
|
enum
|
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
SAMPLE_INPUT_LE_NATIVE_I_STEREO = STEREO_INTERLEAVED,
|
|
|
|
SAMPLE_INPUT_LE_NATIVE_NI_STEREO = STEREO_NONINTERLEAVED,
|
|
|
|
SAMPLE_INPUT_LE_NATIVE_MONO = STEREO_MONO,
|
|
|
|
SAMPLE_INPUT_GT_NATIVE_I_STEREO = STEREO_INTERLEAVED + STEREO_NUM_MODES,
|
|
|
|
SAMPLE_INPUT_GT_NATIVE_NI_STEREO = STEREO_NONINTERLEAVED + STEREO_NUM_MODES,
|
|
|
|
SAMPLE_INPUT_GT_NATIVE_MONO = STEREO_MONO + STEREO_NUM_MODES,
|
|
|
|
SAMPLE_INPUT_GT_NATIVE_1ST_INDEX = STEREO_NUM_MODES
|
2007-02-19 02:49:26 +00:00
|
|
|
};
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
enum
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
SAMPLE_OUTPUT_MONO = 0,
|
|
|
|
SAMPLE_OUTPUT_STEREO,
|
|
|
|
SAMPLE_OUTPUT_DITHERED_MONO,
|
|
|
|
SAMPLE_OUTPUT_DITHERED_STEREO
|
2005-07-16 12:25:28 +00:00
|
|
|
};
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/****************************************************************************
|
|
|
|
* NOTE: Any assembly routines that use these structures must be updated
|
|
|
|
* if current data members are moved or changed.
|
|
|
|
*/
|
2005-07-16 12:25:28 +00:00
|
|
|
struct resample_data
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
uint32_t delta; /* 00h */
|
|
|
|
uint32_t phase; /* 04h */
|
2007-02-24 17:06:36 +00:00
|
|
|
int32_t last_sample[2]; /* 08h */
|
|
|
|
/* 10h */
|
|
|
|
};
|
|
|
|
|
|
|
|
/* This is for passing needed data to assembly dsp routines. If another
|
|
|
|
* dsp parameter needs to be passed, add to the end of the structure
|
|
|
|
* and remove from dsp_config.
|
|
|
|
* If another function type becomes assembly optimized and requires dsp
|
|
|
|
* config info, add a pointer paramter of type "struct dsp_data *".
|
|
|
|
* If removing something from other than the end, reserve the spot or
|
|
|
|
* else update every implementation for every target.
|
|
|
|
* Be sure to add the offset of the new member for easy viewing as well. :)
|
|
|
|
* It is the first member of dsp_config and all members can be accessesed
|
|
|
|
* through the main aggregate but this is intended to make a safe haven
|
|
|
|
* for these items whereas the c part can be rearranged at will. dsp_data
|
|
|
|
* could even moved within dsp_config without disurbing the order.
|
|
|
|
*/
|
|
|
|
struct dsp_data
|
|
|
|
{
|
|
|
|
int output_scale; /* 00h */
|
|
|
|
int num_channels; /* 04h */
|
|
|
|
struct resample_data resample_data; /* 08h */
|
2007-03-25 04:03:44 +00:00
|
|
|
int32_t clip_min; /* 18h */
|
|
|
|
int32_t clip_max; /* 1ch */
|
|
|
|
int32_t gain; /* 20h - Note that this is in S8.23 format. */
|
|
|
|
/* 24h */
|
2005-07-16 12:25:28 +00:00
|
|
|
};
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/* No asm...yet */
|
2005-07-16 12:25:28 +00:00
|
|
|
struct dither_data
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
long error[3]; /* 00h */
|
|
|
|
long random; /* 0ch */
|
|
|
|
/* 10h */
|
2005-07-16 12:25:28 +00:00
|
|
|
};
|
|
|
|
|
2005-11-14 21:56:56 +00:00
|
|
|
struct crossfeed_data
|
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
int32_t gain; /* 00h - Direct path gain */
|
|
|
|
int32_t coefs[3]; /* 04h - Coefficients for the shelving filter */
|
|
|
|
int32_t history[4]; /* 10h - Format is x[n - 1], y[n - 1] for both channels */
|
|
|
|
int32_t delay[13][2]; /* 20h */
|
2007-02-27 17:33:23 +00:00
|
|
|
int32_t *index; /* 88h - Current pointer into the delay line */
|
2007-02-24 17:06:36 +00:00
|
|
|
/* 8ch */
|
2005-11-14 21:56:56 +00:00
|
|
|
};
|
|
|
|
|
2007-02-26 00:41:26 +00:00
|
|
|
/* Current setup is one lowshelf filters three peaking filters and one
|
|
|
|
* highshelf filter. Varying the number of shelving filters make no sense,
|
|
|
|
* but adding peaking filters is possible.
|
|
|
|
*/
|
2007-02-24 17:06:36 +00:00
|
|
|
struct eq_state
|
|
|
|
{
|
|
|
|
char enabled[5]; /* 00h - Flags for active filters */
|
|
|
|
struct eqfilter filters[5]; /* 08h - packing is 4? */
|
|
|
|
/* 10ch */
|
2006-01-29 15:37:03 +00:00
|
|
|
};
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/* Include header with defines which functions are implemented in assembly
|
|
|
|
code for the target */
|
|
|
|
#include <dsp_asm.h>
|
|
|
|
|
2007-02-27 14:25:36 +00:00
|
|
|
/* Typedefs keep things much neater in this case */
|
2007-03-25 04:03:44 +00:00
|
|
|
typedef void (*sample_input_fn_type)(int count, const char *src[],
|
|
|
|
int32_t *dst[]);
|
2007-02-27 14:25:36 +00:00
|
|
|
typedef int (*resample_fn_type)(int count, struct dsp_data *data,
|
|
|
|
int32_t *src[], int32_t *dst[]);
|
|
|
|
typedef void (*sample_output_fn_type)(int count, struct dsp_data *data,
|
|
|
|
int32_t *src[], int16_t *dst);
|
2007-03-25 04:03:44 +00:00
|
|
|
/* Single-DSP channel processing in place */
|
2007-02-27 14:25:36 +00:00
|
|
|
typedef void (*channels_process_fn_type)(int count, int32_t *buf[]);
|
2007-03-25 04:03:44 +00:00
|
|
|
/* DSP local channel processing in place */
|
|
|
|
typedef void (*channels_process_dsp_fn_type)(int count, struct dsp_data *data,
|
|
|
|
int32_t *buf[]);
|
|
|
|
|
2007-02-27 14:25:36 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/*
|
|
|
|
***************************************************************************/
|
2005-08-20 11:13:19 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
struct dsp_config
|
|
|
|
{
|
|
|
|
struct dsp_data data; /* Config members for use in asm routines */
|
|
|
|
long codec_frequency; /* Sample rate of data coming from the codec */
|
|
|
|
long frequency; /* Effective sample rate after pitch shift (if any) */
|
|
|
|
int sample_depth;
|
|
|
|
int sample_bytes;
|
|
|
|
int stereo_mode;
|
|
|
|
int frac_bits;
|
2007-11-18 17:12:19 +00:00
|
|
|
#ifdef HAVE_SW_TONE_CONTROLS
|
|
|
|
/* Filter struct for software bass/treble controls */
|
|
|
|
struct eqfilter tone_filter;
|
|
|
|
#endif
|
2007-02-24 17:06:36 +00:00
|
|
|
/* Functions that change depending upon settings - NULL if stage is
|
|
|
|
disabled */
|
2007-03-25 04:03:44 +00:00
|
|
|
sample_input_fn_type input_samples;
|
|
|
|
resample_fn_type resample;
|
|
|
|
sample_output_fn_type output_samples;
|
2007-02-24 17:06:36 +00:00
|
|
|
/* These will be NULL for the voice codec and is more economical that
|
|
|
|
way */
|
2007-03-25 04:03:44 +00:00
|
|
|
channels_process_dsp_fn_type apply_gain;
|
|
|
|
channels_process_fn_type apply_crossfeed;
|
2007-11-18 17:12:19 +00:00
|
|
|
channels_process_fn_type eq_process;
|
2007-03-25 04:03:44 +00:00
|
|
|
channels_process_fn_type channels_process;
|
2007-02-24 17:06:36 +00:00
|
|
|
};
|
2005-11-28 22:26:20 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/* General DSP config */
|
|
|
|
static struct dsp_config dsp_conf[2] IBSS_ATTR; /* 0=A, 1=V */
|
|
|
|
/* Dithering */
|
|
|
|
static struct dither_data dither_data[2] IBSS_ATTR; /* 0=left, 1=right */
|
|
|
|
static long dither_mask IBSS_ATTR;
|
|
|
|
static long dither_bias IBSS_ATTR;
|
|
|
|
/* Crossfeed */
|
2007-02-27 14:25:36 +00:00
|
|
|
struct crossfeed_data crossfeed_data IDATA_ATTR = /* A */
|
|
|
|
{
|
2007-02-27 17:33:23 +00:00
|
|
|
.index = (int32_t *)crossfeed_data.delay
|
2007-02-27 14:42:38 +00:00
|
|
|
};
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/* Equalizer */
|
2007-11-18 17:12:19 +00:00
|
|
|
static struct eq_state eq_data; /* A */
|
|
|
|
|
|
|
|
/* Software tone controls */
|
2007-02-26 00:41:26 +00:00
|
|
|
#ifdef HAVE_SW_TONE_CONTROLS
|
2007-11-18 17:12:19 +00:00
|
|
|
static int prescale; /* A/V */
|
|
|
|
static int bass; /* A/V */
|
|
|
|
static int treble; /* A/V */
|
2007-02-26 00:41:26 +00:00
|
|
|
#endif
|
2007-02-24 17:06:36 +00:00
|
|
|
|
|
|
|
/* Settings applicable to audio codec only */
|
|
|
|
static int pitch_ratio = 1000;
|
|
|
|
static int channels_mode;
|
|
|
|
long dsp_sw_gain;
|
|
|
|
long dsp_sw_cross;
|
|
|
|
static bool dither_enabled;
|
|
|
|
static long eq_precut;
|
|
|
|
static long track_gain;
|
|
|
|
static bool new_gain;
|
|
|
|
static long album_gain;
|
|
|
|
static long track_peak;
|
|
|
|
static long album_peak;
|
|
|
|
static long replaygain;
|
|
|
|
static bool crossfeed_enabled;
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
#define audio_dsp (dsp_conf[CODEC_IDX_AUDIO])
|
|
|
|
#define voice_dsp (dsp_conf[CODEC_IDX_VOICE])
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2005-07-16 12:25:28 +00:00
|
|
|
/* The internal format is 32-bit samples, non-interleaved, stereo. This
|
|
|
|
* format is similar to the raw output from several codecs, so the amount
|
|
|
|
* of copying needed is minimized for that case.
|
2005-06-26 19:41:29 +00:00
|
|
|
*/
|
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
int32_t sample_buf[SAMPLE_BUF_COUNT] IBSS_ATTR;
|
2007-02-07 00:51:50 +00:00
|
|
|
static int32_t resample_buf[RESAMPLE_BUF_COUNT] IBSS_ATTR;
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
#if 0
|
|
|
|
/* Clip sample to arbitrary limits where range > 0 and min + range = max */
|
|
|
|
static inline long clip_sample(int32_t sample, int32_t min, int32_t range)
|
|
|
|
{
|
2007-10-29 23:58:00 +00:00
|
|
|
if ((uint32_t)(sample - min) > (uint32_t)range)
|
2007-02-24 17:06:36 +00:00
|
|
|
{
|
2007-10-29 23:58:00 +00:00
|
|
|
int32_t c = min;
|
|
|
|
if (sample > min)
|
|
|
|
c += range;
|
2007-10-30 00:06:09 +00:00
|
|
|
sample = c;
|
2007-02-24 17:06:36 +00:00
|
|
|
}
|
|
|
|
return sample;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* Clip sample to signed 16 bit range */
|
|
|
|
static inline int32_t clip_sample_16(int32_t sample)
|
|
|
|
{
|
|
|
|
if ((int16_t)sample != sample)
|
|
|
|
sample = 0x7fff ^ (sample >> 31);
|
|
|
|
return sample;
|
|
|
|
}
|
|
|
|
|
2005-11-28 22:26:20 +00:00
|
|
|
int sound_get_pitch(void)
|
|
|
|
{
|
|
|
|
return pitch_ratio;
|
|
|
|
}
|
|
|
|
|
|
|
|
void sound_set_pitch(int permille)
|
|
|
|
{
|
|
|
|
pitch_ratio = permille;
|
2007-11-18 17:12:19 +00:00
|
|
|
dsp_configure(&audio_dsp, DSP_SWITCH_FREQUENCY,
|
|
|
|
audio_dsp.codec_frequency);
|
2005-11-28 22:26:20 +00:00
|
|
|
}
|
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
/* Convert count samples to the internal format, if needed. Updates src
|
|
|
|
* to point past the samples "consumed" and dst is set to point to the
|
|
|
|
* samples to consume. Note that for mono, dst[0] equals dst[1], as there
|
|
|
|
* is no point in processing the same data twice.
|
2005-07-16 12:25:28 +00:00
|
|
|
*/
|
2007-02-19 02:49:26 +00:00
|
|
|
|
|
|
|
/* convert count 16-bit mono to 32-bit mono */
|
2007-03-25 04:03:44 +00:00
|
|
|
static void sample_input_lte_native_mono(
|
2007-02-24 17:06:36 +00:00
|
|
|
int count, const char *src[], int32_t *dst[])
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
const int16_t *s = (int16_t *) src[0];
|
|
|
|
const int16_t * const send = s + count;
|
2007-03-25 04:03:44 +00:00
|
|
|
int32_t *d = dst[0] = dst[1] = &sample_buf[SAMPLE_BUF_LEFT_CHANNEL];
|
|
|
|
int scale = WORD_SHIFT;
|
2007-02-19 02:49:26 +00:00
|
|
|
|
|
|
|
do
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-19 02:49:26 +00:00
|
|
|
*d++ = *s++ << scale;
|
2005-06-26 19:41:29 +00:00
|
|
|
}
|
2007-02-19 02:49:26 +00:00
|
|
|
while (s < send);
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2007-02-19 02:49:26 +00:00
|
|
|
src[0] = (char *)s;
|
|
|
|
}
|
2005-07-16 12:25:28 +00:00
|
|
|
|
2007-02-19 02:49:26 +00:00
|
|
|
/* convert count 16-bit interleaved stereo to 32-bit noninterleaved */
|
2007-03-25 04:03:44 +00:00
|
|
|
static void sample_input_lte_native_i_stereo(
|
2007-02-24 17:06:36 +00:00
|
|
|
int count, const char *src[], int32_t *dst[])
|
2007-02-19 02:49:26 +00:00
|
|
|
{
|
|
|
|
const int32_t *s = (int32_t *) src[0];
|
|
|
|
const int32_t * const send = s + count;
|
2007-03-25 04:03:44 +00:00
|
|
|
int32_t *dl = dst[0] = &sample_buf[SAMPLE_BUF_LEFT_CHANNEL];
|
|
|
|
int32_t *dr = dst[1] = &sample_buf[SAMPLE_BUF_RIGHT_CHANNEL];
|
|
|
|
int scale = WORD_SHIFT;
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2007-02-19 02:49:26 +00:00
|
|
|
do
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-21 21:46:05 +00:00
|
|
|
int32_t slr = *s++;
|
2007-02-19 02:49:26 +00:00
|
|
|
#ifdef ROCKBOX_LITTLE_ENDIAN
|
|
|
|
*dl++ = (slr >> 16) << scale;
|
2007-02-24 17:06:36 +00:00
|
|
|
*dr++ = (int32_t)(int16_t)slr << scale;
|
2007-02-19 02:49:26 +00:00
|
|
|
#else /* ROCKBOX_BIG_ENDIAN */
|
2007-02-24 17:06:36 +00:00
|
|
|
*dl++ = (int32_t)(int16_t)slr << scale;
|
2007-02-19 02:49:26 +00:00
|
|
|
*dr++ = (slr >> 16) << scale;
|
|
|
|
#endif
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
2007-02-19 02:49:26 +00:00
|
|
|
while (s < send);
|
|
|
|
|
|
|
|
src[0] = (char *)s;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* convert count 16-bit noninterleaved stereo to 32-bit noninterleaved */
|
2007-03-25 04:03:44 +00:00
|
|
|
static void sample_input_lte_native_ni_stereo(
|
2007-02-24 17:06:36 +00:00
|
|
|
int count, const char *src[], int32_t *dst[])
|
2007-02-19 02:49:26 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
const int16_t *sl = (int16_t *) src[0];
|
|
|
|
const int16_t *sr = (int16_t *) src[1];
|
|
|
|
const int16_t * const slend = sl + count;
|
2007-03-25 04:03:44 +00:00
|
|
|
int32_t *dl = dst[0] = &sample_buf[SAMPLE_BUF_LEFT_CHANNEL];
|
|
|
|
int32_t *dr = dst[1] = &sample_buf[SAMPLE_BUF_RIGHT_CHANNEL];
|
|
|
|
int scale = WORD_SHIFT;
|
2007-02-19 02:49:26 +00:00
|
|
|
|
|
|
|
do
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-19 02:49:26 +00:00
|
|
|
*dl++ = *sl++ << scale;
|
|
|
|
*dr++ = *sr++ << scale;
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
2007-02-19 02:49:26 +00:00
|
|
|
while (sl < slend);
|
|
|
|
|
|
|
|
src[0] = (char *)sl;
|
|
|
|
src[1] = (char *)sr;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* convert count 32-bit mono to 32-bit mono */
|
2007-03-25 04:03:44 +00:00
|
|
|
static void sample_input_gt_native_mono(
|
2007-02-24 17:06:36 +00:00
|
|
|
int count, const char *src[], int32_t *dst[])
|
2007-02-19 02:49:26 +00:00
|
|
|
{
|
|
|
|
dst[0] = dst[1] = (int32_t *)src[0];
|
|
|
|
src[0] = (char *)(dst[0] + count);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* convert count 32-bit interleaved stereo to 32-bit noninterleaved stereo */
|
2007-03-25 04:03:44 +00:00
|
|
|
static void sample_input_gt_native_i_stereo(
|
2007-02-24 17:06:36 +00:00
|
|
|
int count, const char *src[], int32_t *dst[])
|
2007-02-19 02:49:26 +00:00
|
|
|
{
|
|
|
|
const int32_t *s = (int32_t *)src[0];
|
|
|
|
const int32_t * const send = s + 2*count;
|
2007-03-25 04:03:44 +00:00
|
|
|
int32_t *dl = dst[0] = &sample_buf[SAMPLE_BUF_LEFT_CHANNEL];
|
|
|
|
int32_t *dr = dst[1] = &sample_buf[SAMPLE_BUF_RIGHT_CHANNEL];
|
2007-02-19 02:49:26 +00:00
|
|
|
|
|
|
|
do
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-19 02:49:26 +00:00
|
|
|
*dl++ = *s++;
|
|
|
|
*dr++ = *s++;
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
2007-02-19 02:49:26 +00:00
|
|
|
while (s < send);
|
|
|
|
|
|
|
|
src[0] = (char *)send;
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2007-02-19 02:49:26 +00:00
|
|
|
/* convert 32 bit-noninterleaved stereo to 32-bit noninterleaved stereo */
|
2007-03-25 04:03:44 +00:00
|
|
|
static void sample_input_gt_native_ni_stereo(
|
2007-02-24 17:06:36 +00:00
|
|
|
int count, const char *src[], int32_t *dst[])
|
2007-02-19 02:49:26 +00:00
|
|
|
{
|
|
|
|
dst[0] = (int32_t *)src[0];
|
|
|
|
dst[1] = (int32_t *)src[1];
|
|
|
|
src[0] = (char *)(dst[0] + count);
|
|
|
|
src[1] = (char *)(dst[1] + count);
|
|
|
|
}
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/**
|
|
|
|
* sample_input_new_format()
|
|
|
|
*
|
|
|
|
* set the to-native sample conversion function based on dsp sample parameters
|
|
|
|
*
|
|
|
|
* !DSPPARAMSYNC
|
|
|
|
* needs syncing with changes to the following dsp parameters:
|
|
|
|
* * dsp->stereo_mode (A/V)
|
|
|
|
* * dsp->sample_depth (A/V)
|
|
|
|
*/
|
2007-11-18 17:12:19 +00:00
|
|
|
static void sample_input_new_format(struct dsp_config *dsp)
|
2007-02-19 02:49:26 +00:00
|
|
|
{
|
2007-02-27 14:25:36 +00:00
|
|
|
static const sample_input_fn_type sample_input_functions[] =
|
2007-02-19 02:49:26 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
[SAMPLE_INPUT_LE_NATIVE_MONO] = sample_input_lte_native_mono,
|
|
|
|
[SAMPLE_INPUT_LE_NATIVE_I_STEREO] = sample_input_lte_native_i_stereo,
|
|
|
|
[SAMPLE_INPUT_LE_NATIVE_NI_STEREO] = sample_input_lte_native_ni_stereo,
|
|
|
|
[SAMPLE_INPUT_GT_NATIVE_MONO] = sample_input_gt_native_mono,
|
|
|
|
[SAMPLE_INPUT_GT_NATIVE_I_STEREO] = sample_input_gt_native_i_stereo,
|
|
|
|
[SAMPLE_INPUT_GT_NATIVE_NI_STEREO] = sample_input_gt_native_ni_stereo,
|
2007-02-19 02:49:26 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
int convert = dsp->stereo_mode;
|
|
|
|
|
|
|
|
if (dsp->sample_depth > NATIVE_DEPTH)
|
2007-02-24 17:06:36 +00:00
|
|
|
convert += SAMPLE_INPUT_GT_NATIVE_1ST_INDEX;
|
|
|
|
|
|
|
|
dsp->input_samples = sample_input_functions[convert];
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifndef DSP_HAVE_ASM_SAMPLE_OUTPUT_MONO
|
|
|
|
/* write mono internal format to output format */
|
|
|
|
static void sample_output_mono(int count, struct dsp_data *data,
|
|
|
|
int32_t *src[], int16_t *dst)
|
|
|
|
{
|
|
|
|
const int32_t *s0 = src[0];
|
|
|
|
const int scale = data->output_scale;
|
2007-08-29 14:32:52 +00:00
|
|
|
const int dc_bias = 1 << (scale - 1);
|
2007-02-24 17:06:36 +00:00
|
|
|
|
|
|
|
do
|
|
|
|
{
|
2007-08-29 14:32:52 +00:00
|
|
|
int32_t lr = clip_sample_16((*s0++ + dc_bias) >> scale);
|
2007-02-24 17:06:36 +00:00
|
|
|
*dst++ = lr;
|
|
|
|
*dst++ = lr;
|
|
|
|
}
|
|
|
|
while (--count > 0);
|
|
|
|
}
|
|
|
|
#endif /* DSP_HAVE_ASM_SAMPLE_OUTPUT_MONO */
|
|
|
|
|
|
|
|
/* write stereo internal format to output format */
|
|
|
|
#ifndef DSP_HAVE_ASM_SAMPLE_OUTPUT_STEREO
|
|
|
|
static void sample_output_stereo(int count, struct dsp_data *data,
|
|
|
|
int32_t *src[], int16_t *dst)
|
|
|
|
{
|
|
|
|
const int32_t *s0 = src[0];
|
|
|
|
const int32_t *s1 = src[1];
|
|
|
|
const int scale = data->output_scale;
|
2007-08-29 14:32:52 +00:00
|
|
|
const int dc_bias = 1 << (scale - 1);
|
2007-02-24 17:06:36 +00:00
|
|
|
|
|
|
|
do
|
|
|
|
{
|
2007-08-29 14:32:52 +00:00
|
|
|
*dst++ = clip_sample_16((*s0++ + dc_bias) >> scale);
|
|
|
|
*dst++ = clip_sample_16((*s1++ + dc_bias) >> scale);
|
2007-02-24 17:06:36 +00:00
|
|
|
}
|
|
|
|
while (--count > 0);
|
|
|
|
}
|
|
|
|
#endif /* DSP_HAVE_ASM_SAMPLE_OUTPUT_STEREO */
|
|
|
|
|
|
|
|
/**
|
|
|
|
* The "dither" code to convert the 24-bit samples produced by libmad was
|
|
|
|
* taken from the coolplayer project - coolplayer.sourceforge.net
|
|
|
|
*
|
|
|
|
* This function handles mono and stereo outputs.
|
|
|
|
*/
|
|
|
|
static void sample_output_dithered(int count, struct dsp_data *data,
|
|
|
|
int32_t *src[], int16_t *dst)
|
|
|
|
{
|
|
|
|
const int32_t mask = dither_mask;
|
|
|
|
const int32_t bias = dither_bias;
|
|
|
|
const int scale = data->output_scale;
|
|
|
|
const int32_t min = data->clip_min;
|
|
|
|
const int32_t max = data->clip_max;
|
|
|
|
const int32_t range = max - min;
|
|
|
|
int ch;
|
2007-02-27 19:14:21 +00:00
|
|
|
int16_t *d;
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
for (ch = 0; ch < data->num_channels; ch++)
|
2007-02-24 17:06:36 +00:00
|
|
|
{
|
|
|
|
struct dither_data * const dither = &dither_data[ch];
|
|
|
|
int32_t *s = src[ch];
|
|
|
|
int i;
|
|
|
|
|
2007-02-27 19:14:21 +00:00
|
|
|
for (i = 0, d = &dst[ch]; i < count; i++, s++, d += 2)
|
2007-02-24 17:06:36 +00:00
|
|
|
{
|
|
|
|
int32_t output, sample;
|
|
|
|
int32_t random;
|
|
|
|
|
2007-12-04 16:59:45 +00:00
|
|
|
/* Noise shape and bias (for correct rounding later) */
|
2007-02-24 17:06:36 +00:00
|
|
|
sample = *s;
|
|
|
|
sample += dither->error[0] - dither->error[1] + dither->error[2];
|
|
|
|
dither->error[2] = dither->error[1];
|
|
|
|
dither->error[1] = dither->error[0]/2;
|
|
|
|
|
|
|
|
output = sample + bias;
|
|
|
|
|
2007-12-04 16:59:45 +00:00
|
|
|
/* Dither, highpass triangle PDF */
|
2007-02-24 17:06:36 +00:00
|
|
|
random = dither->random*0x0019660dL + 0x3c6ef35fL;
|
|
|
|
output += (random & mask) - (dither->random & mask);
|
|
|
|
dither->random = random;
|
|
|
|
|
2007-12-04 16:59:45 +00:00
|
|
|
/* Round sample to output range */
|
|
|
|
output &= ~mask;
|
|
|
|
|
|
|
|
/* Error feedback */
|
|
|
|
dither->error[0] = sample - output;
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/* Clip */
|
2007-10-29 23:58:00 +00:00
|
|
|
if ((uint32_t)(output - min) > (uint32_t)range)
|
2007-02-24 17:06:36 +00:00
|
|
|
{
|
2007-10-29 23:58:00 +00:00
|
|
|
int32_t c = min;
|
|
|
|
if (output > min)
|
|
|
|
c += range;
|
|
|
|
output = c;
|
2007-02-24 17:06:36 +00:00
|
|
|
}
|
|
|
|
|
2007-12-04 16:59:45 +00:00
|
|
|
/* Quantize and store */
|
2007-02-24 17:06:36 +00:00
|
|
|
*d = output >> scale;
|
|
|
|
}
|
|
|
|
}
|
2007-02-27 19:14:21 +00:00
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
if (data->num_channels == 2)
|
2007-02-27 19:14:21 +00:00
|
|
|
return;
|
|
|
|
|
|
|
|
/* Have to duplicate left samples into the right channel since
|
|
|
|
pcm buffer and hardware is interleaved stereo */
|
|
|
|
d = &dst[0];
|
|
|
|
|
|
|
|
do
|
|
|
|
{
|
|
|
|
int16_t s = *d++;
|
|
|
|
*d++ = s;
|
|
|
|
}
|
|
|
|
while (--count > 0);
|
2007-02-24 17:06:36 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* sample_output_new_format()
|
|
|
|
*
|
|
|
|
* set the from-native to ouput sample conversion routine
|
|
|
|
*
|
|
|
|
* !DSPPARAMSYNC
|
|
|
|
* needs syncing with changes to the following dsp parameters:
|
|
|
|
* * dsp->stereo_mode (A/V)
|
|
|
|
* * dither_enabled (A)
|
|
|
|
*/
|
2007-11-18 17:12:19 +00:00
|
|
|
static void sample_output_new_format(struct dsp_config *dsp)
|
2007-02-24 17:06:36 +00:00
|
|
|
{
|
2007-02-27 14:25:36 +00:00
|
|
|
static const sample_output_fn_type sample_output_functions[] =
|
2007-02-24 17:06:36 +00:00
|
|
|
{
|
|
|
|
sample_output_mono,
|
|
|
|
sample_output_stereo,
|
|
|
|
sample_output_dithered,
|
|
|
|
sample_output_dithered
|
|
|
|
};
|
|
|
|
|
|
|
|
int out = dsp->data.num_channels - 1;
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp == &audio_dsp && dither_enabled)
|
2007-02-24 17:06:36 +00:00
|
|
|
out += 2;
|
2007-02-19 02:49:26 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->output_samples = sample_output_functions[out];
|
2007-02-19 02:49:26 +00:00
|
|
|
}
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
/**
|
|
|
|
* Linear interpolation resampling that introduces a one sample delay because
|
2006-04-17 17:24:02 +00:00
|
|
|
* of our inability to look into the future at the end of a frame.
|
2005-07-16 12:25:28 +00:00
|
|
|
*/
|
2007-02-19 02:49:26 +00:00
|
|
|
#ifndef DSP_HAVE_ASM_RESAMPLING
|
2007-02-24 17:06:36 +00:00
|
|
|
static int dsp_downsample(int count, struct dsp_data *data,
|
|
|
|
int32_t *src[], int32_t *dst[])
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
int ch = data->num_channels - 1;
|
|
|
|
uint32_t delta = data->resample_data.delta;
|
|
|
|
uint32_t phase, pos;
|
2007-02-19 02:49:26 +00:00
|
|
|
int32_t *d;
|
|
|
|
|
|
|
|
/* Rolled channel loop actually showed slightly faster. */
|
|
|
|
do
|
|
|
|
{
|
|
|
|
/* Just initialize things and not worry too much about the relatively
|
|
|
|
* uncommon case of not being able to spit out a sample for the frame.
|
|
|
|
*/
|
2007-02-24 17:06:36 +00:00
|
|
|
int32_t *s = src[ch];
|
|
|
|
int32_t last = data->resample_data.last_sample[ch];
|
2007-02-19 02:49:26 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
data->resample_data.last_sample[ch] = s[count - 1];
|
|
|
|
d = dst[ch];
|
|
|
|
phase = data->resample_data.phase;
|
2007-02-19 02:49:26 +00:00
|
|
|
pos = phase >> 16;
|
|
|
|
|
2005-11-28 22:26:20 +00:00
|
|
|
/* Do we need last sample of previous frame for interpolation? */
|
|
|
|
if (pos > 0)
|
2007-02-19 02:49:26 +00:00
|
|
|
last = s[pos - 1];
|
2007-02-07 00:51:50 +00:00
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
while (pos < (uint32_t)count)
|
2007-02-16 12:01:35 +00:00
|
|
|
{
|
2007-02-19 02:49:26 +00:00
|
|
|
*d++ = last + FRACMUL((phase & 0xffff) << 15, s[pos] - last);
|
|
|
|
phase += delta;
|
|
|
|
pos = phase >> 16;
|
|
|
|
last = s[pos - 1];
|
2007-02-16 12:01:35 +00:00
|
|
|
}
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
while (--ch >= 0);
|
2005-07-16 12:25:28 +00:00
|
|
|
|
|
|
|
/* Wrap phase accumulator back to start of next frame. */
|
2007-02-24 17:06:36 +00:00
|
|
|
data->resample_data.phase = phase - (count << 16);
|
2007-02-19 02:49:26 +00:00
|
|
|
return d - dst[0];
|
2005-06-26 19:41:29 +00:00
|
|
|
}
|
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
static int dsp_upsample(int count, struct dsp_data *data,
|
2007-02-24 17:06:36 +00:00
|
|
|
int32_t *src[], int32_t *dst[])
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
int ch = data->num_channels - 1;
|
2007-03-25 04:03:44 +00:00
|
|
|
uint32_t delta = data->resample_data.delta;
|
|
|
|
uint32_t phase, pos;
|
2007-02-19 02:49:26 +00:00
|
|
|
int32_t *d;
|
2005-07-16 12:25:28 +00:00
|
|
|
|
2007-02-19 02:49:26 +00:00
|
|
|
/* Rolled channel loop actually showed slightly faster. */
|
|
|
|
do
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-19 02:49:26 +00:00
|
|
|
/* Should always be able to output a sample for a ratio up to
|
|
|
|
RESAMPLE_BUF_COUNT / SAMPLE_BUF_COUNT. */
|
2007-02-24 17:06:36 +00:00
|
|
|
int32_t *s = src[ch];
|
|
|
|
int32_t last = data->resample_data.last_sample[ch];
|
2007-02-19 02:49:26 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
data->resample_data.last_sample[ch] = s[count - 1];
|
|
|
|
d = dst[ch];
|
|
|
|
phase = data->resample_data.phase;
|
2007-02-19 02:49:26 +00:00
|
|
|
pos = phase >> 16;
|
|
|
|
|
|
|
|
while (pos == 0)
|
|
|
|
{
|
|
|
|
*d++ = last + FRACMUL((phase & 0xffff) << 15, s[0] - last);
|
|
|
|
phase += delta;
|
|
|
|
pos = phase >> 16;
|
|
|
|
}
|
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
while (pos < (uint32_t)count)
|
2007-02-19 02:49:26 +00:00
|
|
|
{
|
|
|
|
last = s[pos - 1];
|
|
|
|
*d++ = last + FRACMUL((phase & 0xffff) << 15, s[pos] - last);
|
|
|
|
phase += delta;
|
|
|
|
pos = phase >> 16;
|
|
|
|
}
|
2005-06-26 19:41:29 +00:00
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
while (--ch >= 0);
|
2005-07-16 12:25:28 +00:00
|
|
|
|
|
|
|
/* Wrap phase accumulator back to start of next frame. */
|
2007-02-24 17:06:36 +00:00
|
|
|
data->resample_data.phase = phase & 0xffff;
|
2007-02-19 02:49:26 +00:00
|
|
|
return d - dst[0];
|
2005-06-26 19:41:29 +00:00
|
|
|
}
|
2007-02-19 02:49:26 +00:00
|
|
|
#endif /* DSP_HAVE_ASM_RESAMPLING */
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
static void resampler_new_delta(struct dsp_config *dsp)
|
2007-03-25 04:03:44 +00:00
|
|
|
{
|
|
|
|
dsp->data.resample_data.delta = (unsigned long)
|
|
|
|
dsp->frequency * 65536LL / NATIVE_FREQUENCY;
|
|
|
|
|
|
|
|
if (dsp->frequency == NATIVE_FREQUENCY)
|
|
|
|
{
|
|
|
|
/* NOTE: If fully glitch-free transistions from no resampling to
|
|
|
|
resampling are desired, last_sample history should be maintained
|
|
|
|
even when not resampling. */
|
|
|
|
dsp->resample = NULL;
|
|
|
|
dsp->data.resample_data.phase = 0;
|
|
|
|
dsp->data.resample_data.last_sample[0] = 0;
|
|
|
|
dsp->data.resample_data.last_sample[1] = 0;
|
|
|
|
}
|
|
|
|
else if (dsp->frequency < NATIVE_FREQUENCY)
|
|
|
|
dsp->resample = dsp_upsample;
|
|
|
|
else
|
|
|
|
dsp->resample = dsp_downsample;
|
|
|
|
}
|
|
|
|
|
2005-07-16 12:25:28 +00:00
|
|
|
/* Resample count stereo samples. Updates the src array, if resampling is
|
|
|
|
* done, to refer to the resampled data. Returns number of stereo samples
|
|
|
|
* for further processing.
|
|
|
|
*/
|
2007-11-18 17:12:19 +00:00
|
|
|
static inline int resample(struct dsp_config *dsp, int count, int32_t *src[])
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
int32_t *dst[2] =
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
&resample_buf[RESAMPLE_BUF_LEFT_CHANNEL],
|
|
|
|
&resample_buf[RESAMPLE_BUF_RIGHT_CHANNEL],
|
|
|
|
};
|
2005-07-16 12:25:28 +00:00
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
count = dsp->resample(count, &dsp->data, src, dst);
|
|
|
|
|
|
|
|
src[0] = dst[0];
|
|
|
|
src[1] = dst[dsp->data.num_channels - 1];
|
2005-07-16 12:25:28 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
return count;
|
2005-06-26 19:41:29 +00:00
|
|
|
}
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
static void dither_init(struct dsp_config *dsp)
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
memset(dither_data, 0, sizeof (dither_data));
|
|
|
|
dither_bias = (1L << (dsp->frac_bits - NATIVE_DEPTH));
|
|
|
|
dither_mask = (1L << (dsp->frac_bits + 1 - NATIVE_DEPTH)) - 1;
|
2005-06-26 19:41:29 +00:00
|
|
|
}
|
|
|
|
|
2006-10-27 20:41:33 +00:00
|
|
|
void dsp_dither_enable(bool enable)
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-11-18 17:12:19 +00:00
|
|
|
struct dsp_config *dsp = &audio_dsp;
|
2007-02-24 17:06:36 +00:00
|
|
|
dither_enabled = enable;
|
2007-11-18 17:12:19 +00:00
|
|
|
sample_output_new_format(dsp);
|
2005-06-26 19:41:29 +00:00
|
|
|
}
|
|
|
|
|
2006-03-23 19:59:52 +00:00
|
|
|
/* Applies crossfeed to the stereo signal in src.
|
|
|
|
* Crossfeed is a process where listening over speakers is simulated. This
|
|
|
|
* is good for old hard panned stereo records, which might be quite fatiguing
|
|
|
|
* to listen to on headphones with no crossfeed.
|
2005-11-14 21:56:56 +00:00
|
|
|
*/
|
2006-03-23 19:59:52 +00:00
|
|
|
#ifndef DSP_HAVE_ASM_CROSSFEED
|
2007-02-27 14:25:36 +00:00
|
|
|
static void apply_crossfeed(int count, int32_t *buf[])
|
2005-11-15 10:05:01 +00:00
|
|
|
{
|
2006-04-11 13:49:05 +00:00
|
|
|
int32_t *hist_l = &crossfeed_data.history[0];
|
|
|
|
int32_t *hist_r = &crossfeed_data.history[2];
|
|
|
|
int32_t *delay = &crossfeed_data.delay[0][0];
|
|
|
|
int32_t *coefs = &crossfeed_data.coefs[0];
|
|
|
|
int32_t gain = crossfeed_data.gain;
|
2007-02-27 17:33:23 +00:00
|
|
|
int32_t *di = crossfeed_data.index;
|
2006-04-17 17:24:02 +00:00
|
|
|
|
2006-04-11 13:49:05 +00:00
|
|
|
int32_t acc;
|
2006-03-19 16:31:45 +00:00
|
|
|
int32_t left, right;
|
2005-11-15 10:05:01 +00:00
|
|
|
int i;
|
2006-04-17 17:24:02 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
for (i = 0; i < count; i++)
|
|
|
|
{
|
|
|
|
left = buf[0][i];
|
|
|
|
right = buf[1][i];
|
2006-04-17 17:24:02 +00:00
|
|
|
|
|
|
|
/* Filter delayed sample from left speaker */
|
2007-02-27 17:33:23 +00:00
|
|
|
ACC_INIT(acc, *di, coefs[0]);
|
2006-04-11 13:49:05 +00:00
|
|
|
ACC(acc, hist_l[0], coefs[1]);
|
|
|
|
ACC(acc, hist_l[1], coefs[2]);
|
2006-04-17 17:24:02 +00:00
|
|
|
/* Save filter history for left speaker */
|
|
|
|
hist_l[1] = GET_ACC(acc);
|
2007-02-27 17:33:23 +00:00
|
|
|
hist_l[0] = *di;
|
|
|
|
*di++ = left;
|
2006-04-17 17:24:02 +00:00
|
|
|
/* Filter delayed sample from right speaker */
|
2007-02-27 17:33:23 +00:00
|
|
|
ACC_INIT(acc, *di, coefs[0]);
|
2006-04-11 13:49:05 +00:00
|
|
|
ACC(acc, hist_r[0], coefs[1]);
|
|
|
|
ACC(acc, hist_r[1], coefs[2]);
|
2006-04-17 17:24:02 +00:00
|
|
|
/* Save filter history for right speaker */
|
|
|
|
hist_r[1] = GET_ACC(acc);
|
2007-02-27 17:33:23 +00:00
|
|
|
hist_r[0] = *di;
|
|
|
|
*di++ = right;
|
2006-04-17 17:24:02 +00:00
|
|
|
/* Now add the attenuated direct sound and write to outputs */
|
2007-02-24 17:06:36 +00:00
|
|
|
buf[0][i] = FRACMUL(left, gain) + hist_r[1];
|
|
|
|
buf[1][i] = FRACMUL(right, gain) + hist_l[1];
|
2006-04-17 17:24:02 +00:00
|
|
|
|
|
|
|
/* Wrap delay line index if bigger than delay line size */
|
2007-02-27 17:33:23 +00:00
|
|
|
if (di >= delay + 13*2)
|
|
|
|
di = delay;
|
2005-11-14 21:56:56 +00:00
|
|
|
}
|
2006-04-17 17:24:02 +00:00
|
|
|
/* Write back local copies of data we've modified */
|
2006-04-11 13:49:05 +00:00
|
|
|
crossfeed_data.index = di;
|
2005-11-14 21:56:56 +00:00
|
|
|
}
|
2007-02-27 14:25:36 +00:00
|
|
|
#endif /* DSP_HAVE_ASM_CROSSFEED */
|
|
|
|
|
|
|
|
/**
|
|
|
|
* dsp_set_crossfeed(bool enable)
|
|
|
|
*
|
|
|
|
* !DSPPARAMSYNC
|
|
|
|
* needs syncing with changes to the following dsp parameters:
|
|
|
|
* * dsp->stereo_mode (A)
|
|
|
|
*/
|
|
|
|
void dsp_set_crossfeed(bool enable)
|
|
|
|
{
|
|
|
|
crossfeed_enabled = enable;
|
2007-11-18 17:12:19 +00:00
|
|
|
audio_dsp.apply_crossfeed = (enable && audio_dsp.data.num_channels > 1)
|
|
|
|
? apply_crossfeed : NULL;
|
2007-02-27 14:25:36 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void dsp_set_crossfeed_direct_gain(int gain)
|
|
|
|
{
|
2007-12-08 01:45:04 +00:00
|
|
|
crossfeed_data.gain = get_replaygain_int(gain * 10) << 7;
|
2007-02-27 17:55:38 +00:00
|
|
|
/* If gain is negative, the calculation overflowed and we need to clamp */
|
|
|
|
if (crossfeed_data.gain < 0)
|
|
|
|
crossfeed_data.gain = 0x7fffffff;
|
2007-02-27 14:25:36 +00:00
|
|
|
}
|
|
|
|
|
2007-12-08 01:45:04 +00:00
|
|
|
/* Both gains should be below 0 dB */
|
2007-02-27 14:25:36 +00:00
|
|
|
void dsp_set_crossfeed_cross_params(long lf_gain, long hf_gain, long cutoff)
|
|
|
|
{
|
2007-03-07 15:06:33 +00:00
|
|
|
int32_t *c = crossfeed_data.coefs;
|
2007-12-08 01:45:04 +00:00
|
|
|
long scaler = get_replaygain_int(lf_gain * 10) << 7;
|
2007-03-07 15:06:33 +00:00
|
|
|
|
|
|
|
cutoff = 0xffffffff/NATIVE_FREQUENCY*cutoff;
|
|
|
|
hf_gain -= lf_gain;
|
2007-12-08 01:45:04 +00:00
|
|
|
/* Divide cutoff by sqrt(10^(hf_gain/20)) to place cutoff at the -3 dB
|
2007-03-07 15:06:33 +00:00
|
|
|
* point instead of shelf midpoint. This is for compatibility with the old
|
|
|
|
* crossfeed shelf filter and should be removed if crossfeed settings are
|
|
|
|
* ever made incompatible for any other good reason.
|
|
|
|
*/
|
2007-12-08 01:45:04 +00:00
|
|
|
cutoff = DIV64(cutoff, get_replaygain_int(hf_gain*5), 24);
|
|
|
|
filter_shelf_coefs(cutoff, hf_gain, false, c);
|
2007-03-07 15:06:33 +00:00
|
|
|
/* Scale coefs by LF gain and shift them to s0.31 format. We have no gains
|
|
|
|
* over 1 and can do this safely
|
|
|
|
*/
|
|
|
|
c[0] = FRACMUL_SHL(c[0], scaler, 4);
|
|
|
|
c[1] = FRACMUL_SHL(c[1], scaler, 4);
|
|
|
|
c[2] <<= 4;
|
2007-02-27 14:25:36 +00:00
|
|
|
}
|
2005-11-14 21:56:56 +00:00
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
/* Apply a constant gain to the samples (e.g., for ReplayGain).
|
|
|
|
* Note that this must be called before the resampler.
|
|
|
|
*/
|
|
|
|
#ifndef DSP_HAVE_ASM_APPLY_GAIN
|
|
|
|
static void dsp_apply_gain(int count, struct dsp_data *data, int32_t *buf[])
|
|
|
|
{
|
|
|
|
const int32_t gain = data->gain;
|
|
|
|
int ch = data->num_channels - 1;
|
|
|
|
|
|
|
|
do
|
|
|
|
{
|
|
|
|
int32_t *s = buf[ch];
|
|
|
|
int32_t *d = buf[ch];
|
|
|
|
int32_t samp = *s++;
|
|
|
|
int i = 0;
|
|
|
|
|
|
|
|
do
|
|
|
|
{
|
|
|
|
FRACMUL_8_LOOP(samp, gain, s, d);
|
|
|
|
}
|
|
|
|
while (++i < count);
|
|
|
|
}
|
|
|
|
while (--ch >= 0);
|
|
|
|
}
|
|
|
|
#endif /* DSP_HAVE_ASM_APPLY_GAIN */
|
|
|
|
|
2006-04-17 21:04:57 +00:00
|
|
|
/* Combine all gains to a global gain. */
|
2007-02-24 17:06:36 +00:00
|
|
|
static void set_gain(struct dsp_config *dsp)
|
2006-04-17 21:04:57 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
dsp->data.gain = DEFAULT_GAIN;
|
2007-02-24 17:06:36 +00:00
|
|
|
|
|
|
|
/* Replay gain not relevant to voice */
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp == &audio_dsp && replaygain)
|
2006-04-17 21:04:57 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
dsp->data.gain = replaygain;
|
2006-04-17 21:04:57 +00:00
|
|
|
}
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp->eq_process && eq_precut)
|
2006-04-17 21:04:57 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
dsp->data.gain =
|
|
|
|
(long) (((int64_t) dsp->data.gain * eq_precut) >> 24);
|
2006-04-17 21:04:57 +00:00
|
|
|
}
|
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
if (dsp->data.gain == DEFAULT_GAIN)
|
2006-04-17 21:04:57 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
dsp->data.gain = 0;
|
2006-04-17 21:04:57 +00:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
dsp->data.gain >>= 1;
|
2006-04-17 21:04:57 +00:00
|
|
|
}
|
2007-03-25 04:03:44 +00:00
|
|
|
|
|
|
|
dsp->apply_gain = dsp->data.gain != 0 ? dsp_apply_gain : NULL;
|
2006-04-17 21:04:57 +00:00
|
|
|
}
|
|
|
|
|
2006-03-28 21:19:30 +00:00
|
|
|
/**
|
|
|
|
* Update the amount to cut the audio before applying the equalizer.
|
|
|
|
*
|
|
|
|
* @param precut to apply in decibels (multiplied by 10)
|
|
|
|
*/
|
|
|
|
void dsp_set_eq_precut(int precut)
|
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
eq_precut = get_replaygain_int(precut * -10);
|
2007-11-18 17:12:19 +00:00
|
|
|
set_gain(&audio_dsp);
|
2006-03-27 21:20:35 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Synchronize the equalizer filter coefficients with the global settings.
|
|
|
|
*
|
|
|
|
* @param band the equalizer band to synchronize
|
|
|
|
*/
|
2006-03-28 21:19:30 +00:00
|
|
|
void dsp_set_eq_coefs(int band)
|
2006-02-07 14:07:46 +00:00
|
|
|
{
|
2006-03-24 14:06:30 +00:00
|
|
|
const int *setting;
|
|
|
|
long gain;
|
|
|
|
unsigned long cutoff, q;
|
2006-02-17 19:56:22 +00:00
|
|
|
|
|
|
|
/* Adjust setting pointer to the band we actually want to change */
|
|
|
|
setting = &global_settings.eq_band0_cutoff + (band * 3);
|
|
|
|
|
2006-03-24 14:06:30 +00:00
|
|
|
/* Convert user settings to format required by coef generator functions */
|
|
|
|
cutoff = 0xffffffff / NATIVE_FREQUENCY * (*setting++);
|
2007-02-05 01:01:15 +00:00
|
|
|
q = *setting++;
|
|
|
|
gain = *setting++;
|
2006-04-02 20:19:00 +00:00
|
|
|
|
|
|
|
if (q == 0)
|
|
|
|
q = 1;
|
|
|
|
|
2006-04-11 13:49:05 +00:00
|
|
|
/* NOTE: The coef functions assume the EMAC unit is in fractional mode,
|
|
|
|
which it should be, since we're executed from the main thread. */
|
2006-02-17 19:56:22 +00:00
|
|
|
|
2006-03-24 14:06:30 +00:00
|
|
|
/* Assume a band is disabled if the gain is zero */
|
2007-02-24 17:06:36 +00:00
|
|
|
if (gain == 0)
|
|
|
|
{
|
2006-02-17 19:56:22 +00:00
|
|
|
eq_data.enabled[band] = 0;
|
2007-02-24 17:06:36 +00:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2006-02-17 19:56:22 +00:00
|
|
|
if (band == 0)
|
2006-03-24 14:06:30 +00:00
|
|
|
eq_ls_coefs(cutoff, q, gain, eq_data.filters[band].coefs);
|
2006-02-17 19:56:22 +00:00
|
|
|
else if (band == 4)
|
2006-03-24 14:06:30 +00:00
|
|
|
eq_hs_coefs(cutoff, q, gain, eq_data.filters[band].coefs);
|
2006-02-17 19:56:22 +00:00
|
|
|
else
|
2006-03-24 14:06:30 +00:00
|
|
|
eq_pk_coefs(cutoff, q, gain, eq_data.filters[band].coefs);
|
2006-02-17 19:56:22 +00:00
|
|
|
|
|
|
|
eq_data.enabled[band] = 1;
|
2006-02-07 14:07:46 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2006-01-29 15:37:03 +00:00
|
|
|
/* Apply EQ filters to those bands that have got it switched on. */
|
2007-02-24 17:06:36 +00:00
|
|
|
static void eq_process(int count, int32_t *buf[])
|
2006-01-29 15:37:03 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
static const int shifts[] =
|
|
|
|
{
|
|
|
|
EQ_SHELF_SHIFT, /* low shelf */
|
|
|
|
EQ_PEAK_SHIFT, /* peaking */
|
|
|
|
EQ_PEAK_SHIFT, /* peaking */
|
|
|
|
EQ_PEAK_SHIFT, /* peaking */
|
|
|
|
EQ_SHELF_SHIFT, /* high shelf */
|
|
|
|
};
|
2007-11-18 17:12:19 +00:00
|
|
|
unsigned int channels = audio_dsp.data.num_channels;
|
2006-01-29 15:37:03 +00:00
|
|
|
int i;
|
2006-03-27 21:20:35 +00:00
|
|
|
|
2006-01-29 15:37:03 +00:00
|
|
|
/* filter configuration currently is 1 low shelf filter, 3 band peaking
|
2006-02-02 20:03:43 +00:00
|
|
|
filters and 1 high shelf filter, in that order. we need to know this
|
|
|
|
so we can choose the correct shift factor.
|
2006-01-29 15:37:03 +00:00
|
|
|
*/
|
2007-02-24 17:06:36 +00:00
|
|
|
for (i = 0; i < 5; i++)
|
|
|
|
{
|
|
|
|
if (!eq_data.enabled[i])
|
|
|
|
continue;
|
|
|
|
eq_filter(buf, &eq_data.filters[i], count, channels, shifts[i]);
|
2006-01-29 15:37:03 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
/**
|
|
|
|
* Use to enable the equalizer.
|
|
|
|
*
|
|
|
|
* @param enable true to enable the equalizer
|
|
|
|
*/
|
|
|
|
void dsp_set_eq(bool enable)
|
|
|
|
{
|
|
|
|
audio_dsp.eq_process = enable ? eq_process : NULL;
|
|
|
|
set_gain(&audio_dsp);
|
|
|
|
}
|
|
|
|
|
2007-03-07 19:11:16 +00:00
|
|
|
void dsp_set_stereo_width(int value)
|
2006-03-21 23:20:17 +00:00
|
|
|
{
|
|
|
|
long width, straight, cross;
|
|
|
|
|
2006-03-26 17:41:36 +00:00
|
|
|
width = value * 0x7fffff / 100;
|
2007-02-24 17:06:36 +00:00
|
|
|
|
|
|
|
if (value <= 100)
|
|
|
|
{
|
2006-03-26 17:41:36 +00:00
|
|
|
straight = (0x7fffff + width) / 2;
|
2006-03-21 23:20:17 +00:00
|
|
|
cross = straight - width;
|
2007-02-24 17:06:36 +00:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2006-03-26 17:41:36 +00:00
|
|
|
/* straight = (1 + width) / (2 * width) */
|
|
|
|
straight = ((int64_t)(0x7fffff + width) << 22) / width;
|
|
|
|
cross = straight - 0x7fffff;
|
2006-03-21 23:20:17 +00:00
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
|
|
|
|
dsp_sw_gain = straight << 8;
|
|
|
|
dsp_sw_cross = cross << 8;
|
2006-03-21 23:20:17 +00:00
|
|
|
}
|
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
/**
|
|
|
|
* Implements the different channel configurations and stereo width.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* SOUND_CHAN_STEREO mode is a noop so has no function - just outline one for
|
|
|
|
* completeness. */
|
|
|
|
#if 0
|
|
|
|
static void channels_process_sound_chan_stereo(int count, int32_t *buf[])
|
|
|
|
{
|
|
|
|
/* The channels are each just themselves */
|
|
|
|
(void)count; (void)buf;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#ifndef DSP_HAVE_ASM_SOUND_CHAN_MONO
|
|
|
|
static void channels_process_sound_chan_mono(int count, int32_t *buf[])
|
|
|
|
{
|
|
|
|
int32_t *sl = buf[0], *sr = buf[1];
|
|
|
|
|
|
|
|
do
|
|
|
|
{
|
|
|
|
int32_t lr = *sl/2 + *sr/2;
|
|
|
|
*sl++ = lr;
|
|
|
|
*sr++ = lr;
|
|
|
|
}
|
|
|
|
while (--count > 0);
|
|
|
|
}
|
|
|
|
#endif /* DSP_HAVE_ASM_SOUND_CHAN_MONO */
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
#ifndef DSP_HAVE_ASM_SOUND_CHAN_CUSTOM
|
|
|
|
static void channels_process_sound_chan_custom(int count, int32_t *buf[])
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
const int32_t gain = dsp_sw_gain;
|
|
|
|
const int32_t cross = dsp_sw_cross;
|
|
|
|
int32_t *sl = buf[0], *sr = buf[1];
|
2005-07-16 12:25:28 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
do
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
int32_t l = *sl;
|
|
|
|
int32_t r = *sr;
|
|
|
|
*sl++ = FRACMUL(l, gain) + FRACMUL(r, cross);
|
|
|
|
*sr++ = FRACMUL(r, gain) + FRACMUL(l, cross);
|
|
|
|
}
|
|
|
|
while (--count > 0);
|
|
|
|
}
|
|
|
|
#endif /* DSP_HAVE_ASM_SOUND_CHAN_CUSTOM */
|
2005-07-16 12:25:28 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
static void channels_process_sound_chan_mono_left(int count, int32_t *buf[])
|
|
|
|
{
|
|
|
|
/* Just copy over the other channel */
|
|
|
|
memcpy(buf[1], buf[0], count * sizeof (*buf));
|
|
|
|
}
|
|
|
|
|
|
|
|
static void channels_process_sound_chan_mono_right(int count, int32_t *buf[])
|
|
|
|
{
|
|
|
|
/* Just copy over the other channel */
|
|
|
|
memcpy(buf[0], buf[1], count * sizeof (*buf));
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifndef DSP_HAVE_ASM_SOUND_CHAN_KARAOKE
|
|
|
|
static void channels_process_sound_chan_karaoke(int count, int32_t *buf[])
|
|
|
|
{
|
|
|
|
int32_t *sl = buf[0], *sr = buf[1];
|
|
|
|
|
|
|
|
do
|
|
|
|
{
|
2007-02-27 14:25:36 +00:00
|
|
|
int32_t ch = *sl/2 - *sr/2;
|
|
|
|
*sl++ = ch;
|
|
|
|
*sr++ = -ch;
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
while (--count > 0);
|
|
|
|
}
|
|
|
|
#endif /* DSP_HAVE_ASM_SOUND_CHAN_KARAOKE */
|
|
|
|
|
2007-03-07 19:11:16 +00:00
|
|
|
void dsp_set_channel_config(int value)
|
2007-02-24 17:06:36 +00:00
|
|
|
{
|
2007-02-27 14:25:36 +00:00
|
|
|
static const channels_process_fn_type channels_process_functions[] =
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
/* SOUND_CHAN_STEREO = All-purpose index for no channel processing */
|
|
|
|
[SOUND_CHAN_STEREO] = NULL,
|
|
|
|
[SOUND_CHAN_MONO] = channels_process_sound_chan_mono,
|
|
|
|
[SOUND_CHAN_CUSTOM] = channels_process_sound_chan_custom,
|
|
|
|
[SOUND_CHAN_MONO_LEFT] = channels_process_sound_chan_mono_left,
|
|
|
|
[SOUND_CHAN_MONO_RIGHT] = channels_process_sound_chan_mono_right,
|
|
|
|
[SOUND_CHAN_KARAOKE] = channels_process_sound_chan_karaoke,
|
|
|
|
};
|
2005-08-18 19:25:39 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if ((unsigned)value >= ARRAYLEN(channels_process_functions) ||
|
2007-11-18 17:12:19 +00:00
|
|
|
audio_dsp.stereo_mode == STEREO_MONO)
|
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
value = SOUND_CHAN_STEREO;
|
2007-11-18 17:12:19 +00:00
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
|
|
|
|
/* This doesn't apply to voice */
|
|
|
|
channels_mode = value;
|
2007-11-18 17:12:19 +00:00
|
|
|
audio_dsp.channels_process = channels_process_functions[value];
|
|
|
|
}
|
|
|
|
|
|
|
|
#if CONFIG_CODEC == SWCODEC
|
|
|
|
|
|
|
|
#ifdef HAVE_SW_TONE_CONTROLS
|
|
|
|
static void set_tone_controls(void)
|
|
|
|
{
|
|
|
|
filter_bishelf_coefs(0xffffffff/NATIVE_FREQUENCY*200,
|
|
|
|
0xffffffff/NATIVE_FREQUENCY*3500,
|
|
|
|
bass, treble, -prescale,
|
|
|
|
audio_dsp.tone_filter.coefs);
|
|
|
|
/* Sync the voice dsp coefficients */
|
|
|
|
memcpy(&voice_dsp.tone_filter.coefs, audio_dsp.tone_filter.coefs,
|
|
|
|
sizeof (voice_dsp.tone_filter.coefs));
|
2005-06-26 19:41:29 +00:00
|
|
|
}
|
2007-11-18 17:12:19 +00:00
|
|
|
#endif
|
|
|
|
|
|
|
|
/* Hook back from firmware/ part of audio, which can't/shouldn't call apps/
|
|
|
|
* code directly.
|
|
|
|
*/
|
|
|
|
int dsp_callback(int msg, intptr_t param)
|
|
|
|
{
|
|
|
|
switch (msg) {
|
|
|
|
#ifdef HAVE_SW_TONE_CONTROLS
|
|
|
|
case DSP_CALLBACK_SET_PRESCALE:
|
|
|
|
prescale = param;
|
|
|
|
set_tone_controls();
|
|
|
|
break;
|
|
|
|
/* prescaler is always set after calling any of these, so we wait with
|
|
|
|
* calculating coefs until the above case is hit.
|
|
|
|
*/
|
|
|
|
case DSP_CALLBACK_SET_BASS:
|
|
|
|
bass = param;
|
|
|
|
break;
|
|
|
|
case DSP_CALLBACK_SET_TREBLE:
|
|
|
|
treble = param;
|
|
|
|
#endif
|
|
|
|
case DSP_CALLBACK_SET_CHANNEL_CONFIG:
|
|
|
|
dsp_set_channel_config(param);
|
|
|
|
break;
|
|
|
|
case DSP_CALLBACK_SET_STEREO_WIDTH:
|
|
|
|
dsp_set_stereo_width(param);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
#endif
|
2005-06-26 19:41:29 +00:00
|
|
|
|
2005-07-16 12:25:28 +00:00
|
|
|
/* Process and convert src audio to dst based on the DSP configuration,
|
2007-02-07 00:51:50 +00:00
|
|
|
* reading count number of audio samples. dst is assumed to be large
|
|
|
|
* enough; use dsp_output_count() to get the required number. src is an
|
|
|
|
* array of pointers; for mono and interleaved stereo, it contains one
|
|
|
|
* pointer to the start of the audio data and the other is ignored; for
|
|
|
|
* non-interleaved stereo, it contains two pointers, one for each audio
|
|
|
|
* channel. Returns number of bytes written to dst.
|
2005-07-16 12:25:28 +00:00
|
|
|
*/
|
2007-11-18 17:12:19 +00:00
|
|
|
int dsp_process(struct dsp_config *dsp, char *dst, const char *src[], int count)
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
int32_t *tmp[2];
|
2007-02-07 00:51:50 +00:00
|
|
|
int written = 0;
|
2005-07-16 12:25:28 +00:00
|
|
|
int samples;
|
|
|
|
|
2007-05-10 13:16:08 +00:00
|
|
|
#if defined(CPU_COLDFIRE)
|
2005-09-07 00:24:27 +00:00
|
|
|
/* set emac unit for dsp processing, and save old macsr, we're running in
|
|
|
|
codec thread context at this point, so can't clobber it */
|
|
|
|
unsigned long old_macsr = coldfire_get_macsr();
|
2005-11-23 14:30:58 +00:00
|
|
|
coldfire_set_macsr(EMAC_FRACTIONAL | EMAC_SATURATE);
|
2007-02-26 00:41:26 +00:00
|
|
|
#endif
|
2006-03-27 21:20:35 +00:00
|
|
|
|
2007-03-25 04:03:44 +00:00
|
|
|
if (new_gain)
|
|
|
|
dsp_set_replaygain(); /* Gain has changed */
|
|
|
|
|
|
|
|
/* Testing function pointers for NULL is preferred since the pointer
|
|
|
|
will be preloaded to be used for the call if not. */
|
2007-02-07 00:51:50 +00:00
|
|
|
while (count > 0)
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-03-25 04:03:44 +00:00
|
|
|
samples = MIN(SAMPLE_BUF_COUNT/2, count);
|
2007-02-07 00:51:50 +00:00
|
|
|
count -= samples;
|
2007-03-25 04:03:44 +00:00
|
|
|
|
|
|
|
dsp->input_samples(samples, src, tmp);
|
|
|
|
|
|
|
|
if (dsp->apply_gain)
|
|
|
|
dsp->apply_gain(samples, &dsp->data, tmp);
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp->resample && (samples = resample(dsp, samples, tmp)) <= 0)
|
2007-02-16 12:01:35 +00:00
|
|
|
break; /* I'm pretty sure we're downsampling here */
|
2007-03-25 04:03:44 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if (dsp->apply_crossfeed)
|
2007-02-27 17:33:23 +00:00
|
|
|
dsp->apply_crossfeed(samples, tmp);
|
2007-03-25 04:03:44 +00:00
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp->eq_process)
|
|
|
|
dsp->eq_process(samples, tmp);
|
2007-03-25 04:03:44 +00:00
|
|
|
|
2007-02-26 00:41:26 +00:00
|
|
|
#ifdef HAVE_SW_TONE_CONTROLS
|
|
|
|
if ((bass | treble) != 0)
|
2007-11-18 17:12:19 +00:00
|
|
|
eq_filter(tmp, &dsp->tone_filter, samples,
|
|
|
|
dsp->data.num_channels, FILTER_BISHELF_SHIFT);
|
2007-02-26 00:41:26 +00:00
|
|
|
#endif
|
2007-03-25 04:03:44 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if (dsp->channels_process)
|
|
|
|
dsp->channels_process(samples, tmp);
|
2007-03-25 04:03:44 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->output_samples(samples, &dsp->data, tmp, (int16_t *)dst);
|
2007-03-25 04:03:44 +00:00
|
|
|
|
2005-07-16 12:25:28 +00:00
|
|
|
written += samples;
|
2007-02-24 17:06:36 +00:00
|
|
|
dst += samples * sizeof (int16_t) * 2;
|
2005-06-26 19:41:29 +00:00
|
|
|
yield();
|
|
|
|
}
|
2007-02-07 00:51:50 +00:00
|
|
|
|
2007-05-10 13:16:08 +00:00
|
|
|
#if defined(CPU_COLDFIRE)
|
2005-09-07 00:24:27 +00:00
|
|
|
/* set old macsr again */
|
|
|
|
coldfire_set_macsr(old_macsr);
|
2007-02-26 00:41:26 +00:00
|
|
|
#endif
|
2007-02-07 00:51:50 +00:00
|
|
|
return written;
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
|
|
|
|
2007-02-07 00:51:50 +00:00
|
|
|
/* Given count number of input samples, calculate the maximum number of
|
|
|
|
* samples of output data that would be generated (the calculation is not
|
|
|
|
* entirely exact and rounds upwards to be on the safe side; during
|
|
|
|
* resampling, the number of samples generated depends on the current state
|
|
|
|
* of the resampler).
|
2005-07-16 12:25:28 +00:00
|
|
|
*/
|
2005-08-10 23:17:55 +00:00
|
|
|
/* dsp_input_size MUST be called afterwards */
|
2007-11-18 17:12:19 +00:00
|
|
|
int dsp_output_count(struct dsp_config *dsp, int count)
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
if (dsp->resample)
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-07 00:51:50 +00:00
|
|
|
count = (int)(((unsigned long)count * NATIVE_FREQUENCY
|
|
|
|
+ (dsp->frequency - 1)) / dsp->frequency);
|
2007-02-24 17:06:36 +00:00
|
|
|
}
|
2005-08-10 23:17:55 +00:00
|
|
|
|
2007-02-28 17:32:31 +00:00
|
|
|
/* Now we have the resampled sample count which must not exceed
|
|
|
|
* RESAMPLE_BUF_COUNT/2 to avoid resample buffer overflow. One
|
|
|
|
* must call dsp_input_count() to get the correct input sample
|
|
|
|
* count.
|
|
|
|
*/
|
|
|
|
if (count > RESAMPLE_BUF_COUNT/2)
|
|
|
|
count = RESAMPLE_BUF_COUNT/2;
|
|
|
|
|
2007-02-07 00:51:50 +00:00
|
|
|
return count;
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
|
|
|
|
2007-02-07 00:51:50 +00:00
|
|
|
/* Given count output samples, calculate number of input samples
|
|
|
|
* that would be consumed in order to fill the output buffer.
|
2005-07-16 12:25:28 +00:00
|
|
|
*/
|
2007-11-18 17:12:19 +00:00
|
|
|
int dsp_input_count(struct dsp_config *dsp, int count)
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2007-02-07 00:51:50 +00:00
|
|
|
/* count is now the number of resampled input samples. Convert to
|
2005-08-10 23:17:55 +00:00
|
|
|
original input samples. */
|
2007-02-24 17:06:36 +00:00
|
|
|
if (dsp->resample)
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2005-08-10 23:17:55 +00:00
|
|
|
/* Use the real resampling delta =
|
2007-02-07 00:51:50 +00:00
|
|
|
* dsp->frequency * 65536 / NATIVE_FREQUENCY, and
|
2005-08-10 23:17:55 +00:00
|
|
|
* round towards zero to avoid buffer overflows. */
|
2007-02-07 00:51:50 +00:00
|
|
|
count = (int)(((unsigned long)count *
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->data.resample_data.delta) >> 16);
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
|
|
|
|
2007-02-07 00:51:50 +00:00
|
|
|
return count;
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
|
|
|
|
2007-03-29 01:55:47 +00:00
|
|
|
static void dsp_set_gain_var(long *var, long value)
|
2005-06-26 19:41:29 +00:00
|
|
|
{
|
2007-11-18 17:12:19 +00:00
|
|
|
*var = value;
|
|
|
|
new_gain = true;
|
2007-03-29 01:55:47 +00:00
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
static void dsp_update_functions(struct dsp_config *dsp)
|
2007-03-29 01:55:47 +00:00
|
|
|
{
|
2007-11-18 17:12:19 +00:00
|
|
|
sample_input_new_format(dsp);
|
|
|
|
sample_output_new_format(dsp);
|
|
|
|
if (dsp == &audio_dsp)
|
2007-03-29 01:55:47 +00:00
|
|
|
dsp_set_crossfeed(crossfeed_enabled);
|
|
|
|
}
|
2005-08-20 11:13:19 +00:00
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
intptr_t dsp_configure(struct dsp_config *dsp, int setting, intptr_t value)
|
2007-03-29 01:55:47 +00:00
|
|
|
{
|
2005-07-16 12:25:28 +00:00
|
|
|
switch (setting)
|
|
|
|
{
|
2007-11-18 17:12:19 +00:00
|
|
|
case DSP_MYDSP:
|
|
|
|
switch (value)
|
|
|
|
{
|
|
|
|
case CODEC_IDX_AUDIO:
|
|
|
|
return (intptr_t)&audio_dsp;
|
|
|
|
case CODEC_IDX_VOICE:
|
|
|
|
return (intptr_t)&voice_dsp;
|
|
|
|
default:
|
|
|
|
return (intptr_t)NULL;
|
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
|
2005-06-26 19:41:29 +00:00
|
|
|
case DSP_SET_FREQUENCY:
|
2007-11-18 17:12:19 +00:00
|
|
|
memset(&dsp->data.resample_data, 0, sizeof (dsp->data.resample_data));
|
2005-08-10 22:56:24 +00:00
|
|
|
/* Fall through!!! */
|
|
|
|
case DSP_SWITCH_FREQUENCY:
|
2007-02-10 16:34:16 +00:00
|
|
|
dsp->codec_frequency = (value == 0) ? NATIVE_FREQUENCY : value;
|
2006-10-27 20:41:33 +00:00
|
|
|
/* Account for playback speed adjustment when setting dsp->frequency
|
2005-11-28 22:26:20 +00:00
|
|
|
if we're called from the main audio thread. Voice UI thread should
|
|
|
|
not need this feature.
|
|
|
|
*/
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp == &audio_dsp)
|
2005-11-28 22:26:20 +00:00
|
|
|
dsp->frequency = pitch_ratio * dsp->codec_frequency / 1000;
|
|
|
|
else
|
|
|
|
dsp->frequency = dsp->codec_frequency;
|
2005-07-16 12:25:28 +00:00
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
resampler_new_delta(dsp);
|
2005-07-16 12:25:28 +00:00
|
|
|
break;
|
|
|
|
|
2005-06-26 19:41:29 +00:00
|
|
|
case DSP_SET_SAMPLE_DEPTH:
|
2007-02-10 16:34:16 +00:00
|
|
|
dsp->sample_depth = value;
|
2007-02-19 02:49:26 +00:00
|
|
|
|
2005-08-20 11:13:19 +00:00
|
|
|
if (dsp->sample_depth <= NATIVE_DEPTH)
|
2005-07-16 12:25:28 +00:00
|
|
|
{
|
2005-08-20 11:13:19 +00:00
|
|
|
dsp->frac_bits = WORD_FRACBITS;
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->sample_bytes = sizeof (int16_t); /* samples are 16 bits */
|
|
|
|
dsp->data.clip_max = ((1 << WORD_FRACBITS) - 1);
|
|
|
|
dsp->data.clip_min = -((1 << WORD_FRACBITS));
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2007-02-10 16:34:16 +00:00
|
|
|
dsp->frac_bits = value;
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->sample_bytes = sizeof (int32_t); /* samples are 32 bits */
|
|
|
|
dsp->data.clip_max = (1 << value) - 1;
|
|
|
|
dsp->data.clip_min = -(1 << value);
|
2005-07-16 12:25:28 +00:00
|
|
|
}
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->data.output_scale = dsp->frac_bits + 1 - NATIVE_DEPTH;
|
2007-11-18 17:12:19 +00:00
|
|
|
sample_input_new_format(dsp);
|
|
|
|
dither_init(dsp);
|
2005-07-16 12:25:28 +00:00
|
|
|
break;
|
|
|
|
|
2005-06-26 19:41:29 +00:00
|
|
|
case DSP_SET_STEREO_MODE:
|
2007-02-19 02:49:26 +00:00
|
|
|
dsp->stereo_mode = value;
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->data.num_channels = value == STEREO_MONO ? 1 : 2;
|
2007-11-18 17:12:19 +00:00
|
|
|
dsp_update_functions(dsp);
|
2005-07-16 12:25:28 +00:00
|
|
|
break;
|
|
|
|
|
2005-06-26 19:41:29 +00:00
|
|
|
case DSP_RESET:
|
2005-08-20 11:13:19 +00:00
|
|
|
dsp->stereo_mode = STEREO_NONINTERLEAVED;
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->data.num_channels = 2;
|
2005-08-20 11:13:19 +00:00
|
|
|
dsp->sample_depth = NATIVE_DEPTH;
|
|
|
|
dsp->frac_bits = WORD_FRACBITS;
|
2007-02-24 17:06:36 +00:00
|
|
|
dsp->sample_bytes = sizeof (int16_t);
|
|
|
|
dsp->data.output_scale = dsp->frac_bits + 1 - NATIVE_DEPTH;
|
|
|
|
dsp->data.clip_max = ((1 << WORD_FRACBITS) - 1);
|
|
|
|
dsp->data.clip_min = -((1 << WORD_FRACBITS));
|
|
|
|
dsp->codec_frequency = dsp->frequency = NATIVE_FREQUENCY;
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp == &audio_dsp)
|
2007-02-24 17:06:36 +00:00
|
|
|
{
|
|
|
|
track_gain = 0;
|
|
|
|
album_gain = 0;
|
|
|
|
track_peak = 0;
|
|
|
|
album_peak = 0;
|
|
|
|
new_gain = true;
|
|
|
|
}
|
|
|
|
|
2007-11-18 17:12:19 +00:00
|
|
|
dsp_update_functions(dsp);
|
|
|
|
resampler_new_delta(dsp);
|
2005-07-16 12:25:28 +00:00
|
|
|
break;
|
|
|
|
|
2006-11-26 12:02:47 +00:00
|
|
|
case DSP_FLUSH:
|
2007-02-24 17:06:36 +00:00
|
|
|
memset(&dsp->data.resample_data, 0,
|
|
|
|
sizeof (dsp->data.resample_data));
|
2007-11-18 17:12:19 +00:00
|
|
|
resampler_new_delta(dsp);
|
|
|
|
dither_init(dsp);
|
2006-11-26 12:02:47 +00:00
|
|
|
break;
|
|
|
|
|
2005-07-24 15:32:28 +00:00
|
|
|
case DSP_SET_TRACK_GAIN:
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp == &audio_dsp)
|
|
|
|
dsp_set_gain_var(&track_gain, value);
|
2005-07-24 15:32:28 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case DSP_SET_ALBUM_GAIN:
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp == &audio_dsp)
|
|
|
|
dsp_set_gain_var(&album_gain, value);
|
2005-07-24 15:32:28 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case DSP_SET_TRACK_PEAK:
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp == &audio_dsp)
|
|
|
|
dsp_set_gain_var(&track_peak, value);
|
2005-07-24 15:32:28 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case DSP_SET_ALBUM_PEAK:
|
2007-11-18 17:12:19 +00:00
|
|
|
if (dsp == &audio_dsp)
|
|
|
|
dsp_set_gain_var(&album_peak, value);
|
2005-07-24 15:32:28 +00:00
|
|
|
break;
|
|
|
|
|
2005-06-26 19:41:29 +00:00
|
|
|
default:
|
|
|
|
return 0;
|
|
|
|
}
|
2005-07-16 12:25:28 +00:00
|
|
|
|
2005-06-26 19:41:29 +00:00
|
|
|
return 1;
|
|
|
|
}
|
2005-07-24 15:32:28 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
void dsp_set_replaygain(void)
|
2005-07-24 15:32:28 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
long gain = 0;
|
2005-07-24 15:32:28 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
new_gain = false;
|
2005-08-11 18:56:20 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if (global_settings.replaygain || global_settings.replaygain_noclip)
|
|
|
|
{
|
|
|
|
bool track_mode = get_replaygain_mode(track_gain != 0,
|
|
|
|
album_gain != 0) == REPLAYGAIN_TRACK;
|
|
|
|
long peak = (track_mode || !album_peak) ? track_peak : album_peak;
|
2005-08-11 18:56:20 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if (global_settings.replaygain)
|
|
|
|
{
|
|
|
|
gain = (track_mode || !album_gain) ? track_gain : album_gain;
|
2005-08-11 18:56:20 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if (global_settings.replaygain_preamp)
|
2005-07-24 15:32:28 +00:00
|
|
|
{
|
2007-02-24 17:06:36 +00:00
|
|
|
long preamp = get_replaygain_int(
|
|
|
|
global_settings.replaygain_preamp * 10);
|
2005-08-11 18:56:20 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
gain = (long) (((int64_t) gain * preamp) >> 24);
|
2005-07-24 15:32:28 +00:00
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
}
|
2005-08-11 18:56:20 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if (gain == 0)
|
|
|
|
{
|
|
|
|
/* So that noclip can work even with no gain information. */
|
|
|
|
gain = DEFAULT_GAIN;
|
|
|
|
}
|
2005-08-11 18:56:20 +00:00
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if (global_settings.replaygain_noclip && (peak != 0)
|
|
|
|
&& ((((int64_t) gain * peak) >> 24) >= DEFAULT_GAIN))
|
|
|
|
{
|
|
|
|
gain = (((int64_t) DEFAULT_GAIN << 24) / peak);
|
2005-07-24 15:32:28 +00:00
|
|
|
}
|
|
|
|
|
2007-02-24 17:06:36 +00:00
|
|
|
if (gain == DEFAULT_GAIN)
|
|
|
|
{
|
|
|
|
/* Nothing to do, disable processing. */
|
|
|
|
gain = 0;
|
|
|
|
}
|
2005-07-24 15:32:28 +00:00
|
|
|
}
|
2007-02-24 17:06:36 +00:00
|
|
|
|
|
|
|
/* Store in S8.23 format to simplify calculations. */
|
|
|
|
replaygain = gain;
|
2007-11-18 17:12:19 +00:00
|
|
|
set_gain(&audio_dsp);
|
2005-07-24 15:32:28 +00:00
|
|
|
}
|