Changeset 279 for pmsm/old/pmsm_sim2.cpp

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/pmsm_sim2.cpp

    r271 r279  
    2727public: 
    2828        //! Default constructor 
    29         EKF_unQ ( RV rx, RV ry,RV ru,RV rQ ) :EKFCh ( rx,ry,ru ),BMcond ( rQ ) {}; 
    3029        void condition ( const vec &Q0 ) { 
    3130                Q.setD ( Q0,0 ); 
     
    4847class EKF_unQful : public EKFfull , public BMcond { 
    4948public: 
    50         //! Default constructor 
    51         EKF_unQful ( RV rx, RV ry,RV ru,RV rQ ) :EKFfull ( rx,ry,ru ),BMcond ( rQ ) {}; 
    5249        void condition ( const vec &Q0 ) { 
    5350                Q=diag(Q0); 
     
    8986        chmat Q ( Qdiag ); 
    9087        chmat R ( Rdiag ); 
    91         EKFCh KFE ( rx,ry,ru ); 
     88        EKFCh KFE ; 
    9289        KFE.set_est ( mu0, chmat( 1*eye ( 4 ) ) ); 
    9390        KFE.set_parameters ( &fxu,&hxu,Q,R); 
    9491 
    9592        RV rQ ( "{Q}","4" ); 
    96         EKF_unQful KFEp ( rx,ry,ru,rQ ); 
     93        EKF_unQful KFEp ; 
    9794        KFEp.set_est ( mu0,  1*ones ( 4 ) ); 
    9895        KFEp.set_parameters ( &fxu,&hxu,diag(Qdiag),diag(Rdiag) ); 
    9996 
    100         mgamma_fix evolQ ( rQ,rQ ); 
    101         MPF<EKF_unQful> M ( rx,rQ,evolQ,evolQ,Npart,KFEp ); 
     97        mgamma_fix evolQ ; 
     98        MPF<EKF_unQful> M ( &evolQ,&evolQ,Npart,KFEp ); 
    10299        // initialize 
    103100        evolQ.set_parameters ( 1000.0 ,Qdiag, 0.5); //sigma = 1/10 mu 
    104101        evolQ.condition ( Qdiag ); //Zdenek default 
    105         epdf& pfinit=evolQ.posterior(); 
     102        epdf& pfinit=evolQ._epdf(); 
    106103        M.set_est ( pfinit ); 
    107104        evolQ.set_parameters ( 100000.0, Qdiag, 0.9999 );