progam3.m

总共有三个源代码： progam1:波达方向估计DOA：三个接收器对波达方向的联合估计问题 progam2:利用电子旋转求DOA progam3:波达方向矩阵法对水听器的DOA进行估计 超好

%波达方向矩阵法
%2008.04.07
%矢量水听器
clc
clear
c=1500;f=1e3;lamd=c/f;
fs=5*f;                                          %采样频率为信号频率的5倍
Ln=1:200;                                    %200拍
theta=pi/10
fi=pi/4                        %信号入射的方位角、俯仰角
ss=exp(j*2*pi*f/fs*Ln);                 %信号
u1=[1 sin(fi)*cos(theta) sin(fi)*sin(theta) cos(fi)].';%阵列流形 
Ap0=kron(ss,u1);
x=Ap0(:,1:100);y=Ap0(:,2:101);

Rxx=x*x'/length(Ln);                     %
Ryx=y*x'/length(Ln);
[D,V]=eig(Rxx);
vi=D(:,4);
Rxx0=vi*vi'/1;
R=Ryx*Rxx0;
[M,N]=eig(R);

u=M(:,1);
Ru=((u(2,1).^2+u(3,1).^2+u(4,1).^2)).^0.5;
uk=u(2,1)/Ru;
vk=u(3,1)/Ru;
wk=u(4,1)/Ru;
fi1=asin((uk.^2+vk.^2).^0.5)
theta1=angle(uk+j*vk)