一种基于空间环境误差模型的分布式定位算法制造技术

本发明专利技术提出了一种基于空间环境误差模型的分布式定位算法。该算法为：首先获取定位环境的空间信息，根据UWB信号在空间结构中的误差模型，结合已知的定位环境空间获取定位区域中包含视距基站分布及非视距误差补偿函数的先验信息图；依据空间先验信息图在定位过程中对UWB基站进行选择和误差补偿；在定位过程中利用PDR的航向信息判断基站是否受到了行人身体的遮挡，若存在对测距值进行修正；最终将补偿后的多基站信息结合PDR通过分布式误差状态算法实现定位。本发明专利技术充分利用空间结构及UWB非视距误差模型等先验信息来优选基站实现精确定位，具有精度高和鲁棒性强的优点。具有精度高和鲁棒性强的优点。

【技术实现步骤摘要】
一种基于空间环境误差模型的分布式定位算法

：
[0001]本专利技术涉及室内定位方法，尤其是涉及一种基于空间环境误差模型的分布式定位算法。
技术背景：
[0002]与室外相比，室内位置服务潜在的商业价值正在逐年攀升。目前，车站、机场、化工厂、医院、养老院、监狱/看守所/戒毒所、施工现场等都大规模引入室内定位，增长速度极快。具体到行业，《2018年室内定位的发展前景分析》报告指出，我国室内定位直接市场总量已突破3000亿元。目前，存在的室内定位技术有红外线、蓝牙、惯性导航、无线保真(wireless fidelity，Wi
‑
Fi)、超宽带(ultra wide band，UWB)技术等。UWB由于具有定位精度高、功耗低、有一定信号穿透性等优点而脱颖而出，已成为一个越来越被关注的

[0003]任何无线电技术不可避免地都有缺陷，UWB技术也不例外。超宽带在理想的室内环境下可以达到厘米级的定位精度，但其信号传输易受非视距干扰。因为UWB信号在室内的传输距离有限，且其信号在绕过障碍物时会产生较大误差，无法胜任NLOS场本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于空间环境误差模型的分布式定位算法，其特征在于，包括以下步骤：S1，获取定位区域环境空间信息，布设定位基站；S2，建立定位环境UWB建站视距或非视距信息分布图；S3，利用非视距误差补偿函数结合S2中基站分布情况建立定位环境先验信息图；S4，对定位过程中的UWB基站进行选择；S5，利用人体误差补偿函数对人体影响下的基站进行误差补偿；S6，建立动态分布式误差滤波算法；S7，将S6中获取的当前定位结果作为下一时刻的定位起点并反馈到PDR进行信息修正。2.根据权利要求1所述的一种基于空间环境误差模型的分布式定位算法，其特征在于，步骤3所述的建立定位环境先验信息图，具体如下：首先通过激光雷达设备扫描定位区域空间环境，根据激光点云建立该区域空间模型；按照PDOP最优化准则结合空间环境进行UWB基站部署；在空间模型中将地面划分成边长为0.5米的正方形小方格，遍历区域中的每个小方格，在小方格中加入可视距的基站编号信息，获取基站视距环境图；针对空间环境中的UWB基站信号传播遮挡障碍物通过测距实验拟合出距离与角度相关信号传播误差函数；在每个小方格的中心点计算基站非视距环境下的误差值，并将该基站对应编号及误差值存入上一步建立的基站视距环境图，最终建成环境先验信息图；该信息图中每个小方格中包含视距基站编号和非视距基站编号，针对非视距基站并包含该位置点非视距情况下的测距误差补偿值。3.根据权利要求1所述的一种基于空间环境误差模型的分布式定位算法，其特征在于，步骤4所述的对UWB定位基站的选择策略，具体如下：UWB定位算法需要获取至少三个基站的位置数据，通过三角定位方法获取动态标签的实时位置。在上一时刻的定位位置的基础上，利用滤波状态预测方程和PDR的航向信息，预判当前时刻UWB移动站的位置，结合S2所建立的UWB建站视距或非视距信息分布图对定位基站进行选择，当该估计点可视化基站大于等于三个时，只选取视距定位基站进行定位；当该估计点可视距基站小于三个时，根据S3步骤中，选定包含视距基站和非视距情况相对较弱的非...

【专利技术属性】
技术研发人员：张昊，王庆，牛运丰，汤立凡，
申请(专利权)人：江苏集萃未来城市应用技术研究所有限公司，
类型：发明
国别省市：