[发明专利]基于智能粒子滤波的室内无人靶车定位方法

说明书

一种基于智能粒子滤波的室内无人靶车定位方法，实现步骤为：生成粒子滤波的初始粒子；确定每个定位时刻粒子滤波的状态坐标集；确定每个定位时刻粒子滤波的观测点坐标；计算每个定位时刻粒子滤波状态坐标集中每个粒子的权值；对每个定位时刻粒子滤波状态坐标集中的每个粒子进行重采样；计算每个定位时刻室内无人靶车的横、纵坐标值。本发明利用粒子滤波对惯性导航定位结果和UWB定位结果进行融合，并对粒子滤波状态坐标集中的粒子根据其权值大小进行选择、交叉、变异操作，有效的减少了粒子退化现象，与现有技术相比，提高了定位精度并延长了高精度定位时间。

技术领域

本发明属于通信技术领域，更进一步涉及无线跟踪技术领域中的一种基于智能粒子滤波的UWB(Ultra Wide Band)和惯性导航的室内无人靶车定位方法。本发明利用室内定位系统，估计室内无人靶车的二维位置。

背景技术

室内无人靶车是一种由人员在室内靶场进行射击训练时需要使用的一种可移动设备，随着科学技术的迅速发展，靶车上开始加载智能控制单元，为了方便对室内智能无人靶车的管理，必须要知道室内无人靶车所处的位置，即对无人靶车进行室内定位。应用于室内定位的方法有很多，其中基于基站的室内定位方法和基于惯性导航的室内定位方法是两种最为常见的室内定位方法。基于基站的室内定位方法利用信标接收到基站发送的短脉冲信号解算出目标物体在室内的具体位置。基于惯性导航的室内定位方法，利用搭载在目标物体上的惯性测量单元采集到的加速度和角速度解算出目标物体在室内的具体位置。两种室内定位方法都有其各自的优缺点，将这些定位方法进行合理地融合，将使系统的整体性能得到很大的提升，使室内定位结果更加准确。

电子科技大学在其申请的专利文献“基于粒子滤波算法的UWB/INS组合室内定位方法”(申请号：CN202010034636.3，申请公布号：CN111256695A)中公开了一种基于基站和惯导组合的室内定位方法。该方法首先通过UWB(超宽带)系统获取到待定位物体在室内的位置。然后通过INS(惯性导航系统)获取目标物体在运动过程中的三轴加速度、三轴角速度、以及三轴磁场强度，通过INS解算单元计算出目标在室内的位置。最后通过粒子滤波算法，将UWB系统计算结果与INS系统计算结果进行数据融合。达到了降低非视距复杂环境的影响、提高定位精度的目的。但是，该方法存在的不足之处是，由于其粒子滤波中用到的重要性采样方法只是根据归一化权值对粒子进行简单的复制和淘汰，容易随着时间的推移导致粒子贫化，最终使得融合算法失效，因此无法实现长期稳定的进行高精度定位。

发明内容

本发明的目的在于针对上述现有技术存在的缺陷，提出一种基于智能粒子滤波的室内靶车定位方法，用于解决现有技术中高精度定位不具有长期性和稳定性的问题。

实现本发明目的的思路是，本发明利用惯性导航积分算法，确定每个定位时刻每个粒子的坐标，得到该定位时刻粒子滤波的状态坐标集。利用UWB定位算法，获取每个定位时刻无人靶车底座中心点的横、纵坐标初值，得到该定位时刻粒子滤波的观测点坐标。然后将每个时刻粒子滤波的状态坐标集和该时刻观测点坐标代入后续的粒子滤波操作中，得到该时刻最终的粒子滤波输出作为该时刻的融合定位结果，由于粒子滤波可以通过粒子分布模拟出方差最小的结果分布，因此以最终的粒子滤波输出作为融合定位结果具有跟踪二者中最佳定位结果的特点，克服了现有技术中使用其中任意一种定位方法导致室内无人靶车平均定位精度不高的不足。

本发明将粒子滤波状态坐标集中的粒子根据其权值大小分为两个群体，保留其中权值较大的群体，对权值小的群体进行交叉、变异操作，这样不但可以增大粒子在其他位置的可能性也可以使得粒子滤波中的大部分粒子自适应的分布在高似然区域内，使粒子滤波可以随着时间的推移自适应的保持粒子活性，克服了现有技术中粒子滤波会随着时间的推移产生粒子贫化现象而导致高精度定位结果失效的不足。

为实现上述目的，本发明采取的技术方案包括如下步骤：

步骤1，生成粒子滤波的初始粒子：