← Back to branch summary

~ubuntu-branches/ubuntu/utopic/ardour3/utopic

« back to all changes in this revision

Viewing changes to libs/qm-dsp/dsp/signalconditioning/DFProcess.cpp

  • Committer: Package Import Robot
  • Author(s): Felipe Sateler
  • Date: 2013-09-21 19:05:02 UTC
  • Revision ID: package-import@ubuntu.com-20130921190502-8gsftrku6jnzhd7v
Tags: upstream-3.4~dfsg
Import upstream version 3.4~dfsg

Show diffs side-by-side

added added

removed removed

Lines of Context:
libs/qm-dsp/dsp/signalconditioning/DFProcess.cpp
 
1
/* -*- c-basic-offset: 4 indent-tabs-mode: nil -*-  vi:set ts=8 sts=4 sw=4: */
 
2
 
 
3
/*
 
4
    QM DSP Library
 
5
 
 
6
    Centre for Digital Music, Queen Mary, University of London.
 
7
    This file 2005-2006 Christian Landone.
 
8
 
 
9
    This program is free software; you can redistribute it and/or
 
10
    modify it under the terms of the GNU General Public License as
 
11
    published by the Free Software Foundation; either version 2 of the
 
12
    License, or (at your option) any later version.  See the file
 
13
    COPYING included with this distribution for more information.
 
14
*/
 
15
 
 
16
#include "DFProcess.h"
 
17
#include "maths/MathUtilities.h"
 
18
 
 
19
#include <cstring>
 
20
 
 
21
//////////////////////////////////////////////////////////////////////
 
22
// Construction/Destruction
 
23
//////////////////////////////////////////////////////////////////////
 
24
 
 
25
DFProcess::DFProcess( DFProcConfig Config )
 
26
{
 
27
    filtSrc = NULL;
 
28
    filtDst = NULL;     
 
29
    m_filtScratchIn = NULL;
 
30
    m_filtScratchOut = NULL;
 
31
 
 
32
    m_FFOrd = 0;
 
33
 
 
34
    initialise( Config );
 
35
}
 
36
 
 
37
DFProcess::~DFProcess()
 
38
{
 
39
    deInitialise();
 
40
}
 
41
 
 
42
void DFProcess::initialise( DFProcConfig Config )
 
43
{
 
44
    m_length = Config.length;
 
45
    m_winPre = Config.winPre;
 
46
    m_winPost = Config.winPost;
 
47
    m_alphaNormParam = Config.AlphaNormParam;
 
48
 
 
49
    m_isMedianPositive = Config.isMedianPositive;
 
50
 
 
51
    filtSrc = new double[ m_length ];
 
52
    filtDst = new double[ m_length ];
 
53
 
 
54
        
 
55
    //Low Pass Smoothing Filter Config
 
56
    m_FilterConfigParams.ord = Config.LPOrd;
 
57
    m_FilterConfigParams.ACoeffs = Config.LPACoeffs;
 
58
    m_FilterConfigParams.BCoeffs = Config.LPBCoeffs;
 
59
        
 
60
    m_FiltFilt = new FiltFilt( m_FilterConfigParams );  
 
61
}
 
62
 
 
63
void DFProcess::deInitialise()
 
64
{
 
65
    delete [] filtSrc;
 
66
 
 
67
    delete [] filtDst;
 
68
 
 
69
    delete [] m_filtScratchIn;
 
70
 
 
71
    delete [] m_filtScratchOut;
 
72
 
 
73
    delete m_FiltFilt;
 
74
}
 
75
 
 
76
void DFProcess::process(double *src, double* dst)
 
77
{
 
78
    if (m_length == 0) return;
 
79
 
 
80
    removeDCNormalize( src, filtSrc );
 
81
 
 
82
    m_FiltFilt->process( filtSrc, filtDst, m_length );
 
83
 
 
84
    medianFilter( filtDst, dst );
 
85
}
 
86
 
 
87
 
 
88
void DFProcess::medianFilter(double *src, double *dst)
 
89
{
 
90
    int i,k,j,l;
 
91
    int index = 0;
 
92
 
 
93
    double val = 0;
 
94
 
 
95
    double* y = new double[ m_winPost + m_winPre + 1];
 
96
    memset( y, 0, sizeof( double ) * ( m_winPost + m_winPre + 1) );
 
97
 
 
98
    double* scratch = new double[ m_length ];
 
99
 
 
100
    for( i = 0; i < m_winPre; i++)
 
101
    {
 
102
        if (index >= m_length) break;
 
103
 
 
104
        k = i + m_winPost + 1;
 
105
 
 
106
        for( j = 0; j < k; j++)
 
107
        {
 
108
            y[ j ] = src[ j ];
 
109
        }
 
110
        scratch[ index ] = MathUtilities::median( y, k );
 
111
        index++;
 
112
    }
 
113
 
 
114
    for(  i = 0; i + m_winPost + m_winPre < m_length; i ++)
 
115
    {
 
116
        if (index >= m_length) break;
 
117
 
 
118
                         
 
119
        l = 0;
 
120
        for(  j  = i; j < ( i + m_winPost + m_winPre + 1); j++)
 
121
        {
 
122
            y[ l ] = src[ j ];
 
123
            l++;
 
124
        }
 
125
 
 
126
        scratch[ index++ ] = MathUtilities::median( y, (m_winPost + m_winPre + 1 ));
 
127
    }
 
128
 
 
129
    for( i = std::max( m_length - m_winPost, 1); i < m_length; i++)
 
130
    {
 
131
        if (index >= m_length) break;
 
132
 
 
133
        k = std::max( i - m_winPre, 1);
 
134
 
 
135
        l = 0;
 
136
        for( j = k; j < m_length; j++)
 
137
        {
 
138
            y[ l ] = src[ j ];
 
139
 
 
140
            l++;
 
141
        }
 
142
                
 
143
        scratch[ index++ ] = MathUtilities::median( y, l); 
 
144
    }
 
145
 
 
146
 
 
147
    for( i = 0; i < m_length; i++ )
 
148
    {
 
149
        val = src[ i ] - scratch[ i ];// - 0.033;
 
150
                
 
151
        if( m_isMedianPositive )
 
152
        {
 
153
            if( val > 0 )
 
154
            {
 
155
                dst[ i ]  = val;
 
156
            }
 
157
            else
 
158
            {
 
159
                dst[ i ]  = 0;
 
160
            }
 
161
        }
 
162
        else
 
163
        {
 
164
            dst[ i ]  = val;
 
165
        }
 
166
    }
 
167
        
 
168
    delete [] y;
 
169
    delete [] scratch;
 
170
}
 
171
 
 
172
 
 
173
void DFProcess::removeDCNormalize( double *src, double*dst )
 
174
{
 
175
    double DFmax = 0;
 
176
    double DFMin = 0;
 
177
    double DFAlphaNorm = 0;
 
178
 
 
179
    MathUtilities::getFrameMinMax( src, m_length, &DFMin, &DFmax );
 
180
 
 
181
    MathUtilities::getAlphaNorm( src, m_length, m_alphaNormParam, &DFAlphaNorm );
 
182
 
 
183
    for(int i = 0; i< m_length; i++)
 
184
    {
 
185
        dst[ i ] = ( src[ i ] - DFMin ) / DFAlphaNorm; 
 
186
    }
 
187
}