px4-firmware/apps/position_estimator_mc/kalman_dlqe1.m

3 lines
137 B
Matlab
Executable File

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