测向交叉定位

;sita1_ce=mvnrnd(sita1_true,sigma1,N);sita2_ce=mvnrnd(sita2_true,sigma2,N);[xt1,yt1]=ksdensity(sita1_ce);[xt2,yt2]=ksdensity(sita2_ce);plot(rad2deg(yt1),xt1,'r',rad2deg(yt2),xt2,'g');title('两个角度测量的随机值分布函数');xlabel('角度');legend('sita1','sita2');%模拟定位过程form=1:Nx3_ce(m)=(x1*tan(sita1_ce(m))-x2*tan(sita2_ce(m)))/(tan(sita1_ce(m))-tan(sita2_ce(m)));%目标测量的横坐标y3_ce(m)=(x3_ce(m)-x1).*tan(sita1_ce(m));%目标测量的纵坐标dsigma_dx(m)=(x3_ce(m)-x30).^2;dsigma_dy(m)=(y3_ce(m)-y30).^2;endyy=[y1y2y30];xx=[x1x2x30];figure(2);plot(xx,yy,'b+');holdon;plot(x3_ce,y3_ce,'g.');axis([-10810-10720]);dsigma_dx=dsigma_dx/N;dsigma_dy=dsigma_dy/N;CEP=0.75*sqrt(dsigma_dx+dsigma_dy);[CEPMin,k]=min(CEP);%找出CEP最小时所对的是第几个的测量值CEPMin%园概率误差sita1_zuijia=radtodeg(sita1_ce(k))%观测站1与目标站之间的夹角sita2_zuijia=rad2deg(sita2_ce(k))%观测站2与目标站之间的夹角