00001 #ifndef INCLUDE_FILTER_H
00002 #define INCLUDE_FILTER_H
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038 #include "LorisExceptions.h"
00039 #include "Notifier.h"
00040
00041 #include <algorithm>
00042 #include <deque>
00043 #include <vector>
00044
00045
00046 namespace Loris {
00047
00048
00049
00050
00074
00075 class Filter
00076 {
00077 public:
00078
00079
00080
00081
00083 Filter( void );
00084
00085
00100
00101 #if !defined(NO_TEMPLATE_MEMBERS)
00102 template<typename IterT1, typename IterT2>
00103 Filter( IterT1 ffwdbegin, IterT1 ffwdend,
00104 IterT2 fbackbegin, IterT2 fbackend,
00105 double gain = 1. );
00106 #else
00107 Filter( const double * ffwdbegin, const double * ffwdend,
00108 const double * fbackbegin, const double * fbackend,
00109 double gain = 1. );
00110 #endif
00111
00112
00113
00116 Filter( const Filter & other );
00117
00118
00121 Filter & operator=( const Filter & rhs );
00122
00126 ~Filter( void );
00127
00128
00129
00130
00135 double apply( double input );
00136
00140 double operator() ( double input ) { return apply(input); }
00141
00142
00143
00147
00148 std::vector< double > numerator( void );
00149
00153
00154 const std::vector< double > numerator( void ) const;
00155
00159
00160 std::vector< double > denominator( void );
00161
00165
00166 const std::vector< double > denominator( void ) const;
00167
00168
00170 void clear( void );
00171
00172
00173 private:
00174
00175
00176
00178 std::deque< double > m_delayline;
00179
00181 std::vector< double > m_ffwdcoefs;
00182
00184 std::vector< double > m_fbackcoefs;
00185
00187 double m_gain;
00188
00189 };
00190
00191
00192
00193
00194
00195
00210
00211 #if !defined(NO_TEMPLATE_MEMBERS)
00212 template<typename IterT1, typename IterT2>
00213 Filter::Filter( IterT1 ffwdbegin, IterT1 ffwdend,
00214 IterT2 fbackbegin, IterT2 fbackend,
00215 double gain ) :
00216 #else
00217 inline
00218 Filter::Filter( const double * ffwdbegin, const double * ffwdend,
00219 const double * fbackbegin, const double * fbackend,
00220 double gain ) :
00221 #endif
00222 m_ffwdcoefs( ffwdbegin, ffwdend ),
00223 m_fbackcoefs( fbackbegin, fbackend ),
00224 m_delayline( std::max( ffwdend-ffwdbegin, fbackend-fbackbegin ) - 1, 0. ),
00225 m_gain( gain )
00226 {
00227 if ( *fbackbegin == 0. )
00228 {
00229 Throw( InvalidObject,
00230 "Tried to create a Filter with feeback coefficient at zero delay equal to 0.0" );
00231 }
00232
00233
00234
00235 if ( *fbackbegin != 1. )
00236 {
00237
00238 std::transform( m_ffwdcoefs.begin(), m_ffwdcoefs.end(), m_ffwdcoefs.begin(),
00239 std::bind2nd( std::divides<double>(), *fbackbegin ) );
00240 std::transform( m_fbackcoefs.begin(), m_fbackcoefs.end(), m_fbackcoefs.begin(),
00241 std::bind2nd( std::divides<double>(), *fbackbegin ) );
00242 m_fbackcoefs[0] = 1.;
00243 }
00244 }
00245
00246
00247 }
00248
00249 #endif