work/git/mixpp/bdm/estim/ekf_templ.h

Go to the documentation of this file.

#ifndef EKF_TEMP_H
#define EKF_TEMP_H

#include "libKF.h"

using namespace itpp;

class EKFful_unQR : public EKFfull , public BMcond {
public:
        EKFful_unQR ( RV rx, RV ry,RV ru,RV rQR ) :EKFfull ( rx,ry,ru ),BMcond ( rQR ) {};
        void condition ( const vec &QR0 ) {
                Q=diag(QR0(0,dimx-1));
                R=diag(QR0(dimx,dimx+dimy-1));
        };
};

class EKFCh_unQ : public EKFCh , public BMcond {
public:
        EKFCh_unQ ( RV rx, RV ry,RV ru,RV rQ ) :EKFCh ( rx,ry,ru ),BMcond ( rQ ) {};
        void condition ( const vec &Q0 ) {
                Q.setD ( Q0,0 );
                //from EKF
                preA.set_submatrix ( dimy+dimx,dimy,Q._Ch() );
        };
};

class EKFCh_cond : public EKFCh , public BMcond {
        public:
                EKFCh_cond ( RV rx, RV ry,RV ru,RV rC ) :EKFCh ( rx,ry,ru ),BMcond ( rC ) {};
                void condition ( const vec &val ) {
                        pfxu->condition ( val );
                };
};

#endif //EKF_TEMP_H

---