1 /*
2 * Copyright (C) 2004-2010 NXP Software
3 * Copyright (C) 2010 The Android Open Source Project
4 *
5 * Licensed under the Apache License, Version 2.0 (the "License");
6 * you may not use this file except in compliance with the License.
7 * You may obtain a copy of the License at
8 *
9 * http://www.apache.org/licenses/LICENSE-2.0
10 *
11 * Unless required by applicable law or agreed to in writing, software
12 * distributed under the License is distributed on an "AS IS" BASIS,
13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14 * See the License for the specific language governing permissions and
15 * limitations under the License.
16 */
17
18 /**********************************************************************************
19 INCLUDE FILES
20 ***********************************************************************************/
21 #include "LVC_Mixer_Private.h"
22 #include "LVM_Macros.h"
23 #include "ScalarArithmetic.h"
24
ADD2_SAT_FLOAT(LVM_FLOAT a,LVM_FLOAT b)25 static inline LVM_FLOAT ADD2_SAT_FLOAT(LVM_FLOAT a, LVM_FLOAT b) {
26 return LVM_Clamp(a + b);
27 }
LVC_Core_MixSoft_1St_MC_float_WRA(Mix_Private_FLOAT_st ** ptrInstance,const LVM_FLOAT * src,LVM_FLOAT * dst,LVM_INT16 NrFrames,LVM_INT16 NrChannels)28 void LVC_Core_MixSoft_1St_MC_float_WRA(Mix_Private_FLOAT_st** ptrInstance, const LVM_FLOAT* src,
29 LVM_FLOAT* dst, LVM_INT16 NrFrames, LVM_INT16 NrChannels) {
30 LVM_INT32 ii, ch;
31 LVM_FLOAT tempCurrent[NrChannels];
32 for (ch = 0; ch < NrChannels; ch++) {
33 tempCurrent[ch] = ptrInstance[ch]->Current;
34 }
35 for (ii = NrFrames; ii > 0; ii--) {
36 for (ch = 0; ch < NrChannels; ch++) {
37 Mix_Private_FLOAT_st* pInstance = ptrInstance[ch];
38 const LVM_FLOAT Delta = pInstance->Delta;
39 LVM_FLOAT Current = tempCurrent[ch];
40 const LVM_FLOAT Target = pInstance->Target;
41 if (Current < Target) {
42 Current = ADD2_SAT_FLOAT(Current, Delta);
43 if (Current > Target) Current = Target;
44 } else {
45 Current -= Delta;
46 if (Current < Target) Current = Target;
47 }
48 *dst++ = *src++ * Current;
49 tempCurrent[ch] = Current;
50 }
51 }
52 for (ch = 0; ch < NrChannels; ch++) {
53 ptrInstance[ch]->Current = tempCurrent[ch];
54 }
55 }
56