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
121
122
123
124
125
|
/*
* Copyright (c) 2012 The WebRTC project authors. All Rights Reserved.
*
* Use of this source code is governed by a BSD-style license
* that can be found in the LICENSE file in the root of the source
* tree. An additional intellectual property rights grant can be found
* in the file PATENTS. All contributing project authors may
* be found in the AUTHORS file in the root of the source tree.
*/
#include "utility.h"
#include "module.h"
#include "trace.h"
#include "signal_processing_library.h"
namespace webrtc
{
namespace voe
{
enum{kMaxTargetLen = 2*32*10}; // stereo 32KHz 10ms
void Utility::MixWithSat(int16_t target[],
int target_channel,
const int16_t source[],
int source_channel,
int source_len)
{
assert((target_channel == 1) || (target_channel == 2));
assert((source_channel == 1) || (source_channel == 2));
assert(source_len <= kMaxTargetLen);
if ((target_channel == 2) && (source_channel == 1))
{
// Convert source from mono to stereo.
int32_t left = 0;
int32_t right = 0;
for (int i = 0; i < source_len; ++i) {
left = source[i] + target[i*2];
right = source[i] + target[i*2 + 1];
target[i*2] = WebRtcSpl_SatW32ToW16(left);
target[i*2 + 1] = WebRtcSpl_SatW32ToW16(right);
}
}
else if ((target_channel == 1) && (source_channel == 2))
{
// Convert source from stereo to mono.
int32_t temp = 0;
for (int i = 0; i < source_len/2; ++i) {
temp = ((source[i*2] + source[i*2 + 1])>>1) + target[i];
target[i] = WebRtcSpl_SatW32ToW16(temp);
}
}
else
{
int32_t temp = 0;
for (int i = 0; i < source_len; ++i) {
temp = source[i] + target[i];
target[i] = WebRtcSpl_SatW32ToW16(temp);
}
}
}
void Utility::MixSubtractWithSat(int16_t target[],
const int16_t source[],
uint16_t len)
{
int32_t temp(0);
for (int i = 0; i < len; i++)
{
temp = target[i] - source[i];
if (temp > 32767)
target[i] = 32767;
else if (temp < -32768)
target[i] = -32768;
else
target[i] = (int16_t) temp;
}
}
void Utility::MixAndScaleWithSat(int16_t target[],
const int16_t source[], float scale,
uint16_t len)
{
int32_t temp(0);
for (int i = 0; i < len; i++)
{
temp = (int32_t) (target[i] + scale * source[i]);
if (temp > 32767)
target[i] = 32767;
else if (temp < -32768)
target[i] = -32768;
else
target[i] = (int16_t) temp;
}
}
void Utility::Scale(int16_t vector[], float scale, uint16_t len)
{
for (int i = 0; i < len; i++)
{
vector[i] = (int16_t) (scale * vector[i]);
}
}
void Utility::ScaleWithSat(int16_t vector[], float scale,
uint16_t len)
{
int32_t temp(0);
for (int i = 0; i < len; i++)
{
temp = (int32_t) (scale * vector[i]);
if (temp > 32767)
vector[i] = 32767;
else if (temp < -32768)
vector[i] = -32768;
else
vector[i] = (int16_t) temp;
}
}
} // namespace voe
} // namespace webrtc
|
