1 files changed, 238 insertions, 0 deletions

diff --git a/lib/rbcodec/dsp/dsp_misc.c b/lib/rbcodec/dsp/dsp_misc.c
new file mode 100644
index 0000000000..7b4589151c
--- /dev/null
+++ b/lib/rbcodec/dsp/dsp_misc.c
@@ -0,0 +1,238 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2005 Miika Pekkarinen
+ * Copyright (C) 2005 Magnus Holmgren
+ * Copyright (C) 2007 Thom Johansen
+ * Copyright (C) 2012 Michael Sevakis
+ *
+ * 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 "config.h"
+#include "system.h"
+#include "dsp.h"
+#include "dsp_sample_io.h"
+#include "replaygain.h"
+#include "sound.h"
+#include "settings.h"
+#include "fixedpoint.h"
+#include <string.h>
+#include "dsp_proc_entry.h"
+
+/** Firmware callback interface **/
+
+/* 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:
+        tone_set_prescale(param);
+        break;
+    case DSP_CALLBACK_SET_BASS:
+        tone_set_bass(param);
+        break;
+    case DSP_CALLBACK_SET_TREBLE:
+        tone_set_treble(param);
+        break;
+    /* FIXME: This must be done by bottom-level PCM driver so it works with
+              all PCM, not here and not in mixer. I won't fully support it
+              here with all streams. -- jethead71 */
+#ifdef HAVE_SW_VOLUME_CONTROL
+    case DSP_CALLBACK_SET_SW_VOLUME:
+        if (global_settings.volume < SW_VOLUME_MAX ||
+            global_settings.volume > SW_VOLUME_MIN)
+        {
+            int vol_gain = get_replaygain_int(global_settings.volume * 100);
+            pga_set_gain(PGA_VOLUME, vol_gain);
+        }
+        break;
+#endif /* HAVE_SW_VOLUME_CONTROL */
+#endif /* HAVE_SW_TONE_CONTROLS */
+    case DSP_CALLBACK_SET_CHANNEL_CONFIG:
+        channel_mode_set_config(param);
+        break;
+    case DSP_CALLBACK_SET_STEREO_WIDTH:
+        channel_mode_custom_set_width(param);
+        break;
+    default:
+        break;
+    }
+
+    return 0;
+}
+
+/** Replaygain settings **/
+static struct dsp_replay_gains current_rpgains;
+
+static void dsp_replaygain_update(const struct dsp_replay_gains *gains)
+{
+    if (gains == NULL)
+    {
+        /* Use defaults */
+        memset(&current_rpgains, 0, sizeof (current_rpgains));
+        gains = &current_rpgains;
+    }
+    else
+    {
+        current_rpgains = *gains; /* Stash settings */
+    }
+
+    int32_t gain = PGA_UNITY;
+
+    if (global_settings.replaygain_type != REPLAYGAIN_OFF ||
+        global_settings.replaygain_noclip)
+    {
+        bool track_mode =
+            get_replaygain_mode(gains->track_gain != 0,
+                                gains->album_gain != 0) == REPLAYGAIN_TRACK;
+
+        int32_t peak = (track_mode || gains->album_peak == 0) ?
+            gains->track_peak : gains->album_peak;
+
+        if (global_settings.replaygain_type != REPLAYGAIN_OFF)
+        {
+            gain = (track_mode || gains->album_gain == 0) ?
+                gains->track_gain : gains->album_gain;
+
+            if (global_settings.replaygain_preamp)
+            {
+                int32_t preamp = get_replaygain_int(
+                    global_settings.replaygain_preamp * 10);
+
+                gain = fp_mul(gain, preamp, 24);
+            }
+        }
+
+        if (gain == 0)
+        {
+            /* So that noclip can work even with no gain information. */
+            gain = PGA_UNITY;
+        }
+
+        if (global_settings.replaygain_noclip && peak != 0 &&
+            fp_mul(gain, peak, 24) >= PGA_UNITY)
+        {
+            gain = fp_div(PGA_UNITY, peak, 24);
+        }
+    }
+
+    pga_set_gain(PGA_REPLAYGAIN, gain);
+    pga_enable_gain(PGA_REPLAYGAIN, gain != PGA_UNITY);
+}
+
+int get_replaygain_mode(bool have_track_gain, bool have_album_gain)
+{
+    bool track = false;
+
+    switch (global_settings.replaygain_type)
+    {
+    case REPLAYGAIN_TRACK:
+        track = true;
+        break;
+
+    case REPLAYGAIN_SHUFFLE:
+        track = global_settings.playlist_shuffle;
+        break;
+    }
+
+    return (!track && have_album_gain) ?
+        REPLAYGAIN_ALBUM : (have_track_gain ? REPLAYGAIN_TRACK : -1);
+}
+
+void dsp_set_replaygain(void)
+{
+    dsp_replaygain_update(&current_rpgains);
+}
+
+
+/** Pitch Settings **/
+
+#ifdef HAVE_PITCHSCREEN
+static int32_t pitch_ratio = PITCH_SPEED_100;
+
+static void dsp_pitch_update(struct dsp_config *dsp)
+{
+    /* Account for playback speed adjustment when setting dsp->frequency
+       if we're called from the main audio thread. Voice playback thread
+       does not support this feature. */
+    struct sample_io_data *data = (void *)dsp;
+    data->format.frequency =
+        (int64_t)pitch_ratio * data->format.codec_frequency / PITCH_SPEED_100;
+}
+
+int32_t sound_get_pitch(void)
+{
+    return pitch_ratio;
+}
+
+void sound_set_pitch(int32_t percent)
+{
+    pitch_ratio = percent > 0 ? percent : PITCH_SPEED_100;
+    struct dsp_config *dsp = dsp_get_config(CODEC_IDX_AUDIO);
+    struct sample_io_data *data = (void *)dsp;
+    dsp_configure(dsp, DSP_SWITCH_FREQUENCY, data->format.codec_frequency);
+}
+#endif /* HAVE_PITCHSCREEN */
+
+/* This is a null-processing stage that monitors as an enabled stage but never
+ * becomes active in processing samples. It only hooks messages. */
+
+/* DSP message hook */
+static intptr_t misc_handler_configure(struct dsp_proc_entry *this,
+                                       struct dsp_config *dsp,
+                                       unsigned setting,
+                                       intptr_t value)
+{
+    switch (setting)
+    {
+    case DSP_INIT:
+        /* Enable us for the audio DSP at startup */
+        if (value == CODEC_IDX_AUDIO)
+            dsp_proc_enable(dsp, DSP_PROC_MISC_HANDLER, true);
+        break;
+
+    case DSP_PROC_CLOSE:
+        /* This stage should be enabled at all times */
+        DEBUGF("DSP_PROC_MISC_HANDLER - Error: Closing!\n");
+        break;
+
+    case DSP_RESET:
+#ifdef HAVE_PITCHSCREEN
+        dsp_pitch_update(dsp);
+#endif
+        value = (intptr_t)NULL; /* Default gains */
+    case REPLAYGAIN_SET_GAINS:
+        dsp_replaygain_update((void *)value);
+        break;
+
+#ifdef HAVE_PITCHSCREEN
+    case DSP_SET_FREQUENCY:
+        dsp_pitch_update(dsp);
+        break;
+#endif
+    }
+
+    return 1;
+    (void)this;
+}
+
+/* Database entry */
+DSP_PROC_DB_ENTRY(
+    MISC_HANDLER,
+    misc_handler_configure);