calculate_cbf.m

适用于线列阵的常用定位算法

% Function of CBF  for linear array
% A is the direction vector  (M*1)
% RXX is the covariance matrix (M*M)
%% P=A'*Rxx*A;
function P = Calculte_CBF(No_element,f0,D,Rxx)
    
    C=345;
    P=zeros(181);
    i=1;
    for theta = -90:90
        k = (0:No_element-1)';
        A = exp(-j*2*pi*f0*k.*D*sin(theta*pi/180)/C);
        P(i)= A'*Rxx*A;
        i=i+1;
    end
    
%     P=abs(P)/max(abs(P));
    P = 10*log10(abs(P));