%  simulation
% set(0,'defaultfigurecolor','w')
derad = pi/180;      %角度->弧度
N = 4;
M = 5;               % 阵元个数
path = 2;               % 信源数目
theta1 = [60 90];  % 待估计角度aoa
theta2 = [150 90];
snr = 10;            % 信噪比
K = 57;             % 快拍数

d = 0.26;            % 阵元间距
ex1 = 0:M-1;
ex2 = 0:N-1;


A1=exp(-1i*2*pi*d.'*cos(theta1*derad)'.*ex1);  %aoa方向矢量
A2=exp(-1i*2*pi*d.'*cos(theta2*derad)'.*ex2);  %aod方向矢量

% 构建信号模型
% 构造不同强度的路径，先考虑路径长度(即与后边tof有关)。假设不同天线，相同路径强度相同
% S = reshape(S,1,path,K);
S = randn(path,K);
% X1=A1'.*S; % M * path * k
% X2=permute(A2'.*S,[2,1,3]); % path * N * K
% X=matrix_3D_times(X1,X2);                    %构造接收信号
X=A1'*A2;

% S=randn(1,1,K);
% S=ones(1,1,K);
X=repmat(X,1,1,57);
% X=awgn(X,snr,'measured'); %将白色高斯噪声添加到信号中
X1=reshape(X(:,2,:),M,57);
% X1=reshape(X(2,:,:),N,57);

% X1=c*randn(M,K);
%
phi = 0:180;

c = exp(-1i*2*pi*d*cos(phi*derad)'.*ex1);
% c=shiftdim(repmat(c,[1,1,181]),2); % g c 3

g = exp(-1i*2*pi*d*cos(phi*derad)'.*ex2);

% g = sum(exp(-1i*2*pi*dd*cos(phi*derad)'.*ex2),2);
% g=shiftdim(repmat(g',[M,1,181]),1);% sub * aod * aoa

% ss = c*X1;plot(abs(sum(ss,2)));
ss = reshape(sum(reshape((c.*g),[181*181,M])*X,2),181,181);

% ss=sum((c*X1),2);plot(abs(ss));
% ss=sum((g*X1),2);plot(abs(ss));
% [Smax,aoa]=max(ss);
% ss=10*log10(ss/Smax);
% h=plot(0:180,abs(ss));
% plot_peak2D(phi,'aod',phi,'aoa',abs(ss));
% set(h,'Linewidth',2);
% xlabel('入射角/(degree)');
% ylabel('空间谱/(dB)');
% % axis([0 180 -15 5])
% set(gca, 'XTick',[0:20:180])
% grid on;

% tt=1+sqrt(3);
% X2= bsxfun(@minus,X,tt*exp(1i*2*pi*d1.'*cos(90*derad)))