一种室内移动目标定位方法、装置和计算机设备

文档序号:1935929 发布日期:2021-12-07 浏览:22次 >En<

阅读说明:本技术 一种室内移动目标定位方法、装置和计算机设备 (Indoor mobile target positioning method and device and computer equipment ) 是由 曹宁 马利 毛明禾 于 2021-08-31 设计创作,主要内容包括:本发明公开了一种室内移动目标定位方法,包括:建立未知移动目标节点运动的状态方程和观测模型;根据状态方程,通过UT计算的一组Sigma点集及其对应的权值,获得系统状态量的一步预测值及协方差矩阵、和观测Sigma点集;根据观测模型,计算观测Sigma点集的观测预测值,得到系统的观测预测值;根据基于最大相关熵的代价函数,融合系统的观测预测值,获得重构观测模型的观测协方差和观测互协方差矩阵,确定卡尔曼增益矩阵,估计系统状态量,确定未知移动目标节点的位置坐标。本发明中基于MCUKF的室内定位方法能更好地完成量测噪声出现非高斯噪声情况下的室内定位,定位精度相比于LS、EKF和UKF的室内定位方法较高,以及鲁棒性比LS、EKF和UKF的室内定位方法也较强。(The invention discloses a method for positioning an indoor moving target, which comprises the following steps: establishing a state equation and an observation model of the motion of an unknown moving target node; according to a state equation, obtaining a one-step predicted value and a covariance matrix of the system state quantity and an observation Sigma point set through a group of Sigma point sets calculated by UT and corresponding weights thereof; calculating an observation predicted value of observing a Sigma point set according to the observation model to obtain an observation predicted value of the system; and according to a cost function based on the maximum correlation entropy, fusing an observation predicted value of the system, obtaining an observation covariance matrix and an observation cross covariance matrix of a reconstructed observation model, determining a Kalman gain matrix, estimating a system state quantity, and determining the position coordinate of an unknown moving target node. The indoor positioning method based on the MCUKF can better complete indoor positioning under the condition that non-Gaussian noise occurs in measurement noise, the positioning precision is higher than that of the indoor positioning methods of LS, EKF and UKF, and the robustness is also higher than that of the indoor positioning methods of LS, EKF and UKF.)

一种室内移动目标定位方法、装置和计算机设备

技术领域

本发明涉及室内定位领域,特别涉及一种基于最大相关熵无迹卡尔曼滤波(MCUKF)的室内移动目标定位方法、装置和计算机设备。

背景技术

近年来,室内定位的需求越来越多。正是由于室内定位规模巨大的应用场景和很高的商业价值,它们被广泛用于医疗中心,智能家居,购物中心,矿井下人员定位追踪,货物跟踪等领域。基于RSS的室内定位系统由于其无需特定硬件的优势,在其刚一出现便受到了广泛关注。由于基于MMSE准则的卡尔曼滤波是一种最优状态估计方法,同时也被引入到了室内定位中,并取得了较好的效果。除此之外,还有卡尔曼滤波的一些改进算法如扩展卡尔曼滤波器 (EKF),无迹卡尔曼滤波器(UKF)等等也被应用于室内定位系统中。但是在实际的室内环境中,由于环境非常复杂,无线信号容易发生反射、衍射和折射等现象,同时温度、湿度、障碍物等周围环境的变化、非视距等也会对无线信号的传播造成一定的影响,这些因素导致室内定位系统常常受到多峰重尾非高斯噪声的影响,此时基于MMSE准则的卡尔曼滤波器精度将会大幅度降低,甚至引起滤波发散,使得室内定位系统无法正常使用。

发明内容

基于此,有必要针对上述技术问题,提供一种室内移动目标定位方法、装置和计算机设备。

本发明实施例提供一种室内移动目标定位方法,包括:基于设置于室内的多个无线接入点AP节点和一个未知移动目标节点构成的定位系统,其中,无线接入点AP节点的数量大于等于3;所述定位方法包括:

建立未知移动目标节点运动的状态方程;

建立未知移动目标节点运动的观测模型;

根据状态方程,通过无迹变换UT计算的一组Sigma点集及其对应的权值,获得系统状态量的一步预测值及协方差矩阵;并根据一步预测值,再次通过无迹变换UT计算新Sigma点集,将新Sigma点集代入观测模型,获得观测Sigma 点集;

根据观测模型,计算观测Sigma点集的观测预测值,并通过加权求和得到系统的观测预测值;

