Changeset 270 for tests/testKF.cpp
- Timestamp:
- 02/16/09 10:02:08 (15 years ago)
- Files:
-
- 1 modified
Legend:
- Unmodified
- Added
- Removed
-
tests/testKF.cpp
r262 r270 54 54 55 55 //Chol 56 KalmanCh KF (rx,ry,ru);56 KalmanCh KF; 57 57 KF.set_parameters(A,B,C,D,chmat(R),chmat(Q)); 58 58 KF.set_est(mu0,chmat(P0) ); //prediction! … … 63 63 // 64 64 // FSQMAT 65 Kalman<ldmat> KFf (rx,ry,ru);65 Kalman<ldmat> KFf; 66 66 KFf.set_parameters(A,B,C,D,ldmat(R),ldmat(Q)); 67 67 KFf.set_est(mu0,ldmat(P0) ); … … 77 77 78 78 // EKF 79 bilinfn fxu( rx,ru,A,B);80 bilinfn hxu( rx,ru,C,D);81 EKFCh KFE (rx,ry,ru);79 bilinfn fxu(A,B); 80 bilinfn hxu(C,D); 81 EKFCh KFE; 82 82 KFE.set_parameters(&fxu,&hxu,Q,R); 83 83 KFE.set_est(mu0,chmat(P0));