Replace float with Type in kalman.

This commit is contained in:
James Goppert
2016-07-06 01:39:06 -04:00
parent 9353e4cb64
commit cbb7e06a1f
+1 -1
View File
@@ -12,7 +12,7 @@ int kalman_correct(
const Matrix<Type, N, 1> &r,
Matrix<Type, M, 1> & dx,
Matrix<Type, M, M> & dP,
float & beta
Type & beta
)
{
SquareMatrix<Type, N> S_I = SquareMatrix<Type, N>(C*P*C.T() + R).I();