根据基于最大相关熵的代价函数,融合系统的观测预测值,获得重构观测模型的观测协方差和观测互协方差矩阵;并根据观测协方差和观测互协方差矩阵,确定卡尔曼增益矩阵;

根据卡尔曼增益矩阵,估计系统状态量和协方差矩阵;并根据估计的系统状态量和协方差矩阵,确定未知移动目标节点的位置坐标。

进一步地,所述建立未知移动目标节点运动的状态方程,包括:

将未知移动目标节点的位置和速度作为状态量建立未知移动目标节点运动的状态方程;且未知移动目标节点的运动用在时间步k处x(k)的变化来描述,表达式如下:x(k+1)=f(x(k))+ω(k)

其中,(x,y)是未知节点的空间位置坐标;分别是未知节点在x方向和y方向的速度;f(x(k))为系统矩阵,w(k)为过程噪声,设采样时间间隔为T=1s;简写为:x(k+1)=f(x(k))+w(k)。

进一步地,所述建立未知移动目标节点运动的观测模型,包括:

获取未知移动目标节点接收来自已知无线接入点AP节点的RSSI值;

将RSSI值作为观测量,建立观测模型。

进一步地,所述将RSSI值作为观测量,建立观测模型,包括:

将不同已知无线接入点AP节点的RSSI值加权平均作为观测量,采用对数距离路径损耗模型,建立观测模型;且所述观测模型的表达式为:

Z(k)=h(x(k))+v(k)

其中,所述对数距离路径损耗模型的通式为: RS(d)=RS(d0)+10λlg(d/d0)+θdB;RS(d)为收发设备间距离为d时的路径损耗,单位为dB;RS(d0)为近距离d0时的参考路径损耗,d0取1米;λ为损耗因子;θdB为正态随机变量;v(k)为观测噪声,是第L个已知已知无线接入点AP节点的坐标向量,Xk是未知移动目标节点第 k时刻的坐标向量。

进一步地,所述获得观测Sigma点集,包括:

根据UT变换获得一组采样点,称为Sigma点集:

计算采样点相应的权值,如下:

根据系统方程形成2n+1个Sigma点集:

系统状态量的预测值及协方差矩阵为:

根据一步预测值,再次使用UT变换,产生新Sigma点集:

将预测的新Sigma点集代入观测模型,得到相应的观测Sigma点集:

其中,n为状态的维数;X0为i=0时的采样点;Xi为第i个Sigma采样点;为Sigma集合的样本均值;P为状态向量的方差;λ为一个缩放比例参数;分别是协方差和均值的权重值;α是采样点的分布状态参数;β≥0为一个非负的权值系数;Xi(k+1∣k)为Sigma采样点的一步预测值;和 P(k+1∣k)分别为系统状态量的一步预测值和协方差矩阵,Q(k)为过程噪声; Zi(k+1∣k)为观测Sigma采样点。

进一步地,所述系统的观测预测值,如下:

进一步地,所述确定卡尔曼增益矩阵,包括:

将观测模型进行重构,得到如下的非线性模型:

其中,

E[r(k)rT(k)]=R(k)

对重构的观测模型两边左乘S-1(k),由于S-1(k)=ST(K),得到如下等式:

其中,e(k)=ST(k)φ(k)

那么,e(k)中第j行的元素ej(k),ej(k)=dj(k)-mj(x(k))。

根据相关熵的性质,基于相关熵的代价函数为:

当代价函数J(·)最大时得到状态的最优估计,那么x(k)的最优估计值为:

上式得到:

由此可得:

得到修改后的协方差为:

其中,

Φ(k)=diag(GΥ(e1(k),…,GΥ(en+m(k))))

在实际中真实的状态是未知的,设则有

修改后的观测协方差为:

则系统观测的协方差变为:

互协方差矩阵为:

卡尔曼增益矩阵K(k)为:

进一步地,所述根据卡尔曼增益矩阵,更新系统状态量和协方差矩阵,包括:

计算状态更新和协方差更新P(k+1∣k+1);

本发明实施例还提供一种室内移动目标定位装置,包括:基于设置于室内的多个无线接入点AP节点和一个未知移动目标节点构成的定位系统,其中,无线接入点AP节点的数量大于等于3;所述定位装置还包括:

状态方程建立模块,用于建立未知移动目标节点运动的状态方程;

观测模型建立模块,用于建立未知移动目标节点运动的观测模型;

