Interferometer.rar_matlab例程_matlab_

%%% 相关系数函数 % 相关时用相似度函数 function [elevation azimuth in_elevation in_azimuth]=DFCofficient(phisamples,phasevector,p,q) %============================输入参数======================================= % phisamples：样本库 % phasevector：实测相位差矢量 % 仿真时进行多次蒙特卡洛试验，为避免重复处理耗时，可以在调用函数前将样本库矢量单位化 % 处理，实测相位差单位化处理 %============================输出参数======================================= % elevation：返回俯仰角 % azimuth：返回方位角 % in_elevation：返回插值后的俯仰角 % in_azimuth：返回插值后的方位角 D=size(phisamples); Rmatrix=zeros(D(1),D(2)); %相关矩阵，存放相关结果 for m=1:D(1) for n=1:D(2) Rmatrix(m,n)=phasevector'/norm(phasevector)*reshape(phisamples(m,n,:),[],1,1)/norm(reshape(phisamples(m,n,:),[],1,1)); %Rmatrix(m,n)=phasevector'*reshape(phisamples(m,n,:),[],1,1); %在调用函数前将样本库，实测相位差单位化 end end [mMax Idxm]=max(Rmatrix); %确定每个方位角对应的最大值及其对应的俯仰角索引 [peak,n0]=max(mMax); %确定最大值对应的俯仰角索引 m0=Idxm(n0); %确定最大值对应的俯仰角索引 elevation=1+(m0-1)*q; %俯仰角计算公式 azimuth=0+(n0-1)*p; %方位角计算公式 %============================插值处理======================================= %主要在离散度p,q较大时使用 if m0==1 || n0==1 || m0==D(1) || n0==D(2) %边界时不进行插值处理 in_elevation=elevation; in_azimuth=azimuth; else %subphisamples=phisamples(:,n0-1:n0+1,m0-1:m0+1); s=zeros(9,1); for m=1:3 for n=1:3 s((m-1)*3+n,1)=phasevector'/norm(phasevector)*reshape(phisamples(m0-2+m,n0-2+n,:),[],1,1)/norm(reshape(phisamples(m0-2+m,n0-2+n,:),1,[],1)); %计算周围点的函数值 %s((m-1)*3+n,1)=phasevector'*rehape(phisamples(m0-2+m,n0-2+n,:),[],1,1); %采用单位化矢量 end end Ma=[ -1/9 2/9 -1/9 2/9 5/9 2/9 -1/9 2/9 -1/9; -1/6 0 1/6 -1/6 0 1/6 -1/6 0 1/6; -1/6 -1/6 -1/6 0 0 0 1/6 1/6 1/6; 1/4 0 -1/4 0 0 0 -1/4 0 1/4; 1/6 -1/3 1/6 1/6 -1/3 1/6 1/6 -1/3 1/6; 1/6 1/6 1/6 -1/3 -1/3 -1/3 1/6 1/6 1/6]; a=Ma*s; f0=(a(4)*a(3)-2*a(6)*a(2))/(4*a(6)*a(5)-a(4)*a(4)); %最大值点偏移量 s0=(a(4)*a(2)-2*a(5)*a(3))/(4*a(6)*a(5)-a(4)*a(4)); if abs(f0)<=1 && abs(s0)<=1 %拟合有意义的条件 in_azimuth=azimuth + f0*p; %插值后方位角估计 in_elevation=elevation + s0*q; %插值后俯仰角估计 else in_azimuth=azimuth; %插值后方位角估计 in_elevation=elevation; %插值后俯仰角估计 end end end