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 2009-2016 Jörg Müller
*
* 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.
******************************************************************************/
#include "fx/BaseIIRFilterReader.h"
#include <cstring>
AUD_NAMESPACE_BEGIN
BaseIIRFilterReader::BaseIIRFilterReader(std::shared_ptr<IReader> reader, int in, int out) :
EffectReader(reader),
m_specs(reader->getSpecs()),
m_xlen(in), m_ylen(out),
m_xpos(0), m_ypos(0), m_channel(0)
{
m_x = new sample_t[m_xlen * m_specs.channels];
m_y = new sample_t[m_ylen * m_specs.channels];
std::memset(m_x, 0, sizeof(sample_t) * m_xlen * m_specs.channels);
std::memset(m_y, 0, sizeof(sample_t) * m_ylen * m_specs.channels);
}
BaseIIRFilterReader::~BaseIIRFilterReader()
{
delete[] m_x;
delete[] m_y;
}
void BaseIIRFilterReader::setLengths(int in, int out)
{
if(in != m_xlen)
{
sample_t* xn = new sample_t[in * m_specs.channels];
std::memset(xn, 0, sizeof(sample_t) * in * m_specs.channels);
for(m_channel = 0; m_channel < m_specs.channels; m_channel++)
{
for(int i = 1; i <= in && i <= m_xlen; i++)
{
xn[(in - i) * m_specs.channels + m_channel] = x(-i);
}
}
delete[] m_x;
m_x = xn;
m_xpos = 0;
m_xlen = in;
}
if(out != m_ylen)
{
sample_t* yn = new sample_t[out * m_specs.channels];
std::memset(yn, 0, sizeof(sample_t) * out * m_specs.channels);
for(m_channel = 0; m_channel < m_specs.channels; m_channel++)
{
for(int i = 1; i <= out && i <= m_ylen; i++)
{
yn[(out - i) * m_specs.channels + m_channel] = y(-i);
}
}
delete[] m_y;
m_y = yn;
m_ypos = 0;
m_ylen = out;
}
}
void BaseIIRFilterReader::read(int& length, bool& eos, sample_t* buffer)
{
Specs specs = m_reader->getSpecs();
if(specs.channels != m_specs.channels)
{
m_specs.channels = specs.channels;
delete[] m_x;
delete[] m_y;
m_x = new sample_t[m_xlen * m_specs.channels];
m_y = new sample_t[m_ylen * m_specs.channels];
std::memset(m_x, 0, sizeof(sample_t) * m_xlen * m_specs.channels);
std::memset(m_y, 0, sizeof(sample_t) * m_ylen * m_specs.channels);
}
if(specs.rate != m_specs.rate)
{
m_specs = specs;
sampleRateChanged(m_specs.rate);
}
m_reader->read(length, eos, buffer);
for(m_channel = 0; m_channel < m_specs.channels; m_channel++)
{
for(int i = 0; i < length; i++)
{
m_x[m_xpos * m_specs.channels + m_channel] = buffer[i * m_specs.channels + m_channel];
m_y[m_ypos * m_specs.channels + m_channel] = buffer[i * m_specs.channels + m_channel] = filter();
m_xpos = m_xlen ? (m_xpos + 1) % m_xlen : 0;
m_ypos = m_ylen ? (m_ypos + 1) % m_ylen : 0;
}
}
}
void BaseIIRFilterReader::sampleRateChanged(SampleRate rate)
{
}
AUD_NAMESPACE_END
|