非线性非高斯条件下基于EKF和PF的协同定位方法
基本信息
申请号 | CN201610439442.5 | 申请日 | - |
公开(公告)号 | CN105898865B | 公开(公告)日 | 2019-06-18 |
申请公布号 | CN105898865B | 申请公布日 | 2019-06-18 |
分类号 | H04W64/00(2009.01)I; G01S5/02(2010.01)I | 分类 | 电通信技术; |
发明人 | 王瑞荣; 许春璐; 王敏; 叶杨 | 申请(专利权)人 | 嘉兴嵩赦智能技术有限公司 |
代理机构 | 杭州君度专利代理事务所(特殊普通合伙) | 代理人 | 杭州电子科技大学;浙江知多多网络科技有限公司;嘉兴嵩赦智能技术有限公司 |
地址 | 310018 浙江省杭州市下沙高教园区2号大街 | ||
法律状态 | - |
摘要
摘要 | 本发明公开非线性非高斯条件下基于EKF和PF的协同定位方法。该方法获取目标节点与各基站的TOA原始数据,计算得到目标节点与各基站之间的距离;利用Wylie鉴别法判断是否有NLOS误差;TOA值做差得到TDOA值,重构TDOA值对应的距离差rm1;分别使用EKF算法和PF算法估算tk时刻目标节点的位置坐标;进行残差加权得到tk时刻的最终估计值;对所有时刻的位置坐标进行加权平滑即可得到最终定位结果。该方法较EKF更适用于非线性非高斯的定位环境,较PF有效避免了使用不正确数据,减少了计算量。该方法有效降低NLOS误差的影响,结合EKF和PF两者的优势,同时克服两者的不足,实现比较精确的定位。 |
