TDOA/AOA是无线定位领域里使用得比较多的一种定位体制,扩展卡尔曼滤波器是最经典的非线性滤波算法,可用于目标的定位和动态轨迹跟踪。
TDOA/AOA定位的扩展卡尔曼滤波算法MATLAB源代码
TDOA/AOA是无线定位领域里使用得比较多的一种定位体制,扩展卡尔曼滤波器是最经典的非线性滤波算法,可用于目标的定位和动态轨迹跟踪。 function
[MX,MY,SS]=ExtendedKalmanFilter(D1,D2,D3,A1,A2,A3,Flag1,FLAG2,S0,P0,SigmaR,SigmaAOA)
%% TDOA/AOA定位的扩展卡尔曼滤波定位算法
% GreenSim团队——专业级算法设计&代写程序
% 欢迎访问GreenSim团队主页→http://doc.docsou.com/greensim
%% 输入参数列表
% D1 基站1和移动台之间的距离
% D2 基站2和移动台之间的距离
% D3 基站3和移动台之间的距离
% A1 基站1测得的角度值
% A2 基站2测得的角度值
% A3 基站3测得的角度值
% Falg1 1×1矩阵,取值1,2,3TDOA数据的 % FLAG2 N×3矩阵,取值0和1AOA是否可选择, % 1表示选择AOA数据,而是由LOS/NLOS检测模块确定
% S0 初始状态向量,4×% P0 4×的矩阵
% SigmaR 无偏/
% SigmaAOA 选择AOA数据的规律已知,因此可以确定 %% 输出参数列表
% MX
% MY
%% 数据
elseif Flag1==2
TDOA1=D1-D2;
TDOA2=D3-D2;
elseif Flag1==3
TDOA1=D1-D3;
TDOA2=D2-D3;
else
error('Flag1输入有误,它只能取1,2,3');
end
%% 第二步:构造两个固定的矩阵
本文内容由网友自发贡献,版权归原作者所有,本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容,请联系:hwhale#tublm.com(使用前将#替换为@)