观测Sigma点集确定模块,用于根据状态方程,通过无迹变换UT计算的一组Sigma点集及其对应的权值,获得系统状态量的一步预测值及协方差矩阵;并根据一步预测值,再次通过无迹变换UT计算新Sigma点集,将新Sigma点集代入观测模型,获得观测Sigma点集;

系统观测预测值确定模块,用于根据观测模型,计算观测Sigma点集的观测预测值,通过加权求和得到系统的观测预测值;

卡尔曼增益矩阵确定模块,用于根据相关熵的性质确定的基于最大相关熵的代价函数,融合系统的观测预测值,获得重构观测模型的观测协方差和观测互协方差矩阵;并根据观测协方差和观测互协方差矩阵,确定卡尔曼增益矩阵;

移动目标确定模块,用于根据卡尔曼增益矩阵,更新系统状态量和协方差矩阵;并根据更新的系统状态量和协方差矩阵,确定未知移动目标节点的位置坐标。

本发明实施例还提供一种计算机设备,包括:基于设置于室内的多个无线接入点AP节点和一个未知移动目标节点构成的定位系统,其中,无线接入点 AP节点的数量大于等于3;

建立未知移动目标节点运动的状态方程;

建立未知移动目标节点运动的观测模型;

根据状态方程,通过无迹变换UT计算的一组Sigma点集及其对应的权值,获得系统状态量的一步预测值及协方差矩阵;并根据一步预测值,再次通过无迹变换UT计算新Sigma点集,将新Sigma点集代入观测模型,获得观测Sigma 点集;

根据观测模型,计算观测Sigma点集的观测预测值,通过加权求和得到系统的观测预测值;

根据基于最大相关熵的代价函数,融合系统的观测预测值,获得重构观测模型的观测协方差和观测互协方差矩阵;并根据观测协方差和观测互协方差矩阵,确定卡尔曼增益矩阵;

根据卡尔曼增益矩阵,更新系统状态量和协方差矩阵;并根据更新的系统状态量和协方差矩阵,确定未知移动目标节点的位置坐标。

本发明实施例提供的上述室内定位方法、装置和计算机设备,与现有技术相比,其有益效果如下:

针对室内定位系统在复杂的室内环境中通常会受到多峰重尾非高斯噪声的影响,本发明提出了将基于最大互相关熵准则(MCC)与无迹卡尔曼滤波器 (UKF)结合,即基于最大相关熵无迹卡尔曼滤波(MCUKF)的室内定位方法。另外,对基于LS、EKF、UKF的室内定位方法和MCUKF室内定位方法进行室内定位实验,结果表明:基于LS、EKF和UKF的室内定位方法的室内定位精度均低于本设计的MCUKF方法;同时,分析了基于四种不同核宽度下的 MCUKF的室内定位方法,得出Υ=10时该提出的方法效果最佳。基于MCUKF 的室内定位方法能更好地完成量测噪声出现非高斯噪声情况下的室内定位,定位精度相比于LS、EKF和UKF的室内定位方法较高,以及鲁棒性比LS、EKF 和UKF的室内定位方法也较强。即MCUKF在多峰重尾非高斯观测噪声的环境下对未知节点的状态估计和位置定位的估计效果比传统的扩展卡尔曼滤波 (EKF)和无迹卡尔曼滤波(UKF)更好,鲁棒性更强。

附图说明

图1为一个实施例中提供的室内移动目标定位方法流程图;

图2为一个实施例中提供的不同定位算法定位精度对比图;

图3为一个实施例中提供的不同核宽度的MCUKF算法动态定位对比;

图4为一个实施例中提供的不同核宽度下的定位RMSE对比图。

具体实施方式

为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。

一个实施例中,参见图1,提供的一种室内移动目标定位方法,该方法具体包括:

MCUKF室内定位方法是基于MCC的非线性回归方法重新构建观测信息,增强了UKF对非高斯噪声的鲁棒性,本发明将该算法应用于室内定位目标的状态估计中,从而解决了室内定位的重尾非高斯噪声影响的问题。

在室内现场设置L个无线接入点(AP)节点,第l个AP节点的坐标为(xl,yl), l=1,2,…L。移动的未知节点可以接收来自AP节点的信号强度,以移动的未知节点的位置和速度为状态量(x,y)是未知节点的空间未知坐标,分别是未知节点在x方向和y方向的速度,它的运动在时间步k处x(k)的变化来描述,表达式如下:x(k+1)=f(x(k))+ω(k)

