MTLAB程序参数估计二维DOA

%距离和角度二维估计by MUSIC;
clear all
close all
rad = pi/180;           %  deg -> rad
c=300;f=100;    %  光速;频率600MHz
lamba=c/f;
sensor = 16;             %  阵列数量
k=1:sensor;
dd =lamba/2;               % 间隔 
d=0:dd:（sensor-1）*dd;   % 
source =2;              % number of DOA
theta=[34 36];
range=[14 16];
% theta1 =25;theta2 =65;              %  角度
% range1 =15;range2 =15;                %  距离
snr = 20;               %  input SNR （dB）
n = 2;                %  snapshots
%          ai=-2*pi*d.*sin（theta*derad）;%%%第i个信源的DOA和距离的非线性函数
%          bi=pi*d.^2*[cos（theta*derad）].^2/range;%%%第i个信源的DOA和距离的非线性函数 
for i=1:source
    theta1=theta（:i）;
    range1=range（:i）; 
A（i:）=exp（j*（k.*（-2*pi*d.*sin（theta1*rad）./lamba）+k.^2.*（pi*d.^2*[cos（theta1*rad）].^2/（range1./lamba））））;%%%% direction matrix
%A（2:）=exp（j*（k.*（-2*pi*d.*sin（theta2*rad）./lamba）+k.^2.*（pi*d.^2*[cos（theta2*rad）].^2/（range2./lamba