mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-14 06:00:35 +08:00
Fixed kalman correct test.
This commit is contained in:
+2
-1
@@ -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);
|
||||
|
||||
Reference in New Issue
Block a user