forked from ZhanLi/UWBIns
25 lines
710 B
Matlab
25 lines
710 B
Matlab
function [ aoa ] = CalUWBAOA(pdoa)
|
|
Lambda = 3e8/6.5e9; % UWB波长
|
|
D_M = 0.0208; % 久凌天线间距
|
|
aoa = zeros(length(pdoa),1);
|
|
for ii=1:length(pdoa)
|
|
if pdoa(ii) < -180.0
|
|
pdoa(ii)=pdoa(ii)+ 360.0;
|
|
elseif pdoa(ii) > 180.0
|
|
pdoa(ii)=pdoa(ii)-360.0;
|
|
end
|
|
phase_m = pdoa(ii) * (Lambda/360.0);
|
|
% 天线非线性矫正
|
|
% coef=[-14205, 419, 4.59, 0.8361,0];
|
|
% phase_m = coef(1)+coef(2)*phase_m+coef(3)*phase_m^2+coef(4)*phase_m^3+coef(5)*phase_m^4;
|
|
alfa = phase_m / D_M;
|
|
if alfa < -1
|
|
alfa = -1;
|
|
elseif alfa > 1
|
|
alfa = 1;
|
|
end
|
|
aoa(ii)=asind(alfa);
|
|
end
|
|
end
|
|
|