xref: /external/sonivox/arm-wt-22k/lib_src/eas_mixer.c

/*----------------------------------------------------------------------------
 *
 * File:
 * eas_mixer.c
 *
 * Contents and purpose:
 * This file contains the critical components of the mix engine that
 * must be optimized for best performance.
 *
 * Copyright Sonic Network Inc. 2005

 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
 *----------------------------------------------------------------------------
 * Revision Control:
 *   $Revision: 706 $
 *   $Date: 2007-05-31 17:22:51 -0700 (Thu, 31 May 2007) $
 *----------------------------------------------------------------------------
*/

//3 dls: This module is in the midst of being converted from a synth
//3 specific module to a general purpose mix engine

/*------------------------------------
 * includes
 *------------------------------------
*/
#include "eas_data.h"
#include "eas_host.h"
#include "eas_math.h"
#include "eas_mixer.h"
#include "eas_config.h"
#include "eas_report.h"

#ifdef _MAXIMIZER_ENABLED
EAS_I32 MaximizerProcess (EAS_VOID_PTR pInstData, EAS_I32 *pSrc, EAS_I32 *pDst, EAS_I32 numSamples);
#endif

/*------------------------------------
 * defines
 *------------------------------------
*/

/* need to boost stereo by ~3dB to compensate for the panner */
#define STEREO_3DB_GAIN_BOOST       512

/*----------------------------------------------------------------------------
 * EAS_MixEngineInit()
 *----------------------------------------------------------------------------
 * Purpose:
 * Prepares the mix engine for work, allocates buffers, locates effects modules, etc.
 *
 * Inputs:
 * pEASData         - instance data
 * pInstData        - pointer to variable to receive instance data handle
 *
 * Outputs:
 *
 * Side Effects:
 *
 *----------------------------------------------------------------------------
*/
EAS_RESULT EAS_MixEngineInit (S_EAS_DATA *pEASData)
{

    /* check Configuration Module for mix buffer allocation */
    if (pEASData->staticMemoryModel)
        pEASData->pMixBuffer = EAS_CMEnumData(EAS_CM_MIX_BUFFER);
    else
        pEASData->pMixBuffer = EAS_HWMalloc(pEASData->hwInstData, BUFFER_SIZE_IN_MONO_SAMPLES * NUM_OUTPUT_CHANNELS * sizeof(EAS_I32));
    if (pEASData->pMixBuffer == NULL)
    {
        { /* dpp: EAS_ReportEx(_EAS_SEVERITY_FATAL, "Failed to allocate mix buffer memory\n"); */ }
        return EAS_ERROR_MALLOC_FAILED;
    }
    EAS_HWMemSet((void *)(pEASData->pMixBuffer), 0, BUFFER_SIZE_IN_MONO_SAMPLES * NUM_OUTPUT_CHANNELS * sizeof(EAS_I32));

    return EAS_SUCCESS;
}

/*----------------------------------------------------------------------------
 * EAS_MixEnginePrep()
 *----------------------------------------------------------------------------
 * Purpose:
 * Performs prep before synthesize a buffer of audio, such as clearing
 * audio buffers, etc.
 *
 * Inputs:
 * psEASData - pointer to overall EAS data structure
 *
 * Outputs:
 *
 * Side Effects:
 *
 *----------------------------------------------------------------------------
*/
void EAS_MixEnginePrep (S_EAS_DATA *pEASData, EAS_I32 numSamples)
{

    /* clear the mix buffer */
#if (NUM_OUTPUT_CHANNELS == 2)
    EAS_HWMemSet(pEASData->pMixBuffer, 0, numSamples * (EAS_I32) sizeof(long) * 2);
#else
    EAS_HWMemSet(pEASData->pMixBuffer, 0, (EAS_I32) numSamples * (EAS_I32) sizeof(long));
#endif

    /* need to clear other side-chain effect buffers (chorus & reverb) */
}

