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

Transition of pmsm and libKF

Location:
pmsm/old
Files:
1 added
1 moved

Legend:

Unmodified
Added
Removed
  • pmsm/old/mpf_u_delta.cpp

    r278 r279  
    3030public: 
    3131        //! 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() {}; 
    3333        void set_ref(const chmat &Qref0){Qref=Qref0;} 
    3434        void condition ( const vec &val ) { 
     
    9898        mat Q2o=diag(Qdiag); 
    9999        chmat R ( Rdiag ); 
    100         EKFCh KFE ( rx,ry,ru ); 
     100        EKFCh KFE ; 
    101101        KFE.set_parameters ( &fxu0,&hxu,Q,R ); 
    102102        KFE.set_est ( mu0, chmat ( ones ( 4 ) ) ); 
    103103 
    104104        RV rUd ( "{ud k}", "2 1" ); 
    105         EKFCh_du_kQ KFEp ( rx,ry,ru,rUd ); 
     105        EKFCh_du_kQ KFEp ; 
    106106        KFEp.set_parameters ( &fxu,&hxu,Q,R ); 
    107107        KFEp.set_ref(Q); 
    108108        KFEp.set_est ( mu0, chmat ( ones ( 4 ) ) ); 
    109109 
    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 ); 
    112112        // initialize 
    113113        vec Ud0="0 0 1.0"; 
    114114        evolUd.set_parameters ( eye ( 3 ), zeros(3), ldmat ( vec( "1e-4 1e-4 10e-4" ))); 
    115115        evolUd.condition ( Ud0 ); 
    116         epdf& pfinit=evolUd.posterior(); 
     116        epdf& pfinit=evolUd._epdf(); 
    117117        M.set_est ( pfinit ); 
    118118        evolUd.set_parameters ( eye ( 3 ), zeros(3), ldmat ( vec(" 7e-4 7e-4 1e-5" )));