- Timestamp:
- 01/15/09 10:54:16 (16 years ago)
- Files:
-
- 1 modified
Legend:
- Unmodified
- Added
- Removed
-
pmsm/mpf_u_delta_real.cpp
r227 r234 17 17 #include <estim/libKF.h> 18 18 #include <estim/libPF.h> 19 #include <estim/ekf_templ.h> 19 20 #include <stat/libFN.h> 20 21 … … 24 25 25 26 using namespace itpp; 26 27 //!Extended Kalman filter with unknown \c Q28 class EKFCh_cond : public EKFCh , public BMcond {29 public:30 //! Default constructor31 EKFCh_cond ( RV rx, RV ry,RV ru,RV rC ) :EKFCh ( rx,ry,ru ),BMcond ( rC ) {};32 void condition ( const vec &val ) {33 pfxu->condition ( val );34 };35 };36 27 37 28 class IMpmsm_delta : public IMpmsm { … … 109 100 epdf& pfinit=evolUd._epdf(); 110 101 M.set_est ( pfinit ); 111 evolUd.set_parameters ( eye ( 2 ), vec_2 ( 0.0,0.0 ), ldmat ( 0.00 1*eye ( 2 ) ) );102 evolUd.set_parameters ( eye ( 2 ), vec_2 ( 0.0,0.0 ), ldmat ( 0.007*eye ( 2 ) ) ); 112 103 113 104 mat Xt=zeros ( Ndat ,4 ); //true state from simulator