Changeset 279 for pmsm/old

Timestamp:

02/24/09 14:12:19 (16 years ago)

Author:

smidl

Message:

Transition of pmsm and libKF

Location:

pmsm/old

Files:

• . (added)
• mpf_u_delta.cpp (moved) (moved from pmsm/mpf_u_delta.cpp) (2 diffs)
• mpf_u_delta_real.cpp (moved) (moved from pmsm/mpf_u_delta_real.cpp) (1 diff)
• mpf_u_weight.cpp (moved) (moved from pmsm/mpf_u_weight.cpp) (2 diffs)
• pmsm_mix.cpp (moved) (moved from pmsm/pmsm_mix.cpp) (2 diffs)
• pmsm_sim.cpp (moved) (moved from pmsm/pmsm_sim.cpp) (2 diffs)
• pmsm_sim2.cpp (moved) (moved from pmsm/pmsm_sim2.cpp) (3 diffs)
• pmsm_sim3.cpp (moved) (moved from pmsm/pmsm_sim3.cpp)
• pmsm_unkQ.cpp (moved) (moved from pmsm/pmsm_unkQ.cpp) (2 diffs)
• pmsm_unkQpf.cpp (moved) (moved from pmsm/pmsm_unkQpf.cpp) (2 diffs)
• sim.cpp (moved) (moved from pmsm/sim.cpp)
• sim_var.cpp (moved) (moved from pmsm/sim_var.cpp) (1 diff)

pmsm/old/mpf_u_delta.cpp

@@ -30 +30 @@
 public:
         //! Default constructor
