一种定位方法、装置及设备

技术领域

本发明涉及通信技术领域，特别是涉及一种定位方法、装置及设备。

背景技术

随着无线通信技术的日益发展，人们对智能化生活的需求也在不断提升，基于位置的服务(Location Based Services，LBS)也逐渐成为人们生活中重要的组成部分，例如目标定位、导航追踪、智慧城市、应急救援等领域。随着第五代通信网络(5G)这样一个万物互联时代的到来，高精度定位技术在车联网、智能家居、工业4.0、虚拟现实(VirtualReality，VR)等场景下的应用将更加广泛。

但室内环境相比较于室外环境更加复杂，信号传播存在多径、非视距(Non-LineOf Sight，NLOS)等多种干扰。其中，建筑物对信号的反射和折射引起的NLOS误差是最主要的误差来源，严重影响了定位的精度和可靠性。NLOS的基站相较于基站(Line Of Sight，LOS)基站将对到达时间差(Time Difference Of Arrival，TDOA)结果造成较大误差，因此会导致室内定位误差增大。因此，如何提高定位精度对于提高位置服务的可靠性以及基于位置服务的应用开发和普及具有十分重大的意义。

发明内容

本发明实施例的目的在于提供一种定位方法、装置及设备，以提高定位精度。具体技术方案如下：

第一方面，本发明实施例提供了一种定位方法，包括：

获取移动终端的初始位置信息，以及各个基站的位置信息；

根据所述移动终端的初始位置信息和各个基站的位置信息，计算所述移动终端分别与各个基站的距离；

基于各个基站的位置信息以及所述移动终端分别与各个基站的距离，计算所述移动终端的估算位置信息；

通过迭代优化算法，对所述估算位置信息进行优化，得到优化后的位置信息。

可选的，所述根据所述移动终端的初始位置信息和各个基站的位置信息，计算所述移动终端分别与各个基站的距离，包括：

针对各个序列组合，构建Cayley-Menger行列式，其中，序列组合是所述移动终端与所有n个基站中的n-1个基站排列组合得到的；

针对各个序列组合对应的Cayley-Menger行列式，计算所述移动终端与相关基站的距离，所述相关基站为所述序列组合所包括的基站。

可选的，所述基于各个基站的位置信息以及所述移动终端分别与各个基站的距离，计算所述移动终端的估算位置信息，包括：

针对每个序列组合，对所述序列组合得到的所述移动终端与相关基站的距离，通过公式：

其中，R

对每个序列组合得到所述估算值，通过公式

其中，X为所述估算位置信息，

可选的，所述通过迭代优化算法，对所述估算位置信息进行优化，得到优化后的位置信息，包括：

通过公式x

其中，x

可选的，所述优化后的位置信息为所述移动终端在前一时刻的位置信息；

在所述通过迭代优化算法，对所述估算位置信息进行优化，得到优化后的位置信息之后，所述方法还包括：

基于所述优化后的位置信息，通过卡尔曼滤波算法，预测所述移动终端当前时刻的位置信息；

对预测的当前时刻的位置信息进行校正，得到校正后的位置信息。

可选的，所述基于所述优化后的位置信息，通过卡尔曼滤波算法，预测所述移动终端当前时刻的位置信息，包括：

通过公式：

其中，

所述对预测的当前时刻的位置信息进行校正，得到校正后的位置信息，包括：

通过公式：

其中，y

可选的，所述基于所述优化后的位置信息，通过卡尔曼滤波算法，预测所述移动终端当前时刻的位置信息，包括：

通过公式

其中，

所述对预测的当前时刻的位置信息进行校正，得到校正后的位置信息，包括：

通过公式：

其中，

第二方面，本发明实施例提供了一种定位装置，包括：

获取模块，用于获取移动终端的初始位置信息，以及各个基站的位置信息；

计算模块，用于根据所述移动终端的初始位置信息和各个基站的位置信息，计算所述移动终端分别与各个基站的距离；基于各个基站的位置信息以及所述移动终端分别与各个基站的距离，计算所述移动终端的估算位置信息；

优化模块，用于通过迭代优化算法，对所述估算位置信息进行优化，得到优化后的位置信息。

