Changeset 270 for bdm/estim/libKF.cpp
- Timestamp:
- 02/16/09 10:02:08 (15 years ago)
- Files:
-
- 1 modified
Legend:
- Unmodified
- Added
- Removed
-
bdm/estim/libKF.cpp
r262 r270 62 62 63 63 /////////////////////////////// EKFS 64 EKFfull::EKFfull ( RV rvx0, RV rvy0, RV rvu0 ) : BM ( rvx0 ),E(rvx0) {};64 EKFfull::EKFfull ( ) : BM (),E() {}; 65 65 66 66 void EKFfull::set_parameters ( diffbifn* pfxu0, diffbifn* phxu0,const mat Q0,const mat R0 ) { … … 68 68 phxu = phxu0; 69 69 70 dimx = rv.count();70 dimx = pfxu0->_dimx(); 71 71 dimy = phxu0->_dimy(); 72 72 dimu = pfxu0->_dimu(); … … 163 163 164 164 165 EKFCh::EKFCh ( RV rvx0, RV rvy0, RV rvu0 ) : KalmanCh ( rvx0,rvy0,rvu0) {}165 EKFCh::EKFCh ( ) : KalmanCh ( ) {} 166 166 167 167 void EKFCh::set_parameters ( diffbifn* pfxu0, diffbifn* phxu0,const chmat Q0,const chmat R0 ) { … … 241 241 242 242 void KFcondQR::condition ( const vec &QR ) { 243 it_assert_debug ( QR.length() == ( rvc.count()),"KFcondRQ: conditioning by incompatible vector" );243 it_assert_debug ( QR.length() == ( dimx+dimy ),"KFcondRQ: conditioning by incompatible vector" ); 244 244 245 245 Q.setD ( QR ( 0, dimx-1 ) ); … … 248 248 249 249 void KFcondR::condition ( const vec &R0 ) { 250 it_assert_debug ( R0.length() == ( rvc.count()),"KFcondR: conditioning by incompatible vector" );250 it_assert_debug ( R0.length() == ( dimy ),"KFcondR: conditioning by incompatible vector" ); 251 251 252 252 R.setD ( R0 );