mVDR波束形成matlab程序

closeallclearallclcc=1500;fs=10e3;T=1;t=0:1/fs:T;L=length(t);f=2000;w=2*pi*f;k=w/c;M=11;%阵元个数Nmid=1;%参考点d=3;%阵元间距m=[0:1:M-1];yi=zeros(M,1);%返回一个M*1维的零矩阵zi=zeros(M,1);xi=m*d;xi=xi.';%各阵元坐标y1=12;x1=10;z1=10;%声源位置，y轴指向声源平面Ric1=sqrt((x1-xi).^2+(y1-yi).^2+(z1-zi).^2);%声源至各阵元的距离M*1维Rn1=Ric1-Ric1(Nmid);%声源至各阵元与参考阵元的声程差矢量M*1维s1=cos(w*t);%参考阵元接收到的信号1*L维snr=20;Am=10^(-snr/20);n1=Am*(randn(M,L)+j*randn(M,L));%各阵元噪声矢量p1=zeros(M,L);%M*L维fork1=1:Mp1(k1,:)=Ric1(Nmid)/Ric1(k1)*s1.*exp(-j*w*Rn1(k1)/c);%各阵元经过幅度衰减和相位延迟后接收到的信号，M*L维endp=p1+n1;%各阵元接收的声压信号矩阵M*LR=p*p'/L;%接收数据的自协方差矩阵M*MRP=inv(R);%求R的逆矩阵%----------------------------------------------------------%扫描范围step_x=0.1;step_z=0.1;y=y1;x=[0:step_x:20];z=[0:step_z:20];fork1=1:length(z)%纵坐标fork2=1:length(x)Ri=sqrt((x(k2)-xi).^2+(y-yi).^2+(z(k1)-zi).^2);%该扫描点至各阵元的聚焦距离矢量Rn=Ri-Ri(Nmid);%扫描点到各阵元与参考阵元的程差矢量M*1b=exp(-j*w*Rn/c);%声压聚焦方向矢量M*1Pmvdr(k1,k2)=1/abs(b'*RP*b);endend%归一化fork1=1:length(z)pp1(k1)=max(Pmvdr(k1,:));%Pmvdr的第k1行的最大元素的值endPmvdr=Pmvdr/max(pp1);%Pmvdr所有元素除以其最大值，归一化幅度figure;mesh(x,z,Pmvdr);xlabel('x(m)'),ylabel('z(m)')title('mvdr单亮点声图')figure;pcolor(x,z,Pmvdr);shadinginterp;xlabel('x(m)'),ylabel('z(m)')title('mvdr单亮点声图')colorbar[a,b]=find(Pmvdr==max(max(Pmvdr)));xm1=b/length(x)*20,zm1=a/length(z)*20,[ab]=find(Pmvdr0.5*max(max(Pmvdr)));deta_x=(max(b)-min(b))/length(x)*20deta_z=(max(a)-min(a))/length(z)*20