其中,w(k)为过程噪声,本文设采样时间间隔为T=1s。

也可以简写为:x(k+1)=f(x(k))+w(k)。

RSSI测距技术也被称为信号强度测距法,它是基于无线电传播路径损耗模型计算得到的。在室内这种复杂多变的环境中,自由空间模型等传统无线信号传输模型已经不再适用,目前比较常用的模型是对数距离路径损耗模型等,它已在各种现实环境中得到验证,其通用模型为:

RS(d)=RS(d0)+10λlg(d/d0)+θdB

在室内定位中,可以从移动节点的收发器中提取RSSI值,预测的RSSI值的观测模型采用对数距离路径损耗模型(即采用对数距离路径损耗模型组成RSSI 值的观测模型从而预测RSSI值)。为了增强定位系统对其他外部无线抗干扰能力,将获得的不同已知节点多次测量的信号强度的加权平均作为观测量。

Z(k)=h(x(k))+v(k)

其中,v(k)为观测噪声,是第L 个已知节点的坐标向量,Xk是移动的未知节点第k时刻的坐标向量。

需要说明的是,传统的观测模型是建立假定噪声是呈高斯分布的,现在噪声发生了变化,是多峰重尾非高斯的噪声,需要重新构建;2、传统的观测模型是基于最小均方差的准则构建的;现在准则发生了变化,是采用最大互相关熵准则,准则发生了变化,原来建立的观测模型不相符,就需要重构观测模型。

最大相关熵无迹卡尔曼滤波MCUKF定位算法,具体过程如下:

(1)首先,根据UT变换获得一组采样点(称为Sigma点集)及其对应的权值:

(初始值)

(2)计算UT变换的这些采样点相应的权值,如下:

(3)然后根据系统方程形成2n+1个Sigma点集:

(4)系统状态量的一步预测及协方差矩阵为:

(5)然后根据上一步预测值,再次使用UT变换,产生新的Sigma点集。

(6)将预测的新Sigma点集代入观测方程,得到相应的观测Sigma点集

(7)由步骤(3)得到观测Sigma点集的观测预测值,通过加权求和得到系统预测的均值,如下所示:

将观测模型进行重构,得到如下的非线性模型:

其中,E[r(k)rT(k)]=R(k)

(9)对重构的观测模型两边左乘S-1(k),由于S-1(k)=ST(K),那么得到如下等式:

其中,e(k)=ST(k)φ(k)

那么,e(k)中第j行的元素ej(k)为ej(k)=dj(k)-mj(x(k))。

(10)根据相关熵的性质,基于相关熵的代价函数为

当函数J(·)最大时可以得到状态的最优估计,那么x(k)的最优估计值为

那么,令

上式就可以得到:

由此可得:

那么,得到修改后的协方差为

其中:

Φ(k)=diag(GΥ(e1(k),…,GΥ(en+m(k))))

(11)在实际中真实的状态是未知的,设则有:

修改后的观测协方差为:

则系统观测的协方差变为:

那么,互协方差矩阵为:

卡尔曼增益矩阵为

(12)最后,计算状态更新和协方差更新

实施例1

为了充分验证所提MCUKF方法的合理性,采用一种基于CC2530的Zigbee 室内定位系统进行实验,基于CC2530的Zigbee室内定位系统中有一个未知节点和四个AP点,四个AP点随机分布,并确定AP点的坐标。然后采用PC机在未知节点静止情况下采集信号强度数据,每次每个点采集3min,从中选择 50组数据,对未知节点接收的4个AP信号强度误差分布特性进行检验分析,经Kolmogorov-Smirnov检验结果分析,如果测试在15%显著水平上拒绝零假设,未知节点到4个AP的信号强度均为非正态分布。针对未知节点接收AP 的信号强度呈现的是非高斯分布状态,那么未知节点与已知AP的测距误差也均为非高斯噪声。因此,其信号强度分布符合几个高斯分布叠加,通过混合高斯模型拟合信号强度的分布,所提出的MCUKF定位算法按照此分布进行计算,如图2所示。

如图2所示,由于引入最大相关熵,MCUKF与其他定位算法对比可知, MCUKF对观测噪声分布特性要求降低,能够对观测数据更好的进行滤波处理,定位精度有了明显的改善,尤其是当其他算法定位误差较大时,采用MCUKF 定位算法精度提升更加明显,因此MCUKF定位算法相比较于其他算法鲁棒性更强,适应环境能力更强。

实施例2

