一种定位方法、装置、电子设备及存储介质转让专利
申请号 : CN202010138839.7
文献号 : CN111263299B
文献日 : 2021-04-23
发明人 : 陈香 , 张磊 , 张旭 , 曹帅
申请人 : 中国科学技术大学
摘要 :
权利要求 :
1.一种定位方法,其特征在于,方法包括:接收第一基站发送的第一信号以及第二基站发送的第二信号;
根据接收到所述第一信号与第二信号的时间差,计算被测目标与所述第一基站以及与所述第二基站之间距离的距离差量测值;
获取所述被测目标相对于所述第一基站的第一量测速度以及相对于所述第二基站的第二量测速度;
根据所述距离差量测值、第一量测速度以及第二量测速度得到一个以上的量测坐标;
计算所述一个以上的量测坐标所围成区域内每一坐标点对应的估计函数,所述被测目标的位置为最小的估计函数对应的坐标点,包括:分别计算每一所述坐标点与所述第一基站以及与所述第二基站之间距离的距离差值;
分别计算每一所述坐标点相对于所述第一基站的第一速度以及相对于所述第二基站的第二速度;
根据所述距离差值、第一速度、第二速度计算每一所述坐标点对应的估计函数;
记录最小的估计函数对应的坐标点为被测目标的坐标;其中,所述估计函数为:其中, 表示所述被测目标的坐标位置,wm、wn均表示权重,m、n均表示基站的编号,N表示基站总数, 和dm1,k分别表示k时刻所述被测目标与所述第一基站和第二基站的所述距离差量测值和距离差值, 和vn,k分别表示所述被测目标相对于各基站的测量速度和真实速度,当n=1时, 表示所述第一量测速度,vn,k表示所述被测目标相对于所述第一基站的第一速度,当n=2...,N时, 表示所述第二量测速度,vn,k表示所述被测目标相对于第二基站的第二速度。
2.根据权利要求1所述的方法,其特征在于,所述根据所述距离差量测值、第一量测速度以及第二量测速度得到一个以上的量测坐标,包括:获取前一时刻所述被测目标的位置、所述第一基站的坐标以及所述第二基站的坐标;
根据所述距离差量测值、第一量测速度、第二量测速度、前一时刻被测目标的位置、第一基站的坐标以及第二基站的坐标计算所述一个以上的量测坐标。
3.根据权利要求2所述的方法,其特征在于,所述第二基站的数量为一个及以上,计算所述一个以上的量测坐标的公式为:其中,所述一个以上的量测坐标为(xk,yk),所述第一基站的位置S1的坐标为(x1,y1),所述第二基站的位置Sm的坐标为(xm,ym),h1、hm分别表示已知的当前时刻所述被测目标与所述第一基站和所述第二基站的垂直高度差,Pk、Pk‑1分别表示当前时刻及前一时刻所述被测目标的位置, 表示当前时刻所述距离差量测值,R1,k、Rm,k分别表示在当前时刻tk所述被测目标与所述第一基站和所述第二基站之间的距离,N表示基站总
数,RVD1,k、RVDm,k分别表示单位时间内所述被测目标相对于所述第一基站和第二基站的移动距离, 表示所述
第一量测速度, 表示第m个所述第二基站的所述第二量测速度。
4.根据权利要求1所述的方法,其特征在于,所述方法还包括:以所述一个以上的量测坐标为边界点,在所述一个以上的量测坐标的所属坐标系中获取包含所述边界点的最大矩形区域并获取所述最大矩形内的每一坐标点。
5.根据权利要求1所述的方法,其特征在于,所述第一信号、第二信号为音频信号。
6.一种装置,其特征在于,包括:信号接收模块,用于接收第一基站发送的第一信号以及第二基站发送的第二信号;
距离差计算模块,用于根据接收到所述第一信号与第二信号的时间差,计算被测目标与所述第一基站以及与所述第二基站之间距离的距离差量测值;
相对速度获取模块,用于获取所述被测目标相对于所述第一基站的第一量测速度以及相对于所述第二基站的第二量测速度;
量测坐标计算模块,用于根据所述距离差量测值、第一量测速度以及第二量测速度得到一个以上的量测坐标;
坐标定位模块,用于计算所述一个以上的量测坐标所围成区域内每一坐标点对应的估计函数,所述被测目标的位置为最小的估计函数对应的坐标点;
所述坐标定位模块包括:
距离差值计算单元,用于分别计算每一所述坐标点与所述第一基站以及与所述第二基站之间距离的距离差值;
速度计算单元,用于分别计算每一所述坐标点相对于所述第一基站的第一速度以及相对于所述第二基站的第二速度;
函数估计单元,用于根据所述距离差值、第一速度、第二速度计算每一所述坐标点对应的估计函数;
坐标确定单元,用于记录最小的估计函数对应的坐标点为被测目标的坐标;
其中,所述估计函数为:
其中, 表示所述被测目标的坐标位置,wm、wn均表示权重,m、n均表示基站的编号,N表示基站总数, 和dm1,k分别表示k时刻所述被测目标与所述第一基站和第二基站的所述距离差量测值和距离差值, 和vn,k分别表示所述被测目标相对于各基站的测量速度和真实速度,当n=1时, 表示所述第一量测速度,vn,k表示所述被测目标相对于所述第一基站的第一速度,当n=2...,N时, 表示所述第二量测速度,vn,k表示所述被测目标相对于第二基站的第二速度。
7.一种电子设备,包括:存储器,处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时,实现权利要求1至5中的任一项所述的方法中的各个步骤。
8.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时,实现权利要求1至5中的任一项所述的方法中的各个步骤。
说明书 :
一种定位方法、装置、电子设备及存储介质
技术领域
背景技术
对室内精确定位的解决方案还处于研究阶段。
TDOA)的定位方法和基于到达时间(Time of Arrival,简称TOA)的定位方法等。其中,指纹
法需要建立和维护指纹库,实现难度大,定位精度低,且后期维护成本高;基于方向角的定
位方法硬件成本较高;基于TDOA和TOA的定位方法分别可以实现高精度的室内定位,但两者
相比,基于TOA的定位方法需要更严格的时钟同步条件。
能将会显著下降。Taylor算法需要有先验条件,即一个初始值,才能保证算法收敛,该算法
计算量大,且最终的定位精度依赖于初始值的选取。上述方法均受使用条件的限制,性能表
现不足。
发明内容
标与所述第一基站以及与所述第二基站之间距离的距离差量测值;获取所述被测目标相对
于所述第一基站的第一量测速度以及相对于所述第二基站的第二量测速度;根据所述距离
差量测值、第一量测速度以及第二量测速度得到一个以上的量测坐标;计算所述一个以上
的量测坐标所围成区域内每一坐标点对应的估计函数,所述被测目标的位置为最小的估计
函数对应的坐标点。
第二基站的坐标;根据所述距离差量测值、第一量测速度、第二量测速度、前一时刻被测目
标的位置、第一基站的坐标以及第二基站的坐标计算所述一个以上的量测坐标。
与所述第一基站和所述第二基站的垂直高度差,Pk、Pk‑1分别表示当前时刻及前一时刻所述
被测目标的位置, 表示当前时刻所述距离差量测值,R1,k、Rm,k分别表示在当前时刻tk
所述被测目标与所述第一基站和所述第二基站之间的距离,
m=2,3,...,N,N表示基站总数,
RVD1,k、RVDm,k分别表示单位时间内所述被测目标相对于所述第一基站和第二基站的移动距
离,
点与所述第一基站以及与所述第二基站之间距离的距离差值;分别计算每一所述坐标点相
对于所述第一基站的第一速度以及相对于所述第二基站的第二速度;根据所述距离差值、
第一速度、第二速度计算每一所述坐标点对应的估计函数;记录最小的估计函数对应的坐
标点为被测目标的坐标。
的所述距离差量测值和距离差值, 和vn,k分别表示所述被测目标相对于各基站的测量
速度和真实速度,当n=1时, 表示所述第一测量速度,vn,k表示所述被测目标相对于所
述第一基站的第一速度,当n=2…,N时, 表示所述第二测量速度,vn,k表示所述被测目
标相对于第二基站的第二速度。
第一信号与第二信号的时间差,计算被测目标与所述第一基站以及与所述第二基站之间距
离的距离差量测值;相对速度获取模块,用于获取所述被测目标相对于所述第一基站的第
一量测速度以及相对于所述第二基站的第二量测速度;量测坐标计算模块,用于根据所述
距离差量测值、第一量测速度以及第二量测速度得到一个以上的量测坐标;坐标定位模块,
用于计算所述一个以上的量测坐标所围成区域内每一坐标点对应的估计函数,所述被测目
标的位置为最小的估计函数对应的坐标点。
中的任一项所述的方法中的各个步骤。
Volecity,简称RV),将位置估计转化成一个求解非线性最优化函数的数学模型问题,通过
模型求解获得多个边界估计位置坐标,对这些边界位置坐标围成的有限矩形区域进行局部
地数值搜索,获得最终的目标坐标,该方法具备定位精度高、稳定性好以及对发射基站数量
要求少的特点。相比传统的基于TDOA的定位方法需要两个TDOA信息(即需要三个基站获
得),本方法需要的TDOA信息更少,鲁棒性更高。
附图说明
具体实施方式
避免不必要地混淆本公开的概念。
出。在此使用的术语“包括”、“包含”等表明了所述特征、步骤、操作和/或部件的存在,但是
并不排除存在或添加一个或多个其他特征、步骤、操作或部件。
含义,而不应以理想化或过于刻板的方式来解释。
专用计算机或其他可编程数据处理装置的处理器,从而这些指令在由该处理器执行时可以
获取用于实现这些方框图和/或流程图中所说明的功能/操作的装置。
计算机程序产品可供指令执行系统使用或者结合指令执行系统使用。在本公开的上下文
中,计算机可读介质可以是能够包含、存储、传送、传播或传输指令的任意介质。例如,计算
机可读介质可以包括但不限于电、磁、光、电磁、红外或半导体系统、装置、器件或传播介质。
计算机可读介质的具体示例包括:磁存储装置,如磁带或硬盘(HDD);光存储装置,如光盘
(CD‑ROM);存储器,如随机存取存储器(RAM)或闪存;和/或有线/无线通信链路。
一信号和第二信号的到达时刻,进一步的,计算出第一信号和第二信号的到达时间差。
被测目标与第一基站以及与第二基站之间距离的距离差量测值。
算得到。根据定位系统计算被测目标相对速度的方法很多,且计算方法为本领域的公知常
识,在此不作赘述。
标。
二基站的垂直高度差,Pk、Pk‑1分别表示当前时刻及前一时刻被测目标的位置, 表示当
前时刻距离差量测值,R1,k、Rm,k分别表示在当前时刻tk被测目标与第一基站和第二基站之
间的距离, m=2,3,...,N,N表示基站总
数,RVD1,k、RVDm,k分别表示单位时间内被测目标相对于第一基站和第二基站的移动距离,
建被测目标坐标的计算模型,通过解各计算模型,获取多个被测目标的量测坐标。
所有坐标点进行局部搜索,以获取被测目标的坐标。
间的距离,第一基站的坐标为(x1,y1),第二基站的坐标为(xm,ym),dm1,k表示当前时刻距离差
值,则:
刻被测目标相对于第一基站的第一速度,n=2…,N时,Sn表示第二基站的坐标位置,vn,k表
示当前时刻被测物体相对于第二基站的第二速度。
值和距离差值, 和vn,k分别表示被测目标相对于各基站的测量速度和真实速度,当n=1
时, 表示第一测量速度,vn,k表示被测目标相对于第一基站的第一速度,当n=2…,N时,
表示第二测量速度,vn,k表示被测目标相对于第二基站的第二速度。
位置估计转化成一个求解非线性最优化函数的数学模型问题,通过模型求解获得多个边界
估计位置坐标,对这些边界位置坐标围成的有限矩形区域进行局部地数值搜索,获得最终
的目标坐标,该方法具备定位精度高、稳定性好以及对发射基站数量要求少的特点。相比传
统的基于TDOA的定位方法需要两个TDOA信息(即两个距离差测量值,至少需要三个发射基
站获得),本方法需要的TDOA信息更少,在更少的基站的前提下,实现定位的可能性更高,鲁
棒性更好。
标。图2示出了该计算模型的二维原理图,基于该计算模型,可得到上述步骤S42中一个以上
量测坐标的计算公式1~4。
式1~3进行详细描述。
坐标围成的区域内搜索坐标可抽象为二维图像表示,如图6所示,从 点出
发,以步长d分别向x轴、y轴步进,向各所述一个以上的坐标靠近,将靠近过程中可能经过的
全部坐标点即为量测坐标围成的区域内的每一坐标点,计算一个以上的量测坐标所围成区
域内每一坐标点对应的估计函数,被测目标的位置为最小的估计函数对应的坐标点。其中,
步长d可根据实际定位精度要求来选取,例如可以选
取为1cm。
模块可以被拆分成多个模块。或者,这些模块中的一个或多个模块的至少部分功能可以与
其他模块的至少部分功能相结合,并在一个模块中实现。根据本发明的实施例,信号接收模
块710、距离差计算模块720、相对速度获取模块730、量测坐标计算模块740及坐标定位模块
750中的至少一个可以至少被部分地实现为硬件电路,例如现场可编程门阵列(FPGA)、可编
程逻辑阵列(PLA)、片上系统、基板上的系统、封装上的系统、专用集成电路(ASIC),或可以
以对电路进行集成或封装的任何其他的合理方式等硬件或固件来实现,或以软件、硬件以
及固件三种实现方式的适当组合来实现。或者,信号接收模块710、距离差计算模块720、相
对速度获取模块730、量测坐标计算模块740及坐标定位模块750中的至少一个可以至少被
部分地实现为计算机程序模块,当该程序被计算机运行时,可以执行相应模块的功能。
速度RV,将位置估计转化成一个求解非线性最优化函数的数学模型问题,通过模型求解获
得多个边界估计位置坐标,对这些边界位置坐标围成的有限矩形区域进行局部地数值搜
索,获得最终的目标坐标,该装置具备定位精度高、稳定性好以及对发射基站数量要求少的
特点。相比传统的基于TDOA的定位方法需要两个TDOA信息(即两个距离差测量值,至少需要
三个基站获得),本装置需要的TDOA信息更少,鲁棒性更高。
途的板载存储器。处理器810可以是用于执行根据本公开实施例的方法流程的不同动作的
单一处理单元或者是多个处理单元。
器件或传播介质。可读存储介质的具体示例包括:磁存储装置,如磁带或硬盘(HDD);光存储
装置,如光盘(CD‑ROM);存储器,如随机存取存储器(RAM)或闪存;和/或有线/无线通信链
路。
方法或其任何变形。
821A、模块821B、……。应当注意,模块的划分方式和个数并不是固定的,本领域技术人员可
以根据实际情况使用合适的程序模块或程序模块组合,当这些程序模块组合被处理器810
执行时,使得处理器810可以执行根据本公开实施例的方法或其任何变形。
算机程序模块,其在被处理器810执行时,可以实现上面描述的相应操作。
不脱离本公开精神和教导的情况下,本公开的各个实施例和/或权利要求中记载的特征可
以进行多种组合和/或结合。所有这些组合和/或结合均落入本公开的范围。
可以对本公开进行形式和细节上的多种改变。因此,本公开的范围不应该限于上述实施例,
而是应该不仅由所附权利要求来进行确定,还由所附权利要求的等同物来进行限定。