calculate.m

来自「可以用于无源定位跟踪的好程序－－粒子滤波和其他滤波的很多方法」· M 代码 · 共 5 行

%calculate H
function H=calculate(X1,X2)
X=X1-X2;
r=X(1)^2+X(2)^2;
H=[X(2)/r X(1)/r 0 0;-X(4)/r-(2*X(1)*X(2)*X(3)-2*X(1)^2*X(4))/(r^2) X(3)/r+(2*X(2)^2*X(3)-2*X(1)*X(2)*X(4))/(r^2) X(2)/r -X(1)/r];