在实际复杂的室内环境中,定位精度经常会受到多峰重尾非高斯噪声的影响,这会导致传统的非线性滤波算法精度下降甚至发散,因此需要研究针对多峰重尾非高斯噪声的非线性鲁棒滤波方法,本发明提出的方法在传统非线性滤波UKF的基础上引入了最大相关熵,使得滤波具有对抗非高斯的鲁棒性。下面以具体的仿真实验进行验证,并比较分析选择合适的核宽度。在室内定位区域部署四个AP,其对应的坐标分别为A1(0,0),A2(0,10),A3(10,0),A4(10,10),设实验中未知节点的状态向量初始真实状态为由LS提供(位置单位m,速度单位m/s)初始的状态估计误差协方差矩阵被设置为P(0∣0)=diag([1,0.5,1,0.5]),过程噪声为Q~N(0,0.1),观测的非高斯噪声由测试的信号强度进行综合分析,为为了找到最佳的核宽度,首先选取四种不同的核宽度进行实验,核宽度分别设置为Υ1=5,Υ2=10,Υ3=20,Υ4=50。实验结果如下图3、4所示。

如图3所示在四种核宽度的MCUKF算法动态定位对比,如图4所示是定位精度的对比图,从图3、4所示可知MCUKF选择核宽度Υ3=10时,室内定位精度最高,性能效果最好。

一个实施例中,提供的一种室内定位装置,该装置包括:基于设置于室内的多个无线接入点AP节点和一个未知移动目标节点构成的定位系统,其中,无线接入点AP节点的数量大于等于3;

状态方程建立模块,用于建立未知移动目标节点运动的状态方程。

观测模型建立模块,用于建立未知移动目标节点运动的观测模型。

观测Sigma点集确定模块,用于根据状态方程,通过无迹变换UT计算的一组Sigma点集及其对应的权值,获得系统状态量的一步预测值及协方差矩阵;并根据一步预测值,再次通过无迹变换UT计算新Sigma点集,将新Sigma点集代入观测模型,获得观测Sigma点集。

系统观测预测值确定模块,用于根据观测模型,计算观测Sigma点集的观测预测值,通过加权求和得到系统的观测预测值。

卡尔曼增益矩阵确定模块,用于根据相关熵的性质确定的基于最大相关熵的代价函数,融合系统的观测预测值,获得重构观测模型的观测协方差和观测互协方差矩阵;并根据观测协方差和观测互协方差矩阵,确定卡尔曼增益矩阵。

移动目标确定模块,用于根据卡尔曼增益矩阵,更新系统状态量和协方差矩阵;并根据更新的系统状态量和协方差矩阵,确定未知移动目标节点的位置坐标。

关于室内定位装置的具体限定可以参见上文中对于室内定位方法的限定,在此不再赘述。上述室内定位装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。

一个实施例中,提供的一种计算机设备,包括:基于设置于室内的多个无线接入点AP节点和一个未知移动目标节点构成的定位系统,其中,无线接入点AP节点的数量大于等于3;

建立未知移动目标节点运动的状态方程。

建立未知移动目标节点运动的观测模型。

根据状态方程,通过无迹变换UT计算的一组Sigma点集及其对应的权值,获得系统状态量的一步预测值及协方差矩阵;并根据一步预测值,再次通过无迹变换UT计算新Sigma点集,将新Sigma点集代入观测模型,获得观测Sigma 点集。

根据观测模型,计算观测Sigma点集的观测预测值,通过加权求和得到系统的观测预测值。

根据基于最大相关熵的代价函数,融合系统的观测预测值,获得重构观测模型的观测协方差和观测互协方差矩阵;并根据观测协方差和观测互协方差矩阵,确定卡尔曼增益矩阵。

根据卡尔曼增益矩阵,更新系统状态量和协方差矩阵;并根据更新的系统状态量和协方差矩阵,确定未知移动目标节点的位置坐标。

本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和易失性存储器中的至少一种。非易失性存储器可包括只读存储器(Read-Only Memory,ROM)、磁带、软盘、闪存或光存储器等。易失性存储器可包括随机存取存储器(Random Access Memory,RAM)或外部高速缓冲存储器。作为说明而非局限,RAM可以是多种形式,比如静态随机存取存储器(Static Random Access Memory, SRAM)或动态随机存取存储器(Dynamic Random Access Memory,DRAM) 等。

以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。还有,以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。

23页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种机器人的近距离混合跟随定位系统及方法

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!