00001 00013 #ifndef EKF_TEMP_H 00014 #define EKF_TEMP_H 00015 00016 #include "libKF.h" 00017 00018 namespace bdm{ 00019 00021 class EKFful_unQR : public EKFfull { 00022 public: 00023 void condition ( const vec &QR0 ) { 00024 Q=diag(QR0(0,dimx-1)); 00025 R=diag(QR0(dimx,dimx+dimy-1)); 00026 }; 00027 }; 00028 00030 class EKFCh_unQ : public EKFCh { 00031 public: 00032 void condition ( const vec &Q0 ) { 00033 Q.setD ( Q0,0 ); 00034 //from EKF 00035 preA.set_submatrix ( dimy+dimx,dimy,Q._Ch() ); 00036 }; 00037 }; 00038 00040 class EKFCh_cond : public EKFCh { 00041 public: 00042 void condition ( const vec &val ) { 00043 pfxu->condition ( val ); 00044 }; 00045 }; 00046 00047 } 00048 #endif //EKF_TEMP_H