单站无源定位的EKF;UKF;MVEKF仿真及比较
资 源 简 介
基于频域信息的单站无源定位,通过测量角度、角度变化率、多普勒频率变化率得到斜距,用EKF;UKF;MVEKF滤波,最后比较了几种算法的跟踪误差。
data:产生运动模型,匀速直线运动,加入观测噪声,蒙特卡洛仿真100次,保存在data文件夹中
EKF:用EKF算法滤波,相对位置误差大于百分之五认为发散,剔除发散值后统计误差均方根
MVEKF:滤波最后增加了一次迭代运算,在观测噪声很大的情况下反而效果更差
UKF:精度要高,但运算量相对较大
compare:对三种算法进行比较,UKF>EKF>MVEKF
很经典的几种算法,希望对你有用。
文 件 列 表
MVEKF.m
UKF.m
date.m
EKF.m
compare_EFK_UKF.m