可选的，所述计算模块，具体用于针对各个序列组合，构建Cayley-Menger行列式，其中，其中，序列组合是所述移动终端与所有n个基站中的n-1个基站排列组合得到的；

针对各个序列组合对应的Cayley-Menger行列式，计算所述移动终端与相关基站的距离，所述相关基站为所述序列组合所包括的基站。

可选的，计算模块，具体用于针对每个序列组合，对序列组合得到的移动终端与相关基站的距离，通过公式：

其中，R

对每个序列组合得到估算值，通过公式

其中，X为估算位置信息，

可选的，优化模块，具体用于通过公式x

其中，x

可选的，优化后的位置信息为移动终端在前一时刻的位置信息；

所述装置还包括：

预测模块，用于在通过迭代优化算法，对估算位置信息进行优化，得到优化后的位置信息之后，基于优化后的位置信息，通过卡尔曼滤波算法，预测移动终端当前时刻的位置信息；

校正模块，用于对预测的当前时刻的位置信息进行校正，得到校正后的位置信息。

可选的，预测模块，具体用于通过公式：

其中，

校正模块，具体用于通过公式：

其中，y

可选的，预测模块，具体用于通过公式

其中，

可选的，校正模块，具体用于通过公式：

其中，

本发明实施例还提供一种定位设备，包括处理器、通信接口、存储器和通信总线，其中，处理器，通信接口，存储器通过通信总线完成相互间的通信；

存储器，用于存放计算机程序；

处理器，用于执行存储器上所存放的程序时，实现第一方面所述的方法步骤。

本发明实施例还提供了一种计算机可读存储介质，该计算机可读存储介质内存储有计算机程序，所述计算机程序被处理器执行时实现上述第一方面所述的方法步骤。

本发明实施例还提供了一种包含指令的计算机程序产品，当其在计算机上运行时，使得计算机执行上述第一方面所述的方法步骤。

本发明实施例有益效果：

本发明实施例提供的定位方法、装置及设备，通过获取移动终端的初始位置信息，以及各个基站的位置信息；根据移动终端的初始位置信息和各个基站的位置信息，计算移动终端分别与各个基站的距离；基于各个基站的位置信息以及移动终端分别与各个基站的距离，计算移动终端的估算位置信息；通过迭代优化算法，对估算位置信息进行优化，得到优化后的位置信息。能够先对获取的初始位置信息，基于各个基站的位置信息以及移动终端分别与各个基站的距离，计算移动终端的估算位置信息，然后，对得到的估算位置信息进一步迭代优化，得到优化后的位置信息，如此，能够使得确定的移动终端的位置信息更加准确，提高对移动终端定位的精度。

当然，实施本发明的任一产品或方法并不一定需要同时达到以上所述的所有优点。

附图说明

为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，还可以根据这些附图获得其他的实施例。

图1为本发明实施例提供的定位方法的一种流程图；

图2为本发明实施例提供的定位方法的另一种流程图；

图3为本发明实施例中增强现实构建平台ARCore坐标系示意图；

图4为本发明实施例提供的定位装置的一种结构示意图；

图5为本发明实施例提供的定位装置的另一种结构示意图；

图6为本发明实施例提供的定位设备的结构示意图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员基于本申请所获得的所有其他实施例，都属于本发明保护的范围。

针对基站的定位大多是通过测量信号到达时间(Time Of Arrival，TOA),到达时间差(Time Difference Of Arrival，TDOA)，接收信号强度(Received Signal StrengthIndicator，RSSI)、到达角(Angle Of Arrival，AOA)以及这几类参量的混合参数(如TOA/AOA,TDOA/AOA)等特征参数来估计目标位置。基于TOA的定位算法通过信号到达时间计算节点间距离，但是需要严格的时间同步，增加了硬件实现的成本和难度。为了降低对时间同步的要求，广泛使用TDOA计算距离信息。且当目标处于移动状态的时候，如何持续的对目标跟踪，将其过去的信息与现在的信息有效联系起来就需要新的算法来实现。

本发明实施例提供了一种定位方法，具体地可以是室内环境中的定位方法，以提高对定位精度，另外，还可以实现持续地目标跟踪，也可以理解为目标在动态过程中的定位。

