Fixed kalman correct test.

This commit is contained in:
jgoppert
2015-11-09 19:58:00 -05:00
parent e972a0a111
commit 2c7a375e3d
+2 -1
View File
@@ -19,8 +19,9 @@ int main()
Vector<float, n_y> r(data);
Vector<float, n_x> dx;
SquareMatrix<float, n_x> dP;
float beta = 0;
kalman_correct<float, 6, 5>(P, C, R, r, dx, beta);
kalman_correct<float, 6, 5>(P, C, R, r, dx, dP, beta);
dx.T().print();
printf("beta: %g\n", beta);