-        EKFCh_du_kQ ( RV rx, RV ry,RV ru,RV rC ) :EKFCh ( rx,ry,ru ),BMcond ( rC ),Qref(rx.count()) {};
+        EKFCh_du_kQ ( ) :EKFCh ( ),BMcond (),Qref() {};
         void set_ref(const chmat &Qref0){Qref=Qref0;}
         void condition ( const vec &val ) {
@@ -98 +98 @@
         mat Q2o=diag(Qdiag);
         chmat R ( Rdiag );
-        EKFCh KFE ( rx,ry,ru );
+        EKFCh KFE ;
         KFE.set_parameters ( &fxu0,&hxu,Q,R );
         KFE.set_est ( mu0, chmat ( ones ( 4 ) ) );
 
         RV rUd ( "{ud k}", "2 1" );
-        EKFCh_du_kQ KFEp ( rx,ry,ru,rUd );
+        EKFCh_du_kQ KFEp ;
         KFEp.set_parameters ( &fxu,&hxu,Q,R );
         KFEp.set_ref(Q);
         KFEp.set_est ( mu0, chmat ( ones ( 4 ) ) );
 
-        mlnorm<ldmat> evolUd ( rUd,rUd );
-        MPF<EKFCh_du_kQ> M ( rx,rUd,evolUd,evolUd,Npart,KFEp );
+        mlnorm<ldmat> evolUd ;
+        MPF<EKFCh_du_kQ> M ( &evolUd,&evolUd,Npart,KFEp );
         // initialize
         vec Ud0="0 0 1.0";
         evolUd.set_parameters ( eye ( 3 ), zeros(3), ldmat ( vec( "1e-4 1e-4 10e-4" )));
         evolUd.condition ( Ud0 );
-        epdf& pfinit=evolUd.posterior();
+        epdf& pfinit=evolUd._epdf();
         M.set_est ( pfinit );
         evolUd.set_parameters ( eye ( 3 ), zeros(3), ldmat ( vec(" 7e-4 7e-4 1e-5" )));

pmsm/old/mpf_u_delta_real.cpp

@@ -83 +83 @@
         chmat Q ( Qdiag );
         chmat R ( Rdiag );
-        EKFCh KFE ( rx,ry,ru );
+        EKFCh KFE ;
         KFE.set_parameters ( &fxu0,&hxu,Q,R );
         KFE.set_est ( mu0, chmat ( ones ( 4 ) ) );
 
         RV rUd ( "{ud }", "2" );
-        EKFCh_cond KFEp ( rx,ry,ru,rUd );
+        EKFCh_cond KFEp ;
         KFEp.set_parameters ( &fxu,&hxu,Q,R );
         KFEp.set_est ( mu0, chmat ( ones ( 4 ) ) );
 
-        mlnorm<ldmat> evolUd ( rUd,rUd );
-        MPF<EKFCh_cond> M ( rx,rUd,evolUd,evolUd,Npart,KFEp );
+        mlnorm<ldmat> evolUd ;
+        MPF<EKFCh_cond> M ( &evolUd,&evolUd,Npart,KFEp );
         // initialize
         vec Ud0="0 0";
         evolUd.set_parameters ( eye ( 2 ), vec_2 ( 0.0,0.0 ), ldmat ( 10.0*eye ( 2 ) ) );
         evolUd.condition ( Ud0 );
-        epdf& pfinit=evolUd.posterior();
+        epdf& pfinit=evolUd._epdf();
         M.set_est ( pfinit );
         evolUd.set_parameters ( eye ( 2 ), vec_2 ( 0.0,0.0 ), ldmat ( 0.005*eye ( 2 ) ) );

pmsm/old/mpf_u_weight.cpp

@@ -28 +28 @@
 class EKFCh_cond : public EKFCh , public BMcond {
 public:
-        //! Default constructor
-        EKFCh_cond ( RV rx, RV ry,RV ru,RV rC ) :EKFCh ( rx,ry,ru ),BMcond ( rC ) {};
+        //! condition on value of pfxu
         void condition ( const vec &val ) {
                 pfxu->condition ( val );
@@ -92 +91 @@
         chmat Q ( Qdiag );
         chmat R ( Rdiag );
-        EKFCh KFE ( rx,ry,ru );
+        EKFCh KFE;
         KFE.set_parameters ( &fxu0,&hxu,Q,R );
         KFE.set_est ( mu0, chmat ( ones ( 4 ) ) );
 
         RV rW ( "{w }" );
-        EKFCh_cond KFEp ( rx,ry,ru,rW );
+        EKFCh_cond KFEp;
         KFEp.set_parameters ( &fxu,&hxu,Q,R );
         KFEp.set_est ( mu0, chmat ( ones ( 4 ) ) );
 
-        mgamma_fix evolW ( rW,rW );
-        MPF<EKFCh_cond> M ( rx,rW,evolW,evolW,Npart,KFEp );
+        mgamma_fix evolW ;
+        MPF<EKFCh_cond> M (&evolW,&evolW,Npart,KFEp );
         // initialize
         vec W0="0.5";
         evolW.set_parameters ( 10.0, W0, 1.0 ); //sigma = 1/10 mu
         evolW.condition ( W0 );
-        epdf& pfinit=evolW.posterior();
+        epdf& pfinit=evolW._epdf();
         M.set_est ( pfinit );
         evolW.set_parameters ( 100.0, W0, 0.99 ); //sigma = 1/10 mu

pmsm/old/pmsm_mix.cpp

@@ -57 +57 @@
         mat Q =diag( Qdiag );
         mat R =diag ( Rdiag );
-        EKFfull Efix ( rx,ry,ru );
+        EKFfull Efix ;
         Efix.set_est ( mu0, 1*eye ( 4 )  );
         Efix.set_parameters ( &fxu,&hxu,Q,R);
 
         RV rQR( "{Q R }", "4 2 ");
-        EKFful_unQR EKU (rx,ry,ru,rQR);
+        EKFful_unQR EKU;
         EKU.set_est ( mu0,  1*ones ( 4 ) );
         EKU.set_parameters ( &fxu,&hxu,diag(Qdiag),diag(Rdiag) );
 
         //QU model
-        egamma Gcom(rQR);Gcom.set_parameters(ones(6),vec("1 1 1e4 1e10 1 1"));
+        egamma Gcom;Gcom.set_parameters(ones(6),vec("1 1 1e4 1e10 1 1"));
 /*      cout << Gcom.mean() <<endl;
         cout << Gcom.sample() <<endl;*/
-        euni Ucom(rQR); Ucom.set_parameters(zeros(6),vec("60 60 453 0.03 100 100"));
+        euni Ucom; Ucom.set_parameters(zeros(6),vec("60 60 453 0.03 100 100"));
 /*      cout << Ucom.mean() <<endl;
         cout << Ucom.sample() <<endl;*/
@@ -76 +76 @@
         Coms(0) = &Gcom;
         Coms(1) = &Ucom;
-        emix Eevol(rQR);        Eevol.set_parameters("0.1 0.9", Coms);
+        emix Eevol;     Eevol.set_parameters("0.1 0.9", Coms);
 //      cout << Eevol.sample() <<endl;
 
         mepdf evolQR(&Eevol);
-        MPF<EKFful_unQR> M ( rx,rQR, evolQR, evolQR, Npar, EKU );
-        M.set_est ( evolQR.posterior() );
+        MPF<EKFful_unQR> M (  &evolQR, &evolQR, Npar, EKU );
+        M.set_est ( evolQR._epdf() );
 
         const epdf& Efix_ep = Efix.posterior();

pmsm/old/pmsm_sim.cpp

@@ -25 +25 @@
 public:
         //! Default constructor
-        EKF_unQ ( RV rx, RV ry,RV ru,RV rQ ) :EKFCh ( rx,ry,ru ),BMcond ( rQ ) {};
         void condition ( const vec &Q0 ) {
                 Q.setD ( Q0,0 );
@@ -53 +52 @@
         chmat Q ( Qdiag );
         chmat R ( Rdiag );
-        EKFCh KFE ( rx,ry,ru );
+        EKFCh KFE ;
         KFE.set_parameters ( &fxu,&hxu,Q,R );
         KFE.set_est ( mu0, chmat ( 1*ones ( 4 ) ) );
 
         RV rQ ( "{Q }","2" );
-        EKF_unQ KFEp ( rx,ry,ru,rQ );
+        EKF_unQ KFEp;
         KFEp.set_parameters ( &fxu,&hxu,Q,R );
         KFEp.set_est ( mu0, chmat ( zeros ( 4 ) ) );
 
-        mgamma evolQ ( rQ,rQ );
-        MPF<EKF_unQ> M ( rx,rQ,evolQ,evolQ,Npart,KFEp );
+        mgamma evolQ ;
+        MPF<EKF_unQ> M (&evolQ,&evolQ,Npart,KFEp );
         // initialize
-        evolQ.set_parameters ( 10.0 ); //sigma = 1/10 mu
+        evolQ.set_parameters ( 10.0, "0.01 0.01" ); //sigma = 1/10 mu
         evolQ.condition ( "0.01 0.01" ); //Zdenek default
-        epdf& pfinit=evolQ.posterior();
+        epdf& pfinit=evolQ._epdf();
         M.set_est ( pfinit );
-        evolQ.set_parameters ( 10.0 );
+        evolQ.set_parameters ( 10.0,  "0.01 0.01");
 
         //

pmsm/old/pmsm_sim2.cpp

@@ -27 +27 @@
 public:
         //! Default constructor
-        EKF_unQ ( RV rx, RV ry,RV ru,RV rQ ) :EKFCh ( rx,ry,ru ),BMcond ( rQ ) {};
         void condition ( const vec &Q0 ) {
                 Q.setD ( Q0,0 );
@@ -48 +47 @@
 class EKF_unQful : public EKFfull , public BMcond {
 public:
-        //! Default constructor
-        EKF_unQful ( RV rx, RV ry,RV ru,RV rQ ) :EKFfull ( rx,ry,ru ),BMcond ( rQ ) {};
         void condition ( const vec &Q0 ) {
                 Q=diag(Q0);
@@ -89 +86 @@
         chmat Q ( Qdiag );
         chmat R ( Rdiag );
-        EKFCh KFE ( rx,ry,ru );
+        EKFCh KFE ;
         KFE.set_est ( mu0, chmat( 1*eye ( 4 ) ) );
         KFE.set_parameters ( &fxu,&hxu,Q,R);
 
         RV rQ ( "{Q}","4" );
-        EKF_unQful KFEp ( rx,ry,ru,rQ );
+        EKF_unQful KFEp ;
         KFEp.set_est ( mu0,  1*ones ( 4 ) );
         KFEp.set_parameters ( &fxu,&hxu,diag(Qdiag),diag(Rdiag) );
 
-        mgamma_fix evolQ ( rQ,rQ );
-        MPF<EKF_unQful> M ( rx,rQ,evolQ,evolQ,Npart,KFEp );
+        mgamma_fix evolQ ;
+        MPF<EKF_unQful> M ( &evolQ,&evolQ,Npart,KFEp );
         // initialize
         evolQ.set_parameters ( 1000.0 ,Qdiag, 0.5); //sigma = 1/10 mu
         evolQ.condition ( Qdiag ); //Zdenek default
-        epdf& pfinit=evolQ.posterior();
+        epdf& pfinit=evolQ._epdf();
         M.set_est ( pfinit );
         evolQ.set_parameters ( 100000.0, Qdiag, 0.9999 );

pmsm/old/pmsm_unkQ.cpp

@@ -46 +46 @@
         chmat Q ( Qdiag );
         chmat R ( Rdiag );
-        EKFCh KFE ( rx,ry,ru );
+        EKFCh KFE ;
         KFE.set_est ( mu0, chmat ( 1000*ones ( 4 ) ) );
         KFE.set_parameters ( &fxu,&hxu,Q,R );
@@ -57 +57 @@
                 vec Qid ( Qdiag );
                 Qid ( 0 ) = vQ ( i ); Qid ( 1 ) = vQ ( i );
-                kfArray[i]= new EKFCh ( rx,ry,ru );
+                kfArray[i]= new EKFCh;
                 kfArray[i]->set_est ( mu0, chmat ( 1000*ones ( 4 ) ) );
                 kfArray[i]->set_parameters ( &fxu,&hxu,chmat ( Qid ),R );

pmsm/old/pmsm_unkQpf.cpp

@@ -24 +24 @@
 public:
         //! Default constructor
-        EKF_unQ ( RV rx, RV ry,RV ru,RV rQ ) :EKFCh ( rx,ry,ru ),BMcond ( rQ ) {};
         void condition ( const vec &Q0 ) {
                 Q.setD ( Q0,0 );
@@ -53 +52 @@
 
         RV rQ ( "{Q}","2" );
-        EKF_unQ KFE ( rx,ry,ru,rQ );
+        EKF_unQ KFE ;
         KFE.set_parameters ( &fxu,&hxu,Q,R );
         KFE.set_est ( mu0, chmat ( 1000*ones ( 4 ) ) );
 
-        mgamma evolQ ( rQ,rQ );
+        mgamma evolQ ;
         //evolQ.set_parameters ( 10000.0 ); //sigma = 1/10 mu
 
-        MPF<EKF_unQ> M ( rx,rQ,evolQ,evolQ,100,KFE );
+        MPF<EKF_unQ> M ( &evolQ,&evolQ,100,KFE );
 
         const epdf& KFEep = KFE.posterior();
         const epdf& Mep = M.posterior();
         // initialize
-        evolQ.set_parameters ( 1.0 ); //sigma = 1/10 mu
+        evolQ.set_parameters ( 1.0, "0.5 0.5" ); //sigma = 1/10 mu
         evolQ.condition ( "0.5 0.5" );
-        const epdf& pfinit=evolQ.posterior();
+        const epdf& pfinit=evolQ._epdf();
         M.set_est ( pfinit );
-        evolQ.set_parameters ( 1000.0 ); //sigma = 1/10 mu
+        evolQ.set_parameters ( 1000.0 , "0.5 0.5"); //sigma = 1/10 mu
 
         //simulator values

pmsm/old/sim_var.cpp

@@ -63 +63 @@
         mat Q =diag( Qdiag );
         mat R =diag ( Rdiag );
-        EKFfull Efix ( rx,ry,ru );
+        EKFfull Efix ;
         Efix.set_est ( mu0, 1*eye ( 4 )  );
         Efix.set_parameters ( &fxu,&hxu,Q,R);
 
-        EKFfull Eop ( rx,ry,ru );
+        EKFfull Eop ;
         Eop.set_est ( mu0, 1*eye ( 4 ) );
         Eop.set_parameters ( &fxu,&hxu,Q,R);
 
-        EKFfull Edi ( rx,ry,ru );
+        EKFfull Edi ;
         Edi.set_est ( mu0, 1*eye ( 4 ) );
         Edi.set_parameters ( &fxu,&hxu,Q,R);