/*----------------------------------------------------------------------------
 * EAS_MixEnginePost
 *----------------------------------------------------------------------------
 * Purpose:
 * This routine does the post-processing after all voices have been
 * synthesized. It calls any sweeteners and does the final mixdown to
 * the output buffer.
 *
 * Inputs:
 *
 * Outputs:
 *
 * Notes:
 *----------------------------------------------------------------------------
*/
void EAS_MixEnginePost (S_EAS_DATA *pEASData, EAS_I32 numSamples)
{
    EAS_U16 gain;

//3 dls: Need to restore the mix engine metrics

    /* calculate the gain multiplier */
#ifdef _MAXIMIZER_ENABLED
    if (pEASData->effectsModules[EAS_MODULE_MAXIMIZER].effect)
    {
        EAS_I32 temp;
        temp = MaximizerProcess(pEASData->effectsModules[EAS_MODULE_MAXIMIZER].effectData, pEASData->pMixBuffer, pEASData->pMixBuffer, numSamples);
        temp = (temp * pEASData->masterGain) >> 15;
        if (temp > 32767)
            gain = 32767;
        else
            gain = (EAS_U16) temp;
    }
    else
        gain = (EAS_U16) pEASData->masterGain;
#else
    gain = (EAS_U16) pEASData->masterGain;
#endif

    /* Not using all the gain bits for now
     * Reduce the input to the compressor by 6dB to prevent saturation
     */
#ifdef _COMPRESSOR_ENABLED
    if (pEASData->effectsModules[EAS_MODULE_COMPRESSOR].effectData)
        gain = gain >> 5;
    else
        gain = gain >> 4;
#else
    gain = gain >> 4;
#endif

    /* convert 32-bit mix buffer to 16-bit output format */
#if (NUM_OUTPUT_CHANNELS == 2)
    SynthMasterGain(pEASData->pMixBuffer, pEASData->pOutputAudioBuffer, gain, (EAS_U16) ((EAS_U16) numSamples * 2));
#else
    SynthMasterGain(pEASData->pMixBuffer, pEASData->pOutputAudioBuffer, gain, (EAS_U16) numSamples);
#endif

#ifdef _ENHANCER_ENABLED
    /* enhancer effect */
    if (pEASData->effectsModules[EAS_MODULE_ENHANCER].effectData)
        (*pEASData->effectsModules[EAS_MODULE_ENHANCER].effect->pfProcess)
            (pEASData->effectsModules[EAS_MODULE_ENHANCER].effectData,
            pEASData->pOutputAudioBuffer,
            pEASData->pOutputAudioBuffer,
            numSamples);
#endif

#ifdef _GRAPHIC_EQ_ENABLED
    /* graphic EQ effect */
    if (pEASData->effectsModules[EAS_MODULE_GRAPHIC_EQ].effectData)
        (*pEASData->effectsModules[EAS_MODULE_GRAPHIC_EQ].effect->pfProcess)
            (pEASData->effectsModules[EAS_MODULE_GRAPHIC_EQ].effectData,
            pEASData->pOutputAudioBuffer,
            pEASData->pOutputAudioBuffer,
            numSamples);
#endif

#ifdef _COMPRESSOR_ENABLED
    /* compressor effect */
    if (pEASData->effectsModules[EAS_MODULE_COMPRESSOR].effectData)
        (*pEASData->effectsModules[EAS_MODULE_COMPRESSOR].effect->pfProcess)
            (pEASData->effectsModules[EAS_MODULE_COMPRESSOR].effectData,
            pEASData->pOutputAudioBuffer,
            pEASData->pOutputAudioBuffer,
            numSamples);
#endif

#ifdef _WOW_ENABLED
    /* WOW requires a 32-bit buffer, borrow the mix buffer and
     * pass it as the destination buffer
     */
    /*lint -e{740} temporarily passing a parameter through an existing I/F */
    if (pEASData->effectsModules[EAS_MODULE_WOW].effectData)
        (*pEASData->effectsModules[EAS_MODULE_WOW].effect->pfProcess)
            (pEASData->effectsModules[EAS_MODULE_WOW].effectData,
            pEASData->pOutputAudioBuffer,
            (EAS_PCM*) pEASData->pMixBuffer,
            numSamples);
#endif

#ifdef _TONECONTROLEQ_ENABLED
    /* ToneControlEQ effect */
    if (pEASData->effectsModules[EAS_MODULE_TONECONTROLEQ].effectData)
        (*pEASData->effectsModules[EAS_MODULE_TONECONTROLEQ].effect->pfProcess)
            (pEASData->effectsModules[EAS_MODULE_TONECONTROLEQ].effectData,
            pEASData->pOutputAudioBuffer,
            pEASData->pOutputAudioBuffer,
            numSamples);
#endif

#ifdef _REVERB_ENABLED
    /* Reverb effect */
    if (pEASData->effectsModules[EAS_MODULE_REVERB].effectData)
        (*pEASData->effectsModules[EAS_MODULE_REVERB].effect->pfProcess)
            (pEASData->effectsModules[EAS_MODULE_REVERB].effectData,
            pEASData->pOutputAudioBuffer,
            pEASData->pOutputAudioBuffer,
            numSamples);
#endif

#ifdef _CHORUS_ENABLED
    /* Chorus effect */
    if (pEASData->effectsModules[EAS_MODULE_CHORUS].effectData)
        (*pEASData->effectsModules[EAS_MODULE_CHORUS].effect->pfProcess)
            (pEASData->effectsModules[EAS_MODULE_CHORUS].effectData,
            pEASData->pOutputAudioBuffer,
            pEASData->pOutputAudioBuffer,
            numSamples);
#endif

}

