画球求解.m

多基时差雷达定位算法。以雷达测量误差分布规律入手

%主程序
global zu1 ok;       %定义全局变量
[O,F,M,E]=fminimax(@(X) leida(X),[-25193 6129 24100])   %应用画球法求解目标位置
plot3(zu1(:,1),zu1(:,2),zu1(:,3),'*')       
hold on
plot3(ok(:,1),ok(:,2),ok(:,3),'.k')
x0=[-25273,6325.3,24022];
[X,RESNORM,RESIDUAL,EXITFLAG]=lsqnonlin(@lsq,x0)
plot3(X(1),X(2),X(3),'pr')
box on
hold on
plot3(O(1),O(2),O(3),'or')
hold on
ro=M^(1/2);
[xo,yo,zo]=sphere(25);
mesh(ro*(xo+O(1)/ro),ro*(yo+O(2)/ro),ro*(zo+O(3)/ro))
hidden off
axis equal