Changeset 279 for pmsm/mpf_load.cpp
- Timestamp:
- 02/24/09 14:12:19 (15 years ago)
- Files:
-
- 1 modified
Legend:
- Unmodified
- Added
- Removed
-
pmsm/mpf_load.cpp
r278 r279 62 62 mat Q =diag( Qdiag ); 63 63 mat R =diag ( Rdiag ); 64 EKFfull Efix ( rx,ry,ru );64 EKFfull Efix; 65 65 Efix.set_est ( mu0, 1*eye ( 4 ) ); 66 66 Efix.set_parameters ( &fxu0,&hxu,diag(Qdiag0),R); 67 67 68 RV rMz=RV("{Mz }"); 69 mlnorm<ldmat> evolMz(rMz,rMz); 68 mlnorm<ldmat> evolMz; 70 69 evolMz.set_parameters(mat("1"),vec("0"),ldmat(1.0*vec("1"))); 71 70 evolMz.condition(" 0.0"); 72 71 73 EKFCh_cond Ep ( rx,ry,ru,rMz );72 EKFCh_cond Ep; 74 73 Ep.set_est ( mu0, 1*eye ( 4 ) ); 75 74 Ep.set_parameters ( &fxu,&hxu,Q,R); 76 75 77 MPF<EKFCh_cond> M ( rx,rMz,evolMz,evolMz, Npart, Ep );78 M.set_est(evolMz. posterior());76 MPF<EKFCh_cond> M ( &evolMz, &evolMz, Npart, Ep ); 77 M.set_est(evolMz._epdf()); 79 78 80 79 //LOG 81 80 int X_log = L.add(rx,"X"); 82 81 int E_log = L.add(rx,"EX"); 83 int M_log = L.add(concat( rMz,rx),"MX");82 int M_log = L.add(concat(RV("Mz",1),rx),"MX"); 84 83 L.init(); 85 84