#ifndef NATIVE_EAS_KERNEL
/*----------------------------------------------------------------------------
 * SynthMasterGain
 *----------------------------------------------------------------------------
 * Purpose:
 * Mixes down audio from 32-bit to 16-bit target buffer
 *
 * Inputs:
 *
 * Outputs:
 *
 *----------------------------------------------------------------------------
*/
void SynthMasterGain (long *pInputBuffer, EAS_PCM *pOutputBuffer, EAS_U16 nGain, EAS_U16 numSamples) {

    /* loop through the buffer */
    while (numSamples--) {
        long s;

        /* read a sample from the input buffer and add some guard bits */
        s = *pInputBuffer++;

        /* add some guard bits */
        /*lint -e{704} <avoid divide for performance>*/
        s = s >> 7;

        /* apply master gain */
        s *= (long) nGain;

        /* shift to lower 16-bits */
        /*lint -e{704} <avoid divide for performance>*/
        s = s >> 9;

        /* saturate */
        s = SATURATE(s);

        *pOutputBuffer++ = (EAS_PCM)s;
    }
}
#endif

/*----------------------------------------------------------------------------
 * EAS_MixEngineShutdown()
 *----------------------------------------------------------------------------
 * Purpose:
 * Shuts down effects modules and deallocates memory
 *
 * Inputs:
 * pEASData         - instance data
 * pInstData        - instance data handle
 *
 * Outputs:
 *
 * Side Effects:
 *
 *----------------------------------------------------------------------------
*/
EAS_RESULT EAS_MixEngineShutdown (S_EAS_DATA *pEASData)
{

    /* check Configuration Module for static memory allocation */
    if (!pEASData->staticMemoryModel && (pEASData->pMixBuffer != NULL))
        EAS_HWFree(pEASData->hwInstData, pEASData->pMixBuffer);

    return EAS_SUCCESS;
}