下面对本发明实施例提供的定位方法进行详细说明。

本发明实施例提供的定位方法的执行主体可以电子设备，具体地电子设备可以包括服务器、终端，等等。

本发明实施例提供了一种定位方法，可以包括：

获取移动终端的初始位置信息，以及各个基站的位置信息；

根据移动终端的初始位置信息和各个基站的位置信息，计算移动终端分别与各个基站的距离；

基于各个基站的位置信息以及移动终端分别与各个基站的距离，计算移动终端的估算位置信息；

通过迭代优化算法，对估算位置信息进行优化，得到优化后的位置信息。

本发明实施例中，通过获取移动终端的初始位置信息，以及各个基站的位置信息；根据移动终端的初始位置信息和各个基站的位置信息，计算移动终端分别与各个基站的距离；基于各个基站的位置信息以及移动终端分别与各个基站的距离，计算移动终端的估算位置信息；通过迭代优化算法，对估算位置信息进行优化，得到优化后的位置信息。能够先对获取的初始位置信息，基于各个基站的位置信息以及移动终端分别与各个基站的距离，计算移动终端的估算位置信息，然后，对得到的估算位置信息进一步迭代优化，得到优化后的位置信息，如此，能够使得确定的移动终端的位置信息更加准确，提高对移动终端定位的精度。

图1为本发明实施例提供的定位方法的一种流程图，参见图1，本发明实施例提供的定位方法，可以包括：

S101，获取移动终端的初始位置信息，以及各个基站的位置信息。

位置信息可以通过坐标来表示。例如，移动终端的坐标为x(x，y)，各个基站的坐标为x

S102，根据移动终端的初始位置信息和各个基站的位置信息，计算移动终端分别与各个基站的距离。

一种可实现方式中，移动终端到各个基站的距离r

S103，基于各个基站的位置信息以及移动终端分别与各个基站的距离，计算移动终端的估算位置信息。

一种可实现方式中，可以针对各个序列组合，构建Cayley-Menger行列式，其中，序列组合是移动终端与所有n个基站中的n-1个基站排列组合得到的；针对各个序列组合对应的Cayley-Menger行列式，计算移动终端与相关基站的距离，相关基站为序列组合所包括的基站。

针对每个序列组合，对序列组合得到的移动终端与相关基站的距离，通过公式：

其中，R

对每个序列组合得到估算值，通过公式

其中，X为估算位置信息，

具体地，假设参考基站为x

d

其中，r

