Changeset 279 for pmsm/old/pmsm_sim2.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/pmsm_sim2.cpp
r271 r279 27 27 public: 28 28 //! Default constructor 29 EKF_unQ ( RV rx, RV ry,RV ru,RV rQ ) :EKFCh ( rx,ry,ru ),BMcond ( rQ ) {};30 29 void condition ( const vec &Q0 ) { 31 30 Q.setD ( Q0,0 ); … … 48 47 class EKF_unQful : public EKFfull , public BMcond { 49 48 public: 50 //! Default constructor51 EKF_unQful ( RV rx, RV ry,RV ru,RV rQ ) :EKFfull ( rx,ry,ru ),BMcond ( rQ ) {};52 49 void condition ( const vec &Q0 ) { 53 50 Q=diag(Q0); … … 89 86 chmat Q ( Qdiag ); 90 87 chmat R ( Rdiag ); 91 EKFCh KFE ( rx,ry,ru );88 EKFCh KFE ; 92 89 KFE.set_est ( mu0, chmat( 1*eye ( 4 ) ) ); 93 90 KFE.set_parameters ( &fxu,&hxu,Q,R); 94 91 95 92 RV rQ ( "{Q}","4" ); 96 EKF_unQful KFEp ( rx,ry,ru,rQ );93 EKF_unQful KFEp ; 97 94 KFEp.set_est ( mu0, 1*ones ( 4 ) ); 98 95 KFEp.set_parameters ( &fxu,&hxu,diag(Qdiag),diag(Rdiag) ); 99 96 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 ); 102 99 // initialize 103 100 evolQ.set_parameters ( 1000.0 ,Qdiag, 0.5); //sigma = 1/10 mu 104 101 evolQ.condition ( Qdiag ); //Zdenek default 105 epdf& pfinit=evolQ. posterior();102 epdf& pfinit=evolQ._epdf(); 106 103 M.set_est ( pfinit ); 107 104 evolQ.set_parameters ( 100000.0, Qdiag, 0.9999 );