#ifdef UNIFIED_MIXER
#ifndef NATIVE_MIX_STREAM
/*----------------------------------------------------------------------------
 * EAS_MixStream
 *----------------------------------------------------------------------------
 * Mix a 16-bit stream into a 32-bit buffer
 *
 * pInputBuffer 16-bit input buffer
 * pMixBuffer   32-bit mix buffer
 * numSamples   number of samples to mix
 * gainLeft     initial gain left or mono
 * gainRight    initial gain right
 * gainLeft     left gain increment per sample
 * gainRight    right gain increment per sample
 * flags        bit 0 = stereo source
 *              bit 1 = stereo output
 *----------------------------------------------------------------------------
*/
void EAS_MixStream (EAS_PCM *pInputBuffer, EAS_I32 *pMixBuffer, EAS_I32 numSamples, EAS_I32 gainLeft, EAS_I32 gainRight, EAS_I32 gainIncLeft, EAS_I32 gainIncRight, EAS_I32 flags)
{
    EAS_I32 temp;
    EAS_INT src, dest;

    /* NOTE: There are a lot of optimizations that can be done
     * in the native implementations based on register
     * availability, etc. For example, it may make sense to
     * break this down into 8 separate routines:
     *
     * 1. Mono source to mono output
     * 2. Mono source to stereo output
     * 3. Stereo source to mono output
     * 4. Stereo source to stereo output
     * 5. Mono source to mono output - no gain change
     * 6. Mono source to stereo output - no gain change
     * 7. Stereo source to mono output - no gain change
     * 8. Stereo source to stereo output - no gain change
     *
     * Other possibilities include loop unrolling, skipping
     * a gain calculation every 2 or 4 samples, etc.
     */

    /* no gain change, use fast loops */
    if ((gainIncLeft == 0) && (gainIncRight == 0))
    {
        switch (flags & (MIX_FLAGS_STEREO_SOURCE | MIX_FLAGS_STEREO_OUTPUT))
        {
            /* mono to mono */
            case 0:
                gainLeft >>= 15;
                for (src = dest = 0; src < numSamples; src++, dest++)
                {

                    pMixBuffer[dest] += (pInputBuffer[src] * gainLeft) >> NUM_MIXER_GUARD_BITS;
                }
                break;

            /* mono to stereo */
            case MIX_FLAGS_STEREO_OUTPUT:
                gainLeft >>= 15;
                gainRight >>= 15;
                for (src = dest = 0; src < numSamples; src++, dest+=2)
                {
                    pMixBuffer[dest] += (pInputBuffer[src] * gainLeft) >> NUM_MIXER_GUARD_BITS;
                    pMixBuffer[dest+1] += (pInputBuffer[src] * gainRight) >> NUM_MIXER_GUARD_BITS;
                }
                break;

            /* stereo to mono */
            case MIX_FLAGS_STEREO_SOURCE:
                gainLeft >>= 15;
                gainRight >>= 15;
                for (src = dest = 0; src < numSamples; src+=2, dest++)
                {
                    temp = (pInputBuffer[src] * gainLeft) >> NUM_MIXER_GUARD_BITS;
                    temp += ((pInputBuffer[src+1] * gainRight) >> NUM_MIXER_GUARD_BITS);
                    pMixBuffer[dest] += temp;
                }
                break;

            /* stereo to stereo */
            case MIX_FLAGS_STEREO_SOURCE | MIX_FLAGS_STEREO_OUTPUT:
                gainLeft >>= 15;
                gainRight >>= 15;
                for (src = dest = 0; src < numSamples; src+=2, dest+=2)
                {
                    pMixBuffer[dest] += (pInputBuffer[src] * gainLeft) >> NUM_MIXER_GUARD_BITS;
                    pMixBuffer[dest+1] += (pInputBuffer[src+1] * gainRight) >> NUM_MIXER_GUARD_BITS;
                }
                break;
        }
    }

    /* gain change - do gain increment */
    else
    {
        switch (flags & (MIX_FLAGS_STEREO_SOURCE | MIX_FLAGS_STEREO_OUTPUT))
        {
            /* mono to mono */
            case 0:
                for (src = dest = 0; src < numSamples; src++, dest++)
                {
                    gainLeft += gainIncLeft;
                    pMixBuffer[dest] += (pInputBuffer[src] * (gainLeft >> 15)) >> NUM_MIXER_GUARD_BITS;
                }
                break;

            /* mono to stereo */
            case MIX_FLAGS_STEREO_OUTPUT:
                for (src = dest = 0; src < numSamples; src++, dest+=2)
                {
                    gainLeft += gainIncLeft;
                    gainRight += gainIncRight;
                    pMixBuffer[dest] += (pInputBuffer[src] * (gainLeft >> 15)) >> NUM_MIXER_GUARD_BITS;
                    pMixBuffer[dest+1] += (pInputBuffer[src] * (gainRight >> 15)) >> NUM_MIXER_GUARD_BITS;
                }
                break;

            /* stereo to mono */
            case MIX_FLAGS_STEREO_SOURCE:
                for (src = dest = 0; src < numSamples; src+=2, dest++)
                {
                    gainLeft += gainIncLeft;
                    gainRight += gainIncRight;
                    temp = (pInputBuffer[src] * (gainLeft >> 15)) >> NUM_MIXER_GUARD_BITS;
                    temp += ((pInputBuffer[src+1] * (gainRight >> 15)) >> NUM_MIXER_GUARD_BITS);
                    pMixBuffer[dest] += temp;
                }
                break;

            /* stereo to stereo */
            case MIX_FLAGS_STEREO_SOURCE | MIX_FLAGS_STEREO_OUTPUT:
                for (src = dest = 0; src < numSamples; src+=2, dest+=2)
                {
                    gainLeft += gainIncLeft;
                    gainRight += gainIncRight;
                    pMixBuffer[dest] += (pInputBuffer[src] * (gainLeft >> 15)) >> NUM_MIXER_GUARD_BITS;
                    pMixBuffer[dest+1] += (pInputBuffer[src+1] * (gainRight >> 15)) >> NUM_MIXER_GUARD_BITS;
                }
                break;
        }
    }
}
#endif
#endif