基于智能粒子滤波的室内无人靶车定位方法技术

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

【技术实现步骤摘要】
基于智能粒子滤波的室内无人靶车定位方法


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

技术介绍

[0002]室内无人靶车是一种由人员在室内靶场进行射击训练时需要使用的一种可移动设备，随着科学技术的迅速发展，靶车上开始加载智能控制单元，为了方便对室内智能无人靶车的管理，必须要知道室内无人靶车所处的位置，即对无人靶车进行室内定位。应用于室内定位的方法有很多，其中基于基站的室内定位方法和基于惯性导航的室内定位方法是两种最为常见的室内定位方法。基于基站的室内定位方法利用信标接收到基站发送的短脉冲信号解算出目标物体在室内的具体位置。基于惯性导航的室内定位方法，利用搭载在目标物体上的惯性测量单元采集到的加速度和角速度解算出目标物体在室内的具体位置。两种室内定位方法都有其各自的优缺点，将这些定位方法进行合理地融合，将使系统的整体性能得到很大的提升，使室内定位结果更加准确。
[0003]电子科技大学在其申请的专利文献“基于粒子滤波算法的UWB/INS组合室内定位方法”(申请号：CN202010034636.3，申请公布号：CN111256695A)中公开了一种基于基站和惯导组合的室内定位方法。该方法首先通过UWB(超宽带)系统获取到待定位物体在室内的位置。然后通过INS(惯性导航系统)获取目标物体在运动过程中的三轴加速度、三轴角速度、以及三轴磁场强度，通过INS解算单元计算出目标在室内的位置。最后通过粒子滤波算法，将UWB系统计算结果与INS系统计算结果进行数据融合。达到了降低非视距复杂环境的影响、提高定位精度的目的。但是，该方法存在的不足之处是，由于其粒子滤波中用到的重要性采样方法只是根据归一化权值对粒子进行简单的复制和淘汰，容易随着时间的推移导致粒子贫化，最终使得融合算法失效，因此无法实现长期稳定的进行高精度定位。

技术实现思路

