summaryrefslogtreecommitdiffstats
path: root/media/libeffects/lvm/lib/Common/src/LVC_MixInSoft_D16C31_SAT.c
blob: 52be1296b743f9ca30b66c30a01c879c24ef6e54 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
/*
 * Copyright (C) 2004-2010 NXP Software
 * Copyright (C) 2010 The Android Open Source Project
 *
 * 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.
 */

/**********************************************************************************

     $Author: beq07716 $
     $Revision: 1000 $
     $Date: 2010-06-28 13:08:20 +0200 (Mon, 28 Jun 2010) $

***********************************************************************************/

/**********************************************************************************
   INCLUDE FILES
***********************************************************************************/

#include "LVC_Mixer_Private.h"
#include "VectorArithmetic.h"
#include "ScalarArithmetic.h"

/**********************************************************************************
   DEFINITIONS
***********************************************************************************/

#define TRUE          1
#define FALSE         0

/**********************************************************************************
   FUNCTION MIXINSOFT_D16C31_SAT
***********************************************************************************/

void LVC_MixInSoft_D16C31_SAT( LVMixer3_1St_st *ptrInstance,
                                    LVM_INT16             *src,
                                    LVM_INT16             *dst,
                                    LVM_INT16             n)
{
    char        HardMixing = TRUE;
    LVM_INT32   TargetGain;
    Mix_Private_st  *pInstance=(Mix_Private_st *)(ptrInstance->MixerStream[0].PrivateParams);

    if(n<=0)    return;

    /******************************************************************************
       SOFT MIXING
    *******************************************************************************/
    if (pInstance->Current != pInstance->Target)
    {
        if(pInstance->Delta == 0x7FFFFFFF){
            pInstance->Current = pInstance->Target;
            TargetGain=pInstance->Target>>(16-pInstance->Shift);  // TargetGain in Q16.15 format
            LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]),TargetGain);
        }else if (Abs_32(pInstance->Current-pInstance->Target) < pInstance->Delta){
            pInstance->Current = pInstance->Target; /* Difference is not significant anymore.  Make them equal. */
            TargetGain=pInstance->Target>>(16-pInstance->Shift);  // TargetGain in Q16.15 format
            LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]),TargetGain);
        }else{
            /* Soft mixing has to be applied */
            HardMixing = FALSE;
            if(pInstance->Shift!=0){
                Shift_Sat_v16xv16 ((LVM_INT16)pInstance->Shift,src,src,n);
                LVC_Core_MixInSoft_D16C31_SAT( &(ptrInstance->MixerStream[0]), src, dst, n);
            }
            else
                LVC_Core_MixInSoft_D16C31_SAT( &(ptrInstance->MixerStream[0]), src, dst, n);
        }
    }

    /******************************************************************************
       HARD MIXING
    *******************************************************************************/

    if (HardMixing){
        if (pInstance->Target != 0){ /* Nothing to do in case Target = 0 */
            if ((pInstance->Target>>16) == 0x7FFF){
                if(pInstance->Shift!=0)
                    Shift_Sat_v16xv16 ((LVM_INT16)pInstance->Shift,src,src,n);
                Add2_Sat_16x16( src, dst, n );
            }
            else{
                if(pInstance->Shift!=0)
                    Shift_Sat_v16xv16 ((LVM_INT16)pInstance->Shift,src,src,n);
                Mac3s_Sat_16x16(src,(LVM_INT16)(pInstance->Target>>16),dst,n);
                pInstance->Current = pInstance->Target; /* In case the LVCore function would have changed the Current value */
            }
        }
    }


    /******************************************************************************
       CALL BACK
    *******************************************************************************/

    if (ptrInstance->MixerStream[0].CallbackSet){
        if (Abs_32(pInstance->Current-pInstance->Target) < pInstance->Delta){
            pInstance->Current = pInstance->Target; /* Difference is not significant anymore.  Make them equal. */
            TargetGain=pInstance->Target>>(16-pInstance->Shift);  // TargetGain in Q16.15 format
            LVC_Mixer_SetTarget(ptrInstance->MixerStream,TargetGain);
            ptrInstance->MixerStream[0].CallbackSet = FALSE;
            if (ptrInstance->MixerStream[0].pCallBack != 0){
                (*ptrInstance->MixerStream[0].pCallBack) ( ptrInstance->MixerStream[0].pCallbackHandle, ptrInstance->MixerStream[0].pGeneralPurpose,ptrInstance->MixerStream[0].CallbackParam );
            }
        }
    }

}

/**********************************************************************************/