Changeset 279 for pmsm/old/mpf_u_delta_real.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_real.cpp
r278 r279 83 83 chmat Q ( Qdiag ); 84 84 chmat R ( Rdiag ); 85 EKFCh KFE ( rx,ry,ru );85 EKFCh KFE ; 86 86 KFE.set_parameters ( &fxu0,&hxu,Q,R ); 87 87 KFE.set_est ( mu0, chmat ( ones ( 4 ) ) ); 88 88 89 89 RV rUd ( "{ud }", "2" ); 90 EKFCh_cond KFEp ( rx,ry,ru,rUd );90 EKFCh_cond KFEp ; 91 91 KFEp.set_parameters ( &fxu,&hxu,Q,R ); 92 92 KFEp.set_est ( mu0, chmat ( ones ( 4 ) ) ); 93 93 94 mlnorm<ldmat> evolUd ( rUd,rUd );95 MPF<EKFCh_cond> M ( rx,rUd,evolUd,evolUd,Npart,KFEp );94 mlnorm<ldmat> evolUd ; 95 MPF<EKFCh_cond> M ( &evolUd,&evolUd,Npart,KFEp ); 96 96 // initialize 97 97 vec Ud0="0 0"; 98 98 evolUd.set_parameters ( eye ( 2 ), vec_2 ( 0.0,0.0 ), ldmat ( 10.0*eye ( 2 ) ) ); 99 99 evolUd.condition ( Ud0 ); 100 epdf& pfinit=evolUd. posterior();100 epdf& pfinit=evolUd._epdf(); 101 101 M.set_est ( pfinit ); 102 102 evolUd.set_parameters ( eye ( 2 ), vec_2 ( 0.0,0.0 ), ldmat ( 0.005*eye ( 2 ) ) );