一种用于环境声源的被动到达角(AoA)提取算法(Matlab代码实现）

news2024/11/15 9:11:06

👨‍🎓个人主页：研学社的博客

💥💥💞💞欢迎来到本博客❤️❤️💥💥

🏆博主优势：🌞🌞🌞博客内容尽量做到思维缜密，逻辑清晰，为了方便读者。

⛳️座右铭：行百里者，半于九十。

📋📋📋本文目录如下：🎁🎁🎁

目录

💥1 概述

📚2 运行结果

🌈3 Matlab代码实现

🎉4 参考文献

💥1 概述

AOA 定位方法，主要是测量信号移动台和基站之间的到达角度，以基站为起点形成的射线必经过移动台，两条射线的交点即为移动台的位置。该方法只需两个基站就可以确定 MS 的估计位置，其定位示意图如图所示。

📚2 运行结果

部分代码：

%% Initialization

clear;
addpath(genpath('../Library/'));
params = getParams();

micUsed = params.micUsed;
fileName = '../data/ReSpeaker/example';
waveOrig = load([fileName '.mat']).wave(micUsed, :);
[~, waveLen] = size(waveOrig);

sampleRate = params.sampleRate;
readRate = params.readRate;
readNum = round(waveLen / sampleRate * readRate);
readSampleNum = params.readSampleNum;
sourceNum = params.sourceNum;

%% AoA Extraction

angleListY = zeros(readNum, sourceNum);
angleListZ = zeros(readNum, sourceNum);
for readIdx = 1: readNum
waveNow = waveOrig(:, ...
(readIdx - 1) * sampleRate / readRate + 1: (readIdx - 1) * sampleRate / readRate + readSampleNum);

[angleNowY, angleNowZ] = multipleSource(waveNow, sourceNum, params);

angleListY(readIdx, :) = angleNowY;
angleListZ(readIdx, :) = angleNowZ;
end

save([fileName '_result.mat'], 'angleListY', 'angleListZ');

%% Visualization

angleListGtY = ones(readNum, 1) * [25 61];
angleListGtZ = ones(readNum, 1) * [291 101];

figure(1);
subplot(1, 2, 1);
plot((1: readNum) / readRate, angleListY, 'x', ...
(1: readNum) / readRate, angleListGtY, 'linewidth', 2);
axis([0 readNum / readRate params.angleRangeY(1) params.angleRangeY(2)]);
legend('Est_1', 'Est_2', 'Gt_1', 'Gt_2');
title('Angle Y');
xlabel('Time (s)');
ylabel('AoA (Deg)');

subplot(1, 2, 2);
plot((1: readNum) / readRate, angleListZ, 'x', ...
(1: readNum) / readRate, angleListGtZ, 'linewidth', 2);
axis([0 readNum / readRate params.angleRangeZ(1) params.angleRangeZ(2)]);
legend('Est_1', 'Est_2', 'Gt_1', 'Gt_2');
title('Angle Z');
xlabel('Time (s)');
ylabel('AoA (Deg)');