定位程序.zip

function [cx,cy,k]=dwei2(m,xreal,yreal,apx,apy,h) z=0:m:100; n=length(z); c=ones(n,1); x=c*z; y=100-x.'; [x0,y0,e]=dwei1(m,xreal,yreal); S1=gljz1(m,xreal,yreal,28,28); S2=gljz1(m,xreal,yreal,72,28); S3=gljz1(m,xreal,yreal,55,55); S4=gljz1(m,xreal,yreal,28,72); S5=gljz1(m,xreal,yreal,72,72); S0=40+10*2*log10(5); w1=log(5)+((S0-S1)*log(10)/(35)); w2=log(5)+((S0-S2)*log(10)/(35)); w3=log(5)+((S0-S3)*log(10)/(35)); w4=log(5)+((S0-S4)*log(10)/(35)); w5=log(5)+((S0-S5)*log(10)/(35)); t=log(10)*4/(35); r1=exp(w1+t.^2/2); r2=exp(w2+t.^2/2); r3=exp(w3+t.^2/2); r4=exp(w4+t.^2/2); r5=exp(w5+t.^2/2); v1=log(10)*r1/(35); v2=log(10)*r2/(35); v3=log(10)*r3/(35); v4=log(10)*r4/(35); v5=log(10)*r5/(35); t=[abs(r1-v1/2),abs(r2-v2/2),abs(r3-v3/2),abs(r4-v4/2),abs(r5-v5/2)]; f=[r1+v1/2,r2+v2/2,r3+v3/2,r4+v4/2,r5+v5/2]; k=0; for i=1:n for j=1:n d=sqrt((x(i,j)-apx).^2+(y(i,j)-apy).^2); if (t(h)<=d)&(d<=f(h)) k=k+1; cx(k)=x(i,j); cy(k)=y(i,j); else k=1; cx=x0; cy=y0; end end end