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
126
127
128
129
130
131
132
133
134
135
136
137
138
139
|
#include "SABuffer.h"
#include "fft.h"
#include "../nsutil/window.h"
#include <windows.h>
static const float const_1_div_128_ = 1.0f / 128.0f; /* 8 bit multiplier */
static const float const_1_div_32768_ = 1.0f / 32768.f; /* 16 bit multiplier */
static const double const_1_div_2147483648_ = 1.0 / 2147483648.0; /* 32 bit multiplier */
static void Int16_To_Float32(float *dest, void *sourceBuffer, signed int sourceStride, unsigned int count)
{
signed short *src = (signed short*)sourceBuffer;
while (count--)
{
float samp = *src * const_1_div_32768_; /* FIXME: i'm concerned about this being asymetrical with float->int16 -rb */
*dest = samp;
src += sourceStride;
dest++;
}
}
static void Int24_To_Float32(float *dest, void *sourceBuffer, signed int sourceStride, unsigned int count)
{
unsigned char *src = (unsigned char*)sourceBuffer;
while (count--)
{
signed long temp = (((long)src[0]) << 8);
temp = temp | (((long)src[1]) << 16);
temp = temp | (((long)src[2]) << 24);
*dest = (float)((double)temp * const_1_div_2147483648_);
src += sourceStride * 3;
dest++;
}
}
static void Int32_To_Float32(float *dest, void *sourceBuffer, signed int sourceStride, unsigned int count)
{
int32_t *src = (int32_t *)sourceBuffer;
while (count--)
{
*dest = (float)((double)*src * const_1_div_2147483648_);
src += sourceStride;
dest++;
}
}
static void UInt8_To_Float32(float *dest, void *sourceBuffer, signed int sourceStride, unsigned int count)
{
unsigned char *src = (unsigned char*)sourceBuffer;
while (count--)
{
float samp = (*src - 128) * const_1_div_128_;
*dest = samp;
src += sourceStride;
dest++;
}
}
SABuffer::SABuffer()
{
memset(&buffer, 0, sizeof(buffer));
used=0;
init=false;
}
void SABuffer::CopyHalf()
{
memcpy(buffer[0], buffer[0]+SABUFFER_WINDOW_INCREMENT, (512-SABUFFER_WINDOW_INCREMENT)*sizeof(float));
memcpy(buffer[1], buffer[1]+SABUFFER_WINDOW_INCREMENT, (512-SABUFFER_WINDOW_INCREMENT)*sizeof(float));
used-=SABUFFER_WINDOW_INCREMENT;
}
void SABuffer::Clear()
{
used=0;
}
void SABuffer::WindowToFFTBuffer(float *wavetrum)
{
for (int i=0;i<512;i++)
{
wavetrum[i] = (buffer[0][i] + buffer[1][i]);
//*wavetrum++=0;
}
nsutil_window_Multiply_F32_IP(wavetrum, window, 512);
}
unsigned int SABuffer::AddToBuffer(char *samples, int numChannels, int bps, int ts, unsigned int numSamples)
{
if (!init) {
nsutil_window_FillHann_F32_IP(window, 512); // TODO this could be hardcoded
init=true;
}
unsigned int toCopy = min((unsigned int)(512-used), numSamples);
switch (bps)
{
case 8:
UInt8_To_Float32(buffer[0]+used, samples, numChannels, toCopy);
if (numChannels > 1)
UInt8_To_Float32(buffer[1]+used, samples+1, numChannels, toCopy);
else
UInt8_To_Float32(buffer[1]+used, samples, numChannels, toCopy);
break;
case 16:
Int16_To_Float32(buffer[0]+used, samples, numChannels, toCopy);
if (numChannels > 1)
Int16_To_Float32(buffer[1]+used, samples+2, numChannels, toCopy);
else
Int16_To_Float32(buffer[1]+used, samples, numChannels, toCopy);
break;
case 24:
Int24_To_Float32(buffer[0]+used, samples, numChannels, toCopy);
if (numChannels > 1)
Int24_To_Float32(buffer[1]+used, samples+3, numChannels, toCopy);
else
Int24_To_Float32(buffer[1]+used, samples, numChannels, toCopy);
break;
case 32:
Int32_To_Float32(buffer[0]+used, samples, numChannels, toCopy);
if (numChannels > 1)
Int32_To_Float32(buffer[1]+used, samples+4, numChannels, toCopy);
else
Int32_To_Float32(buffer[1]+used, samples, numChannels, toCopy);
break;
}
used+=toCopy;
return toCopy;
}
|
