Changeset 279 for pmsm/mpf_load.cpp

Show
Ignore:
Timestamp:
02/24/09 14:12:19 (15 years ago)
Author:
smidl
Message:

Transition of pmsm and libKF

Files:
1 modified

Legend:

Unmodified
Added
Removed
  • pmsm/mpf_load.cpp

    r278 r279  
    6262        mat Q =diag( Qdiag ); 
    6363        mat R =diag ( Rdiag ); 
    64         EKFfull Efix ( rx,ry,ru ); 
     64        EKFfull Efix; 
    6565        Efix.set_est ( mu0, 1*eye ( 4 )  ); 
    6666        Efix.set_parameters ( &fxu0,&hxu,diag(Qdiag0),R); 
    6767 
    68         RV rMz=RV("{Mz }"); 
    69         mlnorm<ldmat> evolMz(rMz,rMz); 
     68        mlnorm<ldmat> evolMz; 
    7069        evolMz.set_parameters(mat("1"),vec("0"),ldmat(1.0*vec("1"))); 
    7170        evolMz.condition(" 0.0"); 
    7271         
    73         EKFCh_cond Ep ( rx,ry,ru,rMz ); 
     72        EKFCh_cond Ep; 
    7473        Ep.set_est ( mu0, 1*eye ( 4 ) ); 
    7574        Ep.set_parameters ( &fxu,&hxu,Q,R); 
    7675         
    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()); 
    7978 
    8079        //LOG 
    8180        int X_log = L.add(rx,"X"); 
    8281        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"); 
    8483        L.init(); 
    8584