[0004]本专利技术的目的在于针对上述现有技术存在的缺陷，提出一种基于智能粒子滤波的室内靶车定位方法，用于解决现有技术中高精度定位不具有长期性和稳定性的问题。
[0005]实现本专利技术目的的思路是，本专利技术利用惯性导航积分算法，确定每个定位时刻每个粒子的坐标，得到该定位时刻粒子滤波的状态坐标集。利用UWB定位算法，获取每个定位时刻无人靶车底座中心点的横、纵坐标初值，得到该定位时刻粒子滤波的观测点坐标。然后将每个时刻粒子滤波的状态坐标集和该时刻观测点坐标代入后续的粒子滤波操作中，得到该时刻最终的粒子滤波输出作为该时刻的融合定位结果，由于粒子滤波可以通过粒子分布模拟出方差最小的结果分布，因此以最终的粒子滤波输出作为融合定位结果具有跟踪二者中最佳定位结果的特点，克服了现有技术中使用其中任意一种定位方法导致室内无人靶车平均定位精度不高的不足。
[0006]本专利技术将粒子滤波状态坐标集中的粒子根据其权值大小分为两个群体，保留其中权值较大的群体，对权值小的群体进行交叉、变异操作，这样不但可以增大粒子在其他位置的可能性也可以使得粒子滤波中的大部分粒子自适应的分布在高似然区域内，使粒子滤波可以随着时间的推移自适应的保持粒子活性，克服了现有技术中粒子滤波会随着时间的推移产生粒子贫化现象而导致高精度定位结果失效的不足。
[0007]为实现上述目的，本专利技术采取的技术方案包括如下步骤：
[0008]步骤1，生成粒子滤波的初始粒子：
[0009]随机生成用于粒子滤波的M个初始粒子，在待定位靶车的区域内随机选择与每个粒子对应的坐标作为该初始粒子的坐标，M≥10；
[0010]步骤2，确定每个定位时刻粒子滤波的状态坐标集：
[0011](2a)利用惯性导航积分算法，确定每个定位时刻每个粒子的坐标；
[0012](2b)将每个定位时刻所有粒子的坐标组成该定位时刻粒子滤波的状态坐标集；
[0013]步骤3，确定每个定位时刻粒子滤波的观测点坐标：
[0014](3a)利用UWB定位算法，获取每个定位时刻无人靶车底座中心点的横、纵坐标初值；
[0015](3b)将每个定位时刻无人靶车底座中心点的横、纵坐标初值作为该定位时刻粒子滤波观测点的横、纵坐标值；
[0016]步骤4，按照下式，计算每个定位时刻粒子滤波状态坐标集中每个粒子的权值：
[0017][0018]其中，表示第k个定位时刻粒子滤波状态坐标集中第m个粒子的权值，和表示第k个定位时刻粒子滤波状态坐标集中第m个粒子的横、纵坐标值，分别表示第k个定位时刻粒子滤波观测点的横、纵坐标值；
[0019]步骤5，对每个定位时刻粒子滤波状态坐标集中的每个粒子进行重采样：
[0020](5a)将在[0.6,0.8]中随机选取的一个小数W
T
设定为阈值，将每个定位时刻粒子滤波状态坐标集中权值小于该阈值的粒子组成该定位时刻的衰败粒子集，其余部分组成该定位时刻的优秀粒子集；
[0021](5b)利用下述交叉公式，对每个定位时刻衰败粒子集中的每个粒子进行交叉操作：
[0022][0023]其中，表示第k个定位时刻衰败粒子集中的第l个粒子交叉后的粒子，表示第k个定位时刻衰败粒子集中的第l个粒子，表示第k个定位时刻优秀粒子集中的第l个粒子，α表示交叉系数，为在[0.6,0.8]中随机选取的一个小数；
[0024](5c)利用如下变异公式，对交叉后的粒子进行变异操作：
[0025][0026]其中，表示变异后的粒子，r
k
表示第k个定位时刻的变异系数，为在[0,1]中随机选取的一个小数，p为(0,1)中随机选取的变异概率；
[0027](5d)将每个定位时刻的优秀粒子集与该定位时刻所有经过变异后的粒子集合，作为该定位时刻重采样后的粒子滤波状态坐标集
[0028]步骤6，按照下式，计算每个定位时刻室内无人靶车的横、纵坐标值：
[0029][0030]其中，和分别表示第k个定位时刻室内无人靶车底座中心点的横、纵坐标值，∑表示求和操作，和分别表示第k个定位时刻重采样后的粒子滤波状态坐标集中第i个粒子的横、纵坐标值。
[0031]本专利技术与现有技术相比，具有以下优点：
[0032]第一，由于本专利技术利用惯性导航积分算法，确定每个定位时刻每个粒子的坐标，再利用UWB定位算法，获取每个定位时刻无人靶车底座中心点的横、纵坐标初值，克服了现有技术中使用其中任意一种定位方法导致室内无人靶车平均定位精度不高的不足，使得本专利技术提高了室内无人靶车的定位精度。
[0033]第二，本专利技术将粒子滤波状态坐标集中的粒子根据其权值大小分为两个群体，保留其中权值较大的群体，对权值小的群体进行交叉、变异操作，增大了粒子在其他位置的可能性，克服了现有技术中粒子滤波会随着时间的推移产生粒子贫化现象而导致高精度定位结果失效的不足，使得本专利技术高精度定位结果不会随着时间的推移而失本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于智能粒子滤波的室内靶车定位方法，其特征在于，根据粒子权值大小将所有粒子分为两个群体，保留其中权值较大的群体，对权值小的群体进行交叉、变异操作；该室内靶车定位方法的具体步骤包括如下：步骤1，生成粒子滤波的初始粒子：随机生成用于粒子滤波的M个初始粒子，在待定位靶车的区域内随机选择与每个粒子对应的坐标作为该初始粒子的坐标，M≥10；步骤2，确定每个定位时刻粒子滤波的状态坐标集：(2a)利用惯性导航积分算法，确定每个定位时刻每个粒子的坐标；(2b)将每个定位时刻所有粒子的坐标组成该定位时刻粒子滤波的状态坐标集；步骤3，确定每个定位时刻粒子滤波的观测点坐标：(3a)利用UWB定位算法，获取每个定位时刻无人靶车底座中心点的横、纵坐标初值；(3b)将每个定位时刻无人靶车底座中心点的横、纵坐标初值作为该定位时刻粒子滤波观测点的横、纵坐标值；步骤4，按照下式，计算每个定位时刻粒子滤波状态坐标集中每个粒子的权值：其中，表示第k个定位时刻粒子滤波状态坐标集中第m个粒子的权值，和表示第k个定位时刻粒子滤波状态坐标集中第m个粒子的横、纵坐标值，分别表示第k个定位时刻粒子滤波观测点的横、纵坐标值；步骤5，对每个定位时刻粒子滤波状态坐标集中的每个粒子进行重采样：(5a)将在[0.6,0.8]中随机选取的一个小数W
T
设定为阈值，将每个定位时刻粒子滤波状态坐标集中权值小于该阈值的粒子组成该定位时刻的衰败粒子集，其余部分组成该定位时刻的优秀粒子集；(5b)利用下述交叉公式，对每个定位时刻衰败粒子集中的每个粒子进行交叉操作：其中，表示第k个定位时刻衰败粒子集中的第l个粒子交叉后的粒子，表示第k个定位时刻衰败粒子集中的第l个粒子，表示第k个定位时刻优秀粒子集中的第l个粒子，α表示交叉系数，为在[0.6,0.8]中随机选取的一个小数；(5c)利用如下变异公式，...

【专利技术属性】
技术研发人员：唐影，王昭，钱海雷，梁添程，左祺森，王重月，
申请(专利权)人：昆山九毫米电子科技有限公司，
类型：发明
国别省市：