CN109541541B - 一种室内三角定位精度修正方法及装置 - Google Patents

一种室内三角定位精度修正方法及装置 Download PDF

Info

Publication number
CN109541541B
CN109541541B CN201811585521.2A CN201811585521A CN109541541B CN 109541541 B CN109541541 B CN 109541541B CN 201811585521 A CN201811585521 A CN 201811585521A CN 109541541 B CN109541541 B CN 109541541B
Authority
CN
China
Prior art keywords
anchor
anchor node
node
positioning
signal
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201811585521.2A
Other languages
English (en)
Other versions
CN109541541A (zh
Inventor
霍颖瑜
钟刚
邹穗萍
梁欣荣
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong Liz Technologies Co ltd
Original Assignee
Guangdong Liz Technologies Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangdong Liz Technologies Co ltd filed Critical Guangdong Liz Technologies Co ltd
Priority to CN201811585521.2A priority Critical patent/CN109541541B/zh
Publication of CN109541541A publication Critical patent/CN109541541A/zh
Application granted granted Critical
Publication of CN109541541B publication Critical patent/CN109541541B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/10Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements, e.g. omega or decca systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0205Details
    • G01S5/021Calibration, monitoring or correction

Abstract

本发明公开了一种室内三角定位精度修正方法及装置,通过被测节点与多个锚节点构造三角定位模型,修正被测节点接收到锚节点信号精度,根据被测节点的状态调整锚节点信号,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标,三角定位模型根据修正后的锚节点坐标进行定位,根据被测节点的状态自适应的调整锚节点信号,无论是在被测节点的移动状态或者静止状态,都能够相应修正获取到锚节点的定位信号的精度,有效的防止了在运动过程中的误定位,提高了定位的精度,保证了定位服务的稳定性质量,具有很强的鲁棒性。

Description

一种室内三角定位精度修正方法及装置
技术领域
本公开涉及无线定位技术领域,具体涉及一种室内三角定位精度修正方法及装置。
背景技术
在室内的定位和导航技术中,一般通过UWB传感器、AP、Wi-Fi等定位技术,现有的很多需求场景都需要精确定位到厘米级以下,通过这些锚点对用户进行室内定位,并且利用Wi-Fi热点进行室内定位,三角定位即三边测量法定位是计算坐标的最基本途径,其基本原理是求三个半径和圆心坐标已知的圆弧的交点。三角测量法适用于基于AOA测角的目标定位,被测节点与两个锚节点可以构成一个三角形,两个锚节点之间的距离是已知的,通过AOA测角又测量出了该三角形的两个角,故通过三角运算可以确定被测节点的坐标。在此种精度要求以下的导航技术,在某些高速度高要求的情况下,由于惯性或者数据峰值问题可能会导致三角定位出现误差,如何高效的去除定位精度噪声是一个有待解决的问题。
发明内容
本公开提供一种室内三角定位精度修正方法及装置,根据被测节点的状态自适应的调整锚节点信号,无论是在被测节点的移动状态或者静止状态,都能够相应修正获取到锚节点的定位信号的精度,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标。
为了实现上述目的,根据本公开的一方面,提供一种室内三角定位精度修正方法,所述方法包括以下步骤:
步骤1,通过被测节点与多个锚节点构造三角定位模型;
步骤2,修正被测节点接收到锚节点信号精度;
步骤3,根据被测节点的状态调整锚节点信号;
步骤4,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标;
步骤5,三角定位模型根据修正后的锚节点坐标进行定位。
进一步地,在步骤1中,通过被测节点与多个锚节点构造三角定位模型的方法为以下步骤,当待定位区域中包含已知位置的3个以上锚节点时,设各已知位置锚节点的坐标为(x1,y1),(x2,y2),…,(xk,yk),k为锚节点的数量,而未知的被测节点坐标为(x,y),被测节点到各已知位置的锚节点的距离分别为d1,d2,…dk,则可建立以下方程组:
Figure BDA0001918987450000021
从第一个方程开始,分别减去最后一个方程得:
Figure BDA0001918987450000022
简化线性方程组为三角定位模型,Az=b,
其中:
Figure BDA0001918987450000023
Figure BDA0001918987450000024
由于测量过程中存在误差N,利用最小二乘法得到:Q(z)=||b-Az||2,对z求导得:
Figure BDA0001918987450000025
如果AAT非奇异,则三角定位模型为z=(ATA)-1ATb,则可求出被测节点的空间坐标(x,y)。
进一步地,在步骤2中,修正被测节点接收到锚节点信号精度的方法为以下步骤,若锚节点数目为M=3,当M>3时同理可以推广,
设锚节点的定位坐标分别为:U1=(x1,y1),U2=(x2,y2),…,U3=(xM,yM),
步骤2.1,被测节点接收到锚节点信号输入概率为,
Figure BDA0001918987450000026
设Xj(k-1|k-1)为k-1时刻锚节点信号j的状态估计,Pj(k-1|k-1)为相应的状态协方差阵,uk-1(j)为k-1时刻接收到锚节点信号j的概率,其中:i,j=1,2,…M,则交互计算后M个锚节点在k时刻的信号输入:
Figure BDA0001918987450000027
其中:
Figure BDA0001918987450000031
Figure BDA0001918987450000032
步骤2.2,对锚节点信号修正:
将Xoj(k-1|k-1)、Poj(k-1|k-1)作为k时刻第j个锚节点信号的输入,得到相应的锚节点信号输出为Xj(k|k),Pj(k|k);
步骤2.3,锚节点信号可能性计算:
若锚节点信号j量测预测残差为
Figure BDA0001918987450000033
及其协方差阵为
Figure BDA0001918987450000034
在高斯假设条件下,那么锚节点j的可能性计算为:
Figure BDA0001918987450000035
其中:
Figure BDA0001918987450000036
步骤2.4,锚节点信号概率更新:
根据贝叶斯定理给出了锚节点信号j的计算概率,其中j=1,2,…M,
Figure BDA0001918987450000037
其中:
Figure BDA0001918987450000038
步骤2.5,计算状态估计和协方差组合:
设X(k|k),P(k|k)分别为k时刻交互式的输出,则有:
Figure BDA0001918987450000039
Figure BDA00019189874500000310
进一步地,在步骤3中,根据被测节点的状态调整锚节点信号的方法为以下步骤,
由估计状态值和估计误差协方差,将相邻的锚节点的状态估计差值表示为:
Figure BDA00019189874500000311
其中,k时刻对两个锚节点i和j状态估计之差的差值为:
Figure BDA0001918987450000041
则在H0假设下,其联合概率密度函数为:
Figure BDA0001918987450000042
其中
Figure BDA0001918987450000043
是先验信息,
在H0条件下,H0为被测节点处于静止状态,两局部节点在l时刻的估计误差tij(l)服从N[0;Cij(l|l)]分布,Cij(l|l)的定义见式,
Figure BDA0001918987450000044
称方程为假设H0的似然函数。
在H1假设下,H1为被测节点处于运动状态,其联合概率密度函数的似然函数被定义为
Figure BDA0001918987450000045
各锚节点的位置、速度和方向的估计误差均匀地分布于某些可能的区域,即假设
Figure BDA0001918987450000046
在某些区域是服从均匀分布的,则两者的联合概率密度函数的似然函数之比即为,
Figure BDA0001918987450000047
取与上式对应的对数似然比为:
Figure BDA0001918987450000048
定义修正的对数似然比函数为,
Figure BDA0001918987450000049
这里有λij(0)=0。
进一步地,在步骤4中,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标的方法为以下步骤,
若锚节点信号j量测预测残差为
Figure BDA00019189874500000410
及其协方差阵为
Figure BDA00019189874500000411
在高斯分布假设条件下,那么锚节点信号j的偏移可能性计算为:
Figure BDA00019189874500000412
其中:
Figure BDA00019189874500000413
按照高斯分布假设,归一化估计误差平方的各项为,εij(k)=tij(k)'Cij -1(k|k)tij(k),是具有nx自由度的χ2分布,于是λij(k)便是具有knx个自由度的χ2分布随机变量,其均值为knx,方差为2knx,这样便可对H0和H1进行假设检验,即:如果λij(k)≤δ(k);被测节点接收到的已知位置锚节点信号的坐标依次为,(x1,y1),(x2,y2),…,(xM,yM),
根据以下公式进行调整得到修正后的锚节点坐标:
Figure BDA0001918987450000051
其中,i∈U1,j∈U2,则接受假设H0,否则接受假设H1,其中阈值满足,P{λij(k)>δ(k)|H0}=α,α是检验的显著水平,α取0.05。
本发明还提供了一种室内三角定位精度修正装置,所述装置包括:存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序运行在以下装置的单元中:
三角定位模型单元,用于通过被测节点与多个锚节点构造三角定位模型;
信号精度修正单元,用于修正被测节点接收到锚节点信号精度;
状态调整单元,用于根据被测节点的状态调整锚节点信号;
高斯分布归一化单元,用于根据高斯分布归一化定位估计误差得到修正后的锚节点坐标;
定位修正单元,用于三角定位模型根据修正后的锚节点坐标进行定位。
本公开的有益效果为:本发明解决了使用单一的WiFi技术进行室内定位的不足,根据被测节点的状态自适应的调整锚节点信号,无论是在被测节点的移动状态或者静止状态,都能够相应修正获取到锚节点的定位信号的精度,有效的防止了在运动过程中的误定位,提高了定位的精度,保证了定位服务的稳定性质量,具有很强的鲁棒性。
附图说明
通过对结合附图所示出的实施方式进行详细说明,本公开的上述以及其他特征将更加明显,本公开附图中相同的参考标号表示相同或相似的元素,显而易见地,下面描述中的附图仅仅是本公开的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图,在附图中:
图1所示为一种室内三角定位精度修正方法的流程图;
图2所示为一种室内三角定位精度修正装置图。
具体实施方式
以下将结合实施例和附图对本公开的构思、具体结构及产生的技术效果进行清楚、完整的描述,以充分地理解本公开的目的、方案和效果。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
如图1所示为根据本公开的一种室内三角定位精度修正方法的流程图,下面结合图1来阐述根据本公开的实施方式的一种室内三角定位精度修正方法。
本公开提出一种室内三角定位精度修正方法,具体包括以下步骤:
步骤1,通过被测节点与多个锚节点构造三角定位模型;
步骤2,修正被测节点接收到锚节点信号精度;
步骤3,根据被测节点的状态调整锚节点信号;
步骤4,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标;
步骤5,三角定位模型根据修正后的锚节点坐标进行定位。
进一步地,在步骤1中,通过被测节点与多个锚节点构造三角定位模型的方法为以下步骤,当待定位区域中包含已知位置的3个以上锚节点时,设各已知位置锚节点的坐标为(x1,y1),(x2,y2),…,(xk,yk),k为锚节点的数量,而未知的被测节点坐标为(x,y),被测节点到各已知位置的锚节点的距离分别为d1,d2,…dk,则可建立以下方程组:
Figure BDA0001918987450000061
从第一个方程开始,分别减去最后一个方程得:
Figure BDA0001918987450000062
简化线性方程组为三角定位模型,Az=b,
其中:
Figure BDA0001918987450000063
Figure BDA0001918987450000064
由于测量过程中存在误差N,利用最小二乘法得到:Q(z)=||b-Az||2,对z求导得:
Figure BDA0001918987450000065
如果AAT非奇异,则三角定位模型为z=(ATA)-1ATb,则可求出被测节点的空间坐标(x,y)。
进一步地,在步骤2中,修正被测节点接收到锚节点信号精度的方法为以下步骤,若锚节点数目为M=3,当M>3时同理可以推广,
设锚节点的定位坐标分别为:U1=(x1,y1),U2=(x2,y2),…,U3=(xM,yM),
步骤2.1,被测节点接收到锚节点信号输入概率为,
Figure BDA0001918987450000071
设Xj(k-1|k-1)为k-1时刻锚节点信号j的状态估计,Pj(k-1|k-1)为相应的状态协方差阵,uk-1(j)为k-1时刻接收到锚节点信号j的概率,其中:i,j=1,2,…M,则交互计算后M个锚节点在k时刻的信号输入:
Figure BDA0001918987450000072
其中:
Figure BDA0001918987450000073
Figure BDA0001918987450000074
步骤2.2,对锚节点信号修正:
将Xoj(k-1|k-1)、Poj(k-1|k-1)作为k时刻第j个锚节点信号的输入,得到相应的锚节点信号输出为Xj(k|k),Pj(k|k);
步骤2.3,锚节点信号可能性计算:
若锚节点信号j量测预测残差为
Figure BDA0001918987450000075
及其协方差阵为
Figure BDA0001918987450000076
在高斯假设条件下,那么锚节点j的可能性计算为:
Figure BDA0001918987450000077
其中:
Figure BDA0001918987450000078
步骤2.4,锚节点信号概率更新:
根据贝叶斯定理给出了锚节点信号j的计算概率,其中j=1,2,…M,
Figure BDA0001918987450000081
其中:
Figure BDA0001918987450000082
步骤2.5,计算状态估计和协方差组合:
设X(k|k),P(k|k)分别为k时刻交互式的输出,则有:
Figure BDA0001918987450000083
Figure BDA0001918987450000084
进一步地,在步骤3中,根据被测节点的状态调整锚节点信号的方法为以下步骤,
由估计状态值和估计误差协方差,将相邻的锚节点的状态估计差值表示为:
Figure BDA0001918987450000085
其中,k时刻对两个锚节点i和j状态估计之差的差值为:
Figure BDA0001918987450000086
则在H0假设下,其联合概率密度函数为:
Figure BDA0001918987450000087
其中
Figure BDA0001918987450000088
是先验信息,
在H0条件下,H0为被测节点处于静止状态,两局部节点在l时刻的估计误差tij(l)服从N[0;Cij(l|l)]分布,Cij(l|l)的定义见式,
Figure BDA0001918987450000089
称方程为假设H0的似然函数。
在H1假设下,H1为被测节点处于运动状态,其联合概率密度函数的似然函数被定义为
Figure BDA00019189874500000810
各锚节点的位置、速度和方向的估计误差均匀地分布于某些可能的区域,即假设
Figure BDA00019189874500000811
在某些区域是服从均匀分布的,则两者的联合概率密度函数的似然函数之比即为,
Figure BDA00019189874500000812
取与上式对应的对数似然比为:
Figure BDA00019189874500000813
定义修正的对数似然比函数为,
Figure BDA0001918987450000091
这里有λij(0)=0。
进一步地,在步骤4中,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标的方法为以下步骤,
若锚节点信号j量测预测残差为
Figure BDA0001918987450000092
及其协方差阵为
Figure BDA0001918987450000093
在高斯分布假设条件下,那么锚节点信号j的偏移可能性计算为:
Figure BDA0001918987450000094
其中:
Figure BDA0001918987450000095
按照高斯分布假设,归一化估计误差平方的各项为,εij(k)=tij(k)'Cij -1(k|k)tij(k),是具有nx自由度的χ2分布,于是λij(k)便是具有knx个自由度的χ2分布随机变量,其均值为knx,方差为2knx,这样便可对H0和H1进行假设检验,即:如果λij(k)≤δ(k);被测节点接收到的已知位置锚节点信号的坐标依次为,(x1,y1),(x2,y2),…,(xM,yM),
根据以下公式进行调整得到修正后的锚节点坐标:
Figure BDA0001918987450000096
其中,i∈U1,j∈U2,则接受假设H0,否则接受假设H1,其中阈值满足,P{λij(k)>δ(k)|H0}=α,α是检验的显著水平,α取0.05。
本公开的实施例提供的一种室内三角定位精度修正装置,如图2所示为本公开的一种室内三角定位精度修正装置图,该实施例的一种室内三角定位精度修正装置包括:处理器、存储器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述一种室内三角定位精度修正装置实施例中的步骤。
所述装置包括:存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序运行在以下装置的单元中:
三角定位模型单元,用于通过被测节点与多个锚节点构造三角定位模型;
信号精度修正单元,用于修正被测节点接收到锚节点信号精度;
状态调整单元,用于根据被测节点的状态调整锚节点信号;
高斯分布归一化单元,用于根据高斯分布归一化定位估计误差得到修正后的锚节点坐标;
定位修正单元,用于三角定位模型根据修正后的锚节点坐标进行定位。
所述一种室内三角定位精度修正装置可以运行于桌上型计算机、笔记本、掌上电脑及云端服务器等计算设备中。所述一种室内三角定位精度修正装置,可运行的装置可包括,但不仅限于,处理器、存储器。本领域技术人员可以理解,所述例子仅仅是一种室内三角定位精度修正装置的示例,并不构成对一种室内三角定位精度修正装置的限定,可以包括比例子更多或更少的部件,或者组合某些部件,或者不同的部件,例如所述一种室内三角定位精度修正装置还可以包括输入输出设备、网络接入设备、总线等。
所称处理器可以是中央处理单元(Central Processing Unit,CPU),还可以是其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等,所述处理器是所述一种室内三角定位精度修正装置运行装置的控制中心,利用各种接口和线路连接整个一种室内三角定位精度修正装置可运行装置的各个部分。
所述存储器可用于存储所述计算机程序和/或模块,所述处理器通过运行或执行存储在所述存储器内的计算机程序和/或模块,以及调用存储在存储器内的数据,实现所述一种室内三角定位精度修正装置的各种功能。所述存储器可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序(比如声音播放功能、图像播放功能等)等;存储数据区可存储根据手机的使用所创建的数据(比如音频数据、电话本等)等。此外,存储器可以包括高速随机存取存储器,还可以包括非易失性存储器,例如硬盘、内存、插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(SecureDigital,SD)卡,闪存卡(Flash Card)、至少一个磁盘存储器件、闪存器件、或其他易失性固态存储器件。
尽管本公开的描述已经相当详尽且特别对几个所述实施例进行了描述,但其并非旨在局限于任何这些细节或实施例或任何特殊实施例,而是应当将其视作是通过参考所附权利要求考虑到现有技术为这些权利要求提供广义的可能性解释,从而有效地涵盖本公开的预定范围。此外,上文以发明人可预见的实施例对本公开进行描述,其目的是为了提供有用的描述,而那些目前尚未预见的对本公开的非实质性改动仍可代表本公开的等效改动。

Claims (3)

1.一种室内三角定位精度修正方法,其特征在于,所述方法包括以下步骤:
步骤1,通过被测节点与多个锚节点构造三角定位模型;
步骤2,修正被测节点接收到锚节点信号精度;
步骤3,根据被测节点的状态调整锚节点信号;
步骤4,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标;
步骤5,三角定位模型根据修正后的锚节点坐标进行定位;
在步骤2中,修正被测节点接收到锚节点信号精度的方法为以下步骤:若锚节点数目为M=3,当M>3时同理可以推广,
设锚节点的定位坐标分别为:U1=(x1,y1),U2=(x2,y2),…,U3=(xM,yM),
步骤2.1,被测节点接收到锚节点信号输入概率为,
Figure FDA0003837220470000011
设Xj(k-1|k-1)为k-1时刻锚节点信号j的状态估计,Pj(k-1|k-1)为相应的状态协方差阵,uk-1(j)为k-1时刻接收到锚节点信号j的概率,其中:i,j=1,2,…M,则交互计算后M个锚节点在k时刻的信号输入:
Figure FDA0003837220470000012
其中:
Figure FDA0003837220470000013
Figure FDA0003837220470000014
步骤2.2,对锚节点信号修正:
将Xoj(k-1|k-1)、Poj(k-1|k-1)作为k时刻第j个锚节点信号的输入,得到相应的锚节点信号输出为Xj(k|k),Pj(k|k);
步骤2.3,锚节点信号可能性计算:
若锚节点信号j量测预测残差为
Figure FDA0003837220470000021
及其协方差阵为
Figure FDA0003837220470000022
在高斯假设条件下,那么锚节点信号j的偏移可能性计算为:
Figure FDA0003837220470000023
其中:
Figure FDA0003837220470000024
步骤2.4,锚节点信号概率更新:
根据贝叶斯定理给出了锚节点信号j的计算概率,其中j=1,2,…M,
Figure FDA0003837220470000025
其中:
Figure FDA0003837220470000026
步骤2.5,计算状态估计和协方差组合:
设X(k|k),P(k|k)分别为k时刻交互式的输出,则有:
Figure FDA0003837220470000027
Figure FDA0003837220470000028
在步骤3中,根据被测节点的状态调整锚节点信号的方法为以下步骤:
由估计状态值和估计误差协方差,将相邻的锚节点的状态估计差值表示为:
Figure FDA0003837220470000029
其中,k时刻对两个锚节点i和j状态估计之差的差值为:
Figure FDA00038372204700000210
则在H0假设下,其联合概率密度函数为:
Figure FDA00038372204700000211
其中
Figure FDA00038372204700000212
是先验信息,
在H0条件下,H0为被测节点处于静止状态,两局部节点在l时刻的估计误差tij(l) 服从N[0;Cij(l|l)]分布,Cij(l|l)的定义见下式:
Figure FDA0003837220470000031
称方程为假设H0的似然函数,
在H1假设下,H1为被测节点处于运动状态,其联合概率密度函数的似然函数被定义为
Figure FDA0003837220470000032
各锚节点的位置、速度和方向的估计误差均匀地分布于某些区域,即假设
Figure FDA0003837220470000033
在某些区域是服从均匀分布的,则两者的联合概率密度函数的似然函数之比即为,
Figure FDA0003837220470000034
取与上式对应的对数似然比为:
Figure FDA0003837220470000035
定义修正的对数似然比函数为,
Figure FDA0003837220470000036
这里有λij(0)=0;
在步骤4中,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标的方法为以下步骤:
若锚节点信号j量测预测残差为
Figure FDA0003837220470000037
及其协方差阵为
Figure FDA0003837220470000038
在高斯分布假设条件下,那么锚节点信号j的偏移可能性计算为:
Figure FDA0003837220470000039
其中:
Figure FDA00038372204700000310
按照高斯分布假设,归一化估计误差平方的各项为,εij(k)=tij(k)'Cij -1(k|k)tij(k),是具有nx自由度的χ2分布,于是λij(k)便是具有knx个自由度的χ2分布随机变量,其均值为knx,方差为2knx,这样便可对H0和H1进行假设检验,即:如果λij(k)≤δ(k);被测节点接收到的已知位置锚节点信号的坐标依次为,(x1,y1),(x2,y2),…,(xM,yM),
根据以下公式进行调整得到修正后的锚节点坐标:
Figure FDA00038372204700000311
其中,i∈U1,j∈U2,则接受假设H0,否则接受假设H1,其中阈值满足,P{λij(k)>δ(k)|H0}=α,α是检验的显著水平,α取0.05。
2.根据权利要求1所述的一种室内三角定位精度修正方法,其特征在于,在步骤1中,通过被测节点与多个锚节点构造三角定位模型的方法为以下步骤:当待定位区域中包含已知位置的3个以上锚节点时,设各已知位置锚节点的坐标为
Figure FDA0003837220470000041
k为锚节点的数量,而未知的被测节点坐标为(x,y),被测节点到各已知位置的锚节点的距离分别为d1,d2,…dk,则可建立以下方程组:
Figure FDA0003837220470000042
从第一个方程开始,分别减去最后一个方程得:
Figure FDA0003837220470000043
简化线性方程组为三角定位模型,Az=b,
其中:
Figure FDA0003837220470000044
Figure FDA0003837220470000045
由于测量过程中存在误差N,利用最小二乘法得到:Q(z)=||b-Az||2,对z求导得:
Figure FDA0003837220470000046
如果AAT非奇异,则三角定位模型为z=(ATA)-1ATb,则可求出被测节点的空间坐标(x,y)。
3.一种室内三角定位精度修正装置,其特征在于,所述装置包括:存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序运行在以下装置的单元中:
三角定位模型单元,用于通过被测节点与多个锚节点构造三角定位模型;
信号精度修正单元,用于修正被测节点接收到锚节点信号精度;
状态调整单元,用于根据被测节点的状态调整锚节点信号;
高斯分布归一化单元,用于根据高斯分布归一化定位估计误差得到修正后的锚节点坐标;
定位修正单元,用于三角定位模型根据修正后的锚节点坐标进行定位;
在信号精度修正单元中,修正被测节点接收到锚节点信号精度的方法为以下步骤:若锚节点数目为M=3,当M>3时同理可以推广,
设锚节点的定位坐标分别为:U1=(x1,y1),U2=(x2,y2),…,U3=(xM,yM),
步骤2.1,被测节点接收到锚节点信号输入概率为,
Figure FDA0003837220470000051
设Xj(k-1|k-1)为k-1时刻锚节点信号j的状态估计,Pj(k-1|k-1)为相应的状态协方差阵,uk-1(j)为k-1时刻接收到锚节点信号j的概率,其中:i,j=1,2,…M,则交互计算后M个锚节点在k时刻的信号输入:
Figure FDA0003837220470000052
其中:
Figure FDA0003837220470000053
Figure FDA0003837220470000054
步骤2.2,对锚节点信号修正:
将Xoj(k-1|k-1)、Poj(k-1|k-1)作为k时刻第j个锚节点信号的输入,得到相应的锚节点信号输出为Xj(k|k),Pj(k|k);
步骤2.3,锚节点信号可能性计算:
若锚节点信号j量测预测残差为
Figure FDA0003837220470000055
及其协方差阵为
Figure FDA0003837220470000056
在高斯假设条件下,那么锚节点信号j的偏移可能性计算为:
Figure FDA0003837220470000061
其中:
Figure FDA0003837220470000062
步骤2.4,锚节点信号概率更新:
根据贝叶斯定理给出了锚节点信号j的计算概率,其中j=1,2,…M,
Figure FDA0003837220470000063
其中:
Figure FDA0003837220470000064
步骤2.5,计算状态估计和协方差组合:
设X(k|k),P(k|k)分别为k时刻交互式的输出,则有:
Figure FDA0003837220470000065
Figure FDA0003837220470000066
在状态调整单元中,根据被测节点的状态调整锚节点信号的方法为以下步骤:
由估计状态值和估计误差协方差,将相邻的锚节点的状态估计差值表示为:
Figure FDA0003837220470000067
其中,k时刻对两个锚节点i和j状态估计之差的差值为:
Figure FDA0003837220470000068
则在H0假设下,其联合概率密度函数为:
Figure FDA0003837220470000069
其中
Figure FDA00038372204700000610
是先验信息,
在H0条件下,H0为被测节点处于静止状态,两局部节点在l时刻的估计误差tij(l)服从N[0;Cij(l|l)]分布,Cij(l|l)的定义见下式:
Figure FDA00038372204700000611
称方程为假设H0的似然函数,
在H1假设下,H1为被测节点处于运动状态,其联合概率密度函数的似然函数被定义为
Figure FDA0003837220470000071
各锚节点的位置、速度和方向的估计误差均匀地分布于某些区域,即假设
Figure FDA0003837220470000072
在某些区域是服从均匀分布的,则两者的联合概率密度函数的似然函数之比即为,
Figure FDA0003837220470000073
取与上式对应的对数似然比为:
Figure FDA0003837220470000074
定义修正的对数似然比函数为,
Figure FDA0003837220470000075
这里有λij(0)=0;
在高斯分布归一化单元中,根据高斯分布归一化定位估计误差得到修正后的锚节点坐标的方法为以下步骤:
若锚节点信号j量测预测残差为
Figure FDA0003837220470000076
及其协方差阵为
Figure FDA0003837220470000077
在高斯分布假设条件下,那么锚节点信号j的偏移可能性计算为:
Figure FDA0003837220470000078
其中:
Figure FDA0003837220470000079
按照高斯分布假设,归一化估计误差平方的各项为,εij(k)=tij(k)'Cij -1(k|k)tij(k),是具有nx自由度的χ2分布,于是λij(k)便是具有knx个自由度的χ2分布随机变量,其均值为knx,方差为2knx,这样便可对H0和H1进行假设检验,即:如果λij(k)≤δ(k);被测节点接收到的已知位置锚节点信号的坐标依次为,(x1,y1),(x2,y2),…,(xM,yM),
根据以下公式进行调整得到修正后的锚节点坐标:
Figure FDA00038372204700000710
其中,i∈U1,j∈U2,则接受假设H0,否则接受假设H1,其中阈值满足,P{λij(k)>δ(k)|H0}=α,α是检验的显著水平,α取0.05。
CN201811585521.2A 2018-12-24 2018-12-24 一种室内三角定位精度修正方法及装置 Active CN109541541B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811585521.2A CN109541541B (zh) 2018-12-24 2018-12-24 一种室内三角定位精度修正方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811585521.2A CN109541541B (zh) 2018-12-24 2018-12-24 一种室内三角定位精度修正方法及装置

Publications (2)

Publication Number Publication Date
CN109541541A CN109541541A (zh) 2019-03-29
CN109541541B true CN109541541B (zh) 2022-11-08

Family

ID=65857107

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811585521.2A Active CN109541541B (zh) 2018-12-24 2018-12-24 一种室内三角定位精度修正方法及装置

Country Status (1)

Country Link
CN (1) CN109541541B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113038362B (zh) * 2021-02-09 2022-10-11 华为技术有限公司 超宽带定位方法及系统
CN114594421B (zh) * 2022-02-15 2022-11-18 湖北大学 一种基于最小二乘法与卡尔曼滤波器的移动靶点位置计算方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101247650A (zh) * 2008-03-20 2008-08-20 中科院嘉兴中心微系统所分中心 一种在无线传感器网络中基于无线信号强度的节点室内定位方法
CN106226732A (zh) * 2016-07-08 2016-12-14 西安电子科技大学 基于tof及迭代无迹滤波的室内无线定位跟踪方法
CN106707235A (zh) * 2017-03-08 2017-05-24 南京信息工程大学 一种基于改进的无迹卡尔曼滤波的室内测距定位方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105093177B (zh) * 2014-05-14 2017-08-04 中国科学院沈阳自动化研究所 一种基于跳频技术的rssi定位方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101247650A (zh) * 2008-03-20 2008-08-20 中科院嘉兴中心微系统所分中心 一种在无线传感器网络中基于无线信号强度的节点室内定位方法
CN106226732A (zh) * 2016-07-08 2016-12-14 西安电子科技大学 基于tof及迭代无迹滤波的室内无线定位跟踪方法
CN106707235A (zh) * 2017-03-08 2017-05-24 南京信息工程大学 一种基于改进的无迹卡尔曼滤波的室内测距定位方法

Also Published As

Publication number Publication date
CN109541541A (zh) 2019-03-29

Similar Documents

Publication Publication Date Title
CN109275093B (zh) 基于uwb定位与激光地图匹配的定位方法和移动终端
US20230077304A1 (en) Cooperative positioning method and apparatus, device, and storage medium
CN108638062B (zh) 机器人定位方法、装置、定位设备及存储介质
WO2019062734A1 (zh) 基于Wi-Fi热点的室内定位方法及装置
US9958531B2 (en) Determining a location of a wireless device using fingerprinting
CN107132504B (zh) 基于粒子滤波的定位追踪装置、方法及电子设备
CN109541541B (zh) 一种室内三角定位精度修正方法及装置
CN112689775B (zh) 雷达点云聚类方法和装置
WO2016112758A1 (zh) 终端的定位方法及装置
CN113038359B (zh) 定位方法、装置、电子设备以及存储介质
CN109238296B (zh) 一种高精度室内导航方法及装置
CN113189541B (zh) 一种定位方法、装置及设备
WO2019183928A1 (zh) 一种室内机器人定位的方法及机器人
CN106885567B (zh) 一种惯导协作定位方法及定位设备
Hillebrandt et al. Quantitative and spatial evaluation of distance-based localization algorithms
CN109376422A (zh) 一种均匀圆阵优化设计评估方法和装置
CN109769206B (zh) 一种室内定位融合方法、装置、存储介质及终端设备
CN113670253B (zh) 空间目标姿态反演方法、装置、计算设备及存储介质
US20220171024A1 (en) Method, apparatus, and non-transitory computer readable medium for identifying human postures using millimeter-wave radar
WO2023065110A1 (zh) 基站标定方法、计算机设备以及存储介质
CN108981713B (zh) 一种混合无线自适应导航方法及装置
KR101001612B1 (ko) 탐색레이더에서의 정밀 표적탐지방법
CN109121080B (zh) 一种室内定位方法、装置、移动终端及存储介质
CN107250831B (zh) 提供移动装置的前进方向的指示
CN114325577A (zh) 一种非视距定位误差修正方法与装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant