Changeset 279 for pmsm/old/mpf_u_delta.cpp
- Timestamp:
- 02/24/09 14:12:19 (15 years ago)
- Location:
- pmsm/old
- Files:
-
- 1 added
- 1 moved
Legend:
- Unmodified
- Added
- Removed
-
pmsm/old/mpf_u_delta.cpp
r278 r279 30 30 public: 31 31 //! Default constructor 32 EKFCh_du_kQ ( RV rx, RV ry,RV ru,RV rC ) :EKFCh ( rx,ry,ru ),BMcond ( rC ),Qref(rx.count()) {};32 EKFCh_du_kQ ( ) :EKFCh ( ),BMcond (),Qref() {}; 33 33 void set_ref(const chmat &Qref0){Qref=Qref0;} 34 34 void condition ( const vec &val ) { … … 98 98 mat Q2o=diag(Qdiag); 99 99 chmat R ( Rdiag ); 100 EKFCh KFE ( rx,ry,ru );100 EKFCh KFE ; 101 101 KFE.set_parameters ( &fxu0,&hxu,Q,R ); 102 102 KFE.set_est ( mu0, chmat ( ones ( 4 ) ) ); 103 103 104 104 RV rUd ( "{ud k}", "2 1" ); 105 EKFCh_du_kQ KFEp ( rx,ry,ru,rUd );105 EKFCh_du_kQ KFEp ; 106 106 KFEp.set_parameters ( &fxu,&hxu,Q,R ); 107 107 KFEp.set_ref(Q); 108 108 KFEp.set_est ( mu0, chmat ( ones ( 4 ) ) ); 109 109 110 mlnorm<ldmat> evolUd ( rUd,rUd );111 MPF<EKFCh_du_kQ> M ( rx,rUd,evolUd,evolUd,Npart,KFEp );110 mlnorm<ldmat> evolUd ; 111 MPF<EKFCh_du_kQ> M ( &evolUd,&evolUd,Npart,KFEp ); 112 112 // initialize 113 113 vec Ud0="0 0 1.0"; 114 114 evolUd.set_parameters ( eye ( 3 ), zeros(3), ldmat ( vec( "1e-4 1e-4 10e-4" ))); 115 115 evolUd.condition ( Ud0 ); 116 epdf& pfinit=evolUd. posterior();116 epdf& pfinit=evolUd._epdf(); 117 117 M.set_est ( pfinit ); 118 118 evolUd.set_parameters ( eye ( 3 ), zeros(3), ldmat ( vec(" 7e-4 7e-4 1e-5" )));