Cayley-Menger行列式在距离几何中被广泛使用，首先需要建立Cayley-Menger矩阵，它由两个n点序列(p

d(p

例如，基站x

对于序列组合(x,x

同理，可对序列组合(x,x

对于每一个序列组合的残差平方和R

通过最小二乘法可以求得

S104，通过迭代优化算法，对估算位置信息进行优化，得到优化后的位置信息。

一种可实现方式中，可以通过公式x

其中，x

对一维多元函数f

其中，梯度向量

所以每次迭代过程中x

HΔx+G＝0

‖HΔx+G‖

其中，

x

本发明实施例中，能够先对获取的初始位置信息，基于各个基站的位置信息以及移动终端分别与各个基站的距离，计算移动终端的估算位置信息，然后，对得到的估算位置信息进一步迭代优化，得到优化后的位置信息，如此，能够使得确定的移动终端的位置信息更加准确，提高对移动终端定位的精度。本发明根据距离几何关系的性质，提出一种基于Cayley-Menger行列式的最小残差加权方法来抑制NLOS的影响，使用Cayley-Menger行列式得到距离估计，再进行残差加权来抑制NLOS误差影响得到初始位置，最后通过修正牛顿迭代以解决Hessian构造矩阵非正定和奇异导致算法失效的问题得到最终的位置估计值，能够在在未知复杂环境中，抑制NLOS影响带来的定位误差，提高定位精度。

同时，本发明实施例中采用Cayley-Menger行列式的方式求解，行列式的计算相比如一些凸优化求解以及神经网络算法的计算复杂度低，求解速度快，更能满足在移动过程中定位的时效性，同时对多个结果进行残差加权的方式来克服NLOS误差带来的影响，以提高定位精度，能够实现低复杂度且高效的室内定位。

一种可选的实施例中，优化后的位置信息为移动终端在前一时刻的位置信息；

在S104之后，如图2所示，还可以包括：

S105，基于优化后的位置信息，通过卡尔曼滤波算法，预测移动终端当前时刻的位置信息。

S106，对预测的当前时刻的位置信息进行校正，得到校正后的位置信息。

一种可实现方式中，通过公式：

其中，

对预测的当前时刻的位置信息进行校正，得到校正后的位置信息，包括：

通过公式：

其中，y

通过上述实施例得到移动终端一时刻时的位置信息，为了实现在移动终端移动过程对移动终端进行跟踪，本发明实施例中，可以理解为上述实施例得到的是初始定位点，之后可以通过自适应的卡尔曼滤波方法对目标进行动态跟踪，即可以理解为在移动终端处于移动状态的时候，持续的对移动终端进行跟踪定位。

对目标进行动态定位和跟踪，需要根据运动状态建立状态转换方程，离散的运动状态转换方程如下所示：

x

其中，状态向量x

运动的观测方程可以表示为：

y

测量关系矩阵

卡尔曼滤波的预测过程如下：

卡尔曼滤波的校正过程如下：

ARCore(增强现实构建平台)可以使用不同的应用程序接口让移动终端如手机感知其环境，可以跟踪其相对于现实世界环境中的位置。步行者航位推算技术(PedestrianDead Reckoning,PDR)是通过惯性测量单元(Inertial Measurement Unit，IMU)感知物体在移动过程中的加速度、角速度、磁力和压力等数据，并使用这些数据对物体移动过程中的步数、步长以及航向角进行测量与统计。

手机的方向并不总是指向正北方向，ARCore在启动时就将当前手机所指向的方向定义为x轴正方向，并以此建立右手坐标系，中指方向定义为z轴的正方向，y轴方向为食指所指方向，原点为手机位置。定义角度

ARCore坐标系确立之后需要将其映射到XOY(NOE，X(E)，Y(N))坐标系中，xoz坐标系在XOY坐标系中如图3所示，映射关系可以使用坐标旋转公式确定，映射公式如式：

增强现实技术的ARCore并不能持续对当前环境进行特征点捕捉，当所处环境不足以支持特征点提取进行位置感知时ARCore将失效，ARCore状态有效性可以表示为公式：

本发明实施例中可以通过第k2-1次的卡尔曼滤波最优估计值，并结合第k2、k2-1次的ARCore或者PDR输出值对第k2次的卡尔曼滤波预测值矩阵和观测值矩阵进行重构。

可以通过公式

其中，

对预测的当前时刻的位置信息进行校正，得到校正后的位置信息，包括：

通过公式：

其中，

另外，可以根据每n次的测量输出值倾斜角的方差决定是否对ARCore的初始方向角

对跟踪过程中n次自适应卡尔曼滤波最优估计测量的n-1段求倾斜角的方差D(θ)，根据方差大小及n次ARCore行进距离决定是否对初始方向角

其中，

本发明实施例提供了基于视觉辅助的时差定位和目标跟踪的方式，可以在未知的复杂环境中，减小NLOS误差对定位精度的影响，提升了视距传输下的室内定位和目标跟踪精度。结合增强现实的视觉辅助和步行者航位推算技术，提出重构卡尔曼滤波的观测值和预测值的自适应算法对目标进行动态定位和跟踪。

对应于上述实施例提供的定位方法，本发明实施例还提供了一种定位装置，如图4所示，可以包括：

获取模块401，用于获取移动终端的初始位置信息，以及各个基站的位置信息；

计算模块402，用于根据移动终端的初始位置信息和各个基站的位置信息，计算移动终端分别与各个基站的距离；基于各个基站的位置信息以及移动终端分别与各个基站的距离，计算移动终端的估算位置信息；

优化模块403，用于通过迭代优化算法，对估算位置信息进行优化，得到优化后的位置信息。

可选的，计算模块402，具体用于针对各个序列组合，构建Cayley-Menger行列式，其中，其中，序列组合是移动终端与所有n个基站中的n-1个基站排列组合得到的；针对各个序列组合对应的Cayley-Menger行列式，计算移动终端与相关基站的距离，相关基站为序列组合所包括的基站。

可选的，计算模块402，具体用于针对每个序列组合，对序列组合得到的移动终端与相关基站的距离，通过公式：

其中，R

对每个序列组合得到估算值，通过公式

其中，X为估算位置信息，

可选的，优化模块403，具体用于通过公式x

其中，x

可选的，优化后的位置信息为移动终端在前一时刻的位置信息；

如图5所示，装置还包括：

预测模块501，用于在通过迭代优化算法，对估算位置信息进行优化，得到优化后的位置信息之后，基于优化后的位置信息，通过卡尔曼滤波算法，预测移动终端当前时刻的位置信息；

校正模块502，用于对预测的当前时刻的位置信息进行校正，得到校正后的位置信息。

可选的，预测模块501，具体用于通过公式：

其中，

校正模块502，具体用于通过公式：

其中，y

可选的，预测模块501，具体用于通过公式

其中，

ΔX

可选的，校正模块502，具体用于通过公式：

其中，

本发明实施例提供的定位装置是应用上述定位方法的装置，则上述定位方法的所有实施例均适用于该装置，且均能达到相同或相似的有益效果。

本发明实施例还提供了一种定位设备，如图6所示，包括处理器601、通信接口602、存储器603和通信总线604，其中，处理器601，通信接口602，存储器603通过通信总线604完成相互间的通信。

存储器603，用于存放计算机程序；

处理器601，用于执行存储器603上所存放的程序时，实现上述实施例中定位方法的方法步骤。

上述定位设备提到的通信总线可以是外设部件互连标准(Peripheral ComponentInterconnect，PCI)总线或扩展工业标准结构(Extended Industry StandardArchitecture，EISA)总线等。该通信总线可以分为地址总线、数据总线、控制总线等。为便于表示，图中仅用一条粗线表示，但并不表示仅有一根总线或一种类型的总线。

通信接口用于上述定位设备与其他设备之间的通信。

存储器可以包括随机存取存储器(Random Access Memory，RAM)，也可以包括非易失性存储器(Non-Volatile Memory，NVM)，例如至少一个磁盘存储器。可选的，存储器还可以是至少一个位于远离前述处理器的存储装置。

上述的处理器可以是通用处理器，包括中央处理器(Central Processing Unit，CPU)、网络处理器(Network Processor，NP)等；还可以是数字信号处理器(Digital SignalProcessor，DSP)、专用集成电路(Application Specific Integrated Circuit，ASIC)、现场可编程门阵列(Field-Programmable Gate Array，FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。

在本发明提供的又一实施例中，还提供了一种计算机可读存储介质，该计算机可读存储介质内存储有计算机程序，所述计算机程序被处理器执行时实现上述实施例中定位方法的方法步骤。

在本发明提供的又一实施例中，还提供了一种包含指令的计算机程序产品，当其在计算机上运行时，使得计算机执行上述实施例中定位方法的方法步骤。

在上述实施例中，可以全部或部分地通过软件、硬件、固件或者其任意组合来实现。当使用软件实现时，可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令。在计算机上加载和执行所述计算机程序指令时，全部或部分地产生按照本发明实施例所述的流程或功能。所述计算机可以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中，或者从一个计算机可读存储介质向另一个计算机可读存储介质传输，例如，所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(DSL))或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质，(例如，软盘、硬盘、磁带)、光介质(例如，DVD)、或者半导体介质(例如固态硬盘Solid State Disk(SSD))等。

需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。

本说明书中的各个实施例均采用相关的方式描述，各个实施例之间相同相似的部分互相参见即可，每个实施例重点说明的都是与其他实施例的不同之处。尤其，对于装置、设备、计算机可读存储介质以及计算机程序产品实施例而言，由于其基本相似于方法实施例，所以描述的比较简单，相关之处参见方法实施例的部分说明即可。

以上所述仅为本发明的较佳实施例，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等，均包含在本发明的保护范围内。