tdoa/aoa定位的扩展卡尔曼滤波定位算法matlab源码,03TDOA_AOA定位的扩展卡尔曼滤波算法MATLAB源代码...

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

%% 第二步:构造两个固定的矩阵

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值