Changeset 565 for library/bdm/estim/kalman.h
- Timestamp:
- 08/19/09 16:54:24 (15 years ago)
- Files:
-
- 1 modified
Legend:
- Unmodified
- Added
- Removed
-
library/bdm/estim/kalman.h
r536 r565 286 286 public: 287 287 void condition ( const vec &QR ) { 288 it_assert_debug ( QR.length() == ( dimx + dimy ), "KFcondRQ: conditioning by incompatible vector" );288 bdm_assert_debug ( QR.length() == ( dimx + dimy ), "KFcondQR: conditioning by incompatible vector" ); 289 289 290 290 Q.setD ( QR ( 0, dimx - 1 ) ); … … 304 304 305 305 void condition ( const vec &R0 ) { 306 it_assert_debug ( R0.length() == ( dimy ), "KFcondR: conditioning by incompatible vector" );306 bdm_assert_debug ( R0.length() == ( dimy ), "KFcondR: conditioning by incompatible vector" ); 307 307 308 308 R.setD ( R0 ); … … 338 338 dimu = B0.cols(); 339 339 340 it_assert_debug ( A0.cols() == dimx, "Kalman: A is not square" );341 it_assert_debug ( B0.rows() == dimx, "Kalman: B is not compatible" );342 it_assert_debug ( C0.cols() == dimx, "Kalman: C is not square" );343 it_assert_debug ( ( D0.rows() == dimy ) || ( D0.cols() == dimu ), "Kalman: D is not compatible" );344 it_assert_debug ( ( R0.cols() == dimy ) || ( R0.rows() == dimy ), "Kalman: R is not compatible" );345 it_assert_debug ( ( Q0.cols() == dimx ) || ( Q0.rows() == dimx ), "Kalman: Q is not compatible" );340 bdm_assert_debug ( A0.cols() == dimx, "Kalman: A is not square" ); 341 bdm_assert_debug ( B0.rows() == dimx, "Kalman: B is not compatible" ); 342 bdm_assert_debug ( C0.cols() == dimx, "Kalman: C is not square" ); 343 bdm_assert_debug ( ( D0.rows() == dimy ) || ( D0.cols() == dimu ), "Kalman: D is not compatible" ); 344 bdm_assert_debug ( ( R0.cols() == dimy ) || ( R0.rows() == dimy ), "Kalman: R is not compatible" ); 345 bdm_assert_debug ( ( Q0.cols() == dimx ) || ( Q0.rows() == dimx ), "Kalman: Q is not compatible" ); 346 346 347 347 A = A0; … … 355 355 template<class sq_T> 356 356 void Kalman<sq_T>::bayes ( const vec &dt ) { 357 it_assert_debug ( dt.length() == ( dimy + dimu ), "KalmanFull::bayes wrong size of dt" );357 bdm_assert_debug ( dt.length() == ( dimy + dimu ), "Kalman::bayes wrong size of dt" ); 358 358 359 359 sq_T iRy ( dimy ); … … 439 439 break; 440 440 default: 441 it_error ( "unknown policy" );441 bdm_error ( "unknown policy" ); 442 442 } 443 443 // copy result to all models … … 486 486 template<class sq_T> 487 487 void EKF<sq_T>::bayes ( const vec &dt ) { 488 it_assert_debug ( dt.length() == ( dimy + dimu ), "KalmanFull::bayes wrong size of dt" );488 bdm_assert_debug ( dt.length() == ( dimy + dimu ), "EKF<>::bayes wrong size of dt" ); 489 489 490 490 sq_T iRy ( dimy, dimy );