yet another refactoring

[cpPlugins.git] / lib / cpExtensions / Algorithms / KalmanConstantFilter.cxx

diff --git a/lib/cpExtensions/Algorithms/KalmanConstantFilter.cxx b/lib/cpExtensions/Algorithms/KalmanConstantFilter.cxx
new file mode 100644 (file)
index 0000000..0fd5d6c
--- /dev/null
+++ b/lib/cpExtensions/Algorithms/KalmanConstantFilter.cxx
@@ -0,0 +1,49 @@
+// -------------------------------------------------------------------------
+// @author Leonardo Florez-Valencia (florez-l@javeriana.edu.co)
+// -------------------------------------------------------------------------
+
+#include <cpExtensions/Algorithms/KalmanConstantFilter.h>
+
+// -------------------------------------------------------------------------
+template< typename T >
+void cpExtensions::Algorithms::KalmanConstantFilter< T >::
+Configure( unsigned int m )
+{
+  this->Superclass::Configure( m, 1, m );
+}
+
+// -------------------------------------------------------------------------
+template< typename T >
+void cpExtensions::Algorithms::KalmanConstantFilter< T >::
+Initialize( )
+{
+  this->Superclass::Initialize( );
+
+  this->m_A.set_identity( );
+  this->m_B.fill( TScalar( 0 ) );
+  this->m_H.set_identity( );
+}
+
+// -------------------------------------------------------------------------
+template< typename T >
+cpExtensions::Algorithms::KalmanConstantFilter< T >::
+KalmanConstantFilter( )
+  : Superclass( )
+{
+  this->Configure( 1 );
+}
+
+// -------------------------------------------------------------------------
+template< typename T >
+cpExtensions::Algorithms::KalmanConstantFilter< T >::
+~KalmanConstantFilter( )
+{
+}
+
+// -------------------------------------------------------------------------
+// Explicit instantiations
+
+template class cpExtensions::Algorithms::KalmanConstantFilter< float >;
+template class cpExtensions::Algorithms::KalmanConstantFilter< double >;
+
+// eof - $RCSfile$