diff options
Diffstat (limited to 'src/modules/position_estimator_mc/kalman_dlqe1.m')
| -rwxr-xr-x | src/modules/position_estimator_mc/kalman_dlqe1.m | 3 |
1 files changed, 3 insertions, 0 deletions
diff --git a/src/modules/position_estimator_mc/kalman_dlqe1.m b/src/modules/position_estimator_mc/kalman_dlqe1.m new file mode 100755 index 000000000..ff939d029 --- /dev/null +++ b/src/modules/position_estimator_mc/kalman_dlqe1.m @@ -0,0 +1,3 @@ +function [x_aposteriori] = kalman_dlqe1(A,C,K,x_aposteriori_k,z) + x_aposteriori=A*x_aposteriori_k+K*(z-C*A*x_aposteriori_k); +end
\ No newline at end of file |