CN110933630A - 基于超宽带通信的室内三维定位方法及装置 - Google Patents
基于超宽带通信的室内三维定位方法及装置 Download PDFInfo
- Publication number
- CN110933630A CN110933630A CN201911182827.8A CN201911182827A CN110933630A CN 110933630 A CN110933630 A CN 110933630A CN 201911182827 A CN201911182827 A CN 201911182827A CN 110933630 A CN110933630 A CN 110933630A
- Authority
- CN
- China
- Prior art keywords
- label
- dimensional
- tag
- base station
- estimated
- 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.)
- Pending
Links
Images
Classifications
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/33—Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-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/10—Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements, e.g. omega or decca systems
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开一种基于超宽带通信的室内三维定位方法及装置,该方法通过获取标签的TDOA原始数据,其中,标签所在的室内场景中预先布置有4个以上超宽带基站,建立空间三维直角坐标系,标签的TDOA原始数据由超宽带基站通过TDOA方式对标签进行定位所得到,利用TDOA原始数据,通过三维空间Chan算法估计得到标签的预估三维位置,对标签的预估三维位置做残值加权处理,将经过处理的标签的预估三维位置作为高斯‑牛顿迭代算法的初值,经迭代运算,得到标签的三维空间位置,能够有效适应室内存在的非视距环境,并为基于超宽带通信的室内三维定位提供了一种合理、高精度的三维定位方案。
Description
技术领域
本发明涉及通信技术领域,尤其涉及一种基于超宽带通信的室内三维定位方法及装置。
背景技术
室内定位随着经济的发展、商业活动的趋室内化的拓展,以及智慧工厂、智能仓储等工业领域自动化、智能化的高要求,逐渐引起国内外学者的广泛关注与研究。基于超宽带通信技术所应用的室内定位的技术,可以概括为四大种类:基于信号到达时间(TOA)、基于信号到达时间差(TDOA)、基于信号衰减强度(RSSI)以及基于信号到达角度(AOA)。由于在室内环境下含有电波的非视距传播效应、多径效应以及多址干扰,因此基于超宽带通信得定位方式多采用TOA/TDOA技术,而TOA定位技术需严格的时间同步,硬件及实际场景中较难实现,所以国内外学者广泛采用TODA方式。由TDOA获得的定位所需测量值所建立的非线性方程组,通常需要变换为线性方程组进行求解。
最早学者们使用最小二乘法研究TDOA定位方式,但其求解值,并非最优解。高斯-牛顿迭代算法能得到较精准的解算结果,收敛速度快、稳健性强,很贴合非线性方程的求解。但其对迭代运算的初始值依赖性很强,需要满足一定准确度的初始值才能获得较高的收敛速度。而当使用高斯-牛顿迭代算法时,选取接近欲求取的真实坐标的临近坐标作为迭代运算的初始值,可以有效防止迭代运算的发散。而Chan算法在视距环境下具有较高精度,且不需初始值,适用于TDOA定位方式,其误差模型所用的零均值高斯噪声,在非视距环境下,受到误差干扰导致精度会有下降。
发明内容
本发明提供一种基于超宽带通信的室内三维定位方法及装置,以解决现有技术在非视距环境下,容易受到误差干扰导致精度下降的问题。
第一方面,本发明提供一种基于超宽带通信的室内三维定位方法,所述方法包括:
获取标签的TDOA原始数据,其中,所述标签所在的室内场景中预先布置有4个以上超宽带基站,建立空间三维直角坐标系,所述标签的TDOA原始数据由所述超宽带基站通过TDOA方式对标签进行定位所得到;
利用所述TDOA原始数据,通过三维空间Chan算法估计得到所述标签的预估三维位置;
对所述标签的预估三维位置做残值加权处理;
将经过处理的标签的预估三维位置作为高斯-牛顿迭代算法的初值,经迭代运算,得到所述标签的三维空间位置。
结合第一方面,在第一方面的第一种可实现方式中,建立空间三维直角坐标系包括:
设标签坐标(x,y,z),基站坐标(Xi,Yi,Zi),c为电磁波在空气中传播速度,ti为超宽带信号从标签到第i个基站的时间,ti,1为超宽带信号从标签到第i个基站与到第1个基站的时间差,ti,1=ti-t1,ri为标签到第i个基站的真实的空间距离,ri=cti,并表示为ri,1为标签到第i个基站与到第1个基站的距离差ri,1=ri-r1,表示为
结合第一方面,在第一方面的第二种可实现方式中,利用所述TDOA原始数据,通过三维空间Chan算法估计得到所述标签的预估三维位置,包括:
h=Gaza;
在实际情况下,za中元素r1与(x,y,z)关联,假设存在足够小噪声e,使za成为一个随机向量,其均值为真实值,这时Ga、h与za表示为
设ei,i=1,2,3,4为噪声,za元素表示为
za=[x0+e1,y0+e2,z0+e3,r1 0+e4]T;
新的线性方程可建立为
ψ'=h'-Ga'za';
其中:
对za'求加权最小二乘估计
式中Ψ'误差协方差阵,在ei较小时通过忽略Ψ'计算中得高次项,做近似处理得:
Ψ'=E[ψ'ψ'T]=4B'cov(za)B';
B'=diag{x0-X1,y0-Y1,z0-Z1,r1 0};
结合第一方面,在第一方面的第三种可实现方式中,对所述标签的预估三维位置做残值加权处理,包括:
选定一个基站作为定位基准站,将剩余M-1个基站进行分组,基站的参与量至少为4个,分组共种组合,第k种组合记为Sk,表示该种组合所对应基站的集合,在该组合下利用Chan算法估算得到的标签坐标记为zt,k=[xk,yk,zk]T,k=1,2,...,N,第i个基站的坐标记为Ai=[Xi,Yi,Zi];
建立三维平方残值函数:
式中
假设每组经Chan算法估计所得的位置,权值为wk,wk=1/p(zt,k,Sk),则标签位置估计为
结合第一方面,在第一方面的第四种可实现方式中,将经过处理的标签的预估三维位置作为高斯-牛顿迭代算法的初值,经迭代运算,得到所述标签的三维空间位置,包括:
设定适用坐标参数,建立对应三维定位的高斯-牛顿迭代法函数原型;
标签真实坐标为(x,y,z),第i个基站坐标为(Xi,Yi,Zi),并设mi,k为第i个基站测得的第k个TDOA测量值,即mi,k=ri,k-r1,k建立函数原型为
fk(x,y,z,Xi,Yi,Zi)=uk=mi,k-ek,k=1,2,...,n,
式中,ek是统计分布的随机变量误差,均值为零,误差协方差阵Re=[cij],矩阵中第i行j列元素cij=(eij);
利用经过平方残值加权后的标签坐标估计值zrw(xv,yv,zv)与标签真实坐标(x,y,z)建立关系式,并对函数原型fk作泰勒级数展开,保留一介项可得:
x=xv+δx,y=yv+δy,z=zv+δz,
fkv+ak1δx+ak2δy+ak3δz=mi,k-ek,
式中:
定义矩阵与向量:
建立新的方程为L=Aδ+e(23);
通过做加权最小二乘估计可得δ的解
δ=[ATRe -1A]-1ATRe -1L;
利用残值平方构造加权误差协方差矩阵We为
将构造的加权误差协方差矩阵We带入,可得δ的最小二乘解为
δ=[ATWe -1A]-1ATWe -1L;
则迭代后的zrw'(xv',yv',zv')为
xv'=xv+δx,yv'=yv+δy,zv'=zv+δz;
重复迭代,当满足|δx|+|δy|+|δz|<ε,ε为充分小时,高斯-牛顿迭代收敛,最终可得标签最优估计三维空间位置。
第二方面,本发明提供一种基于超宽带通信的室内三维定位装置,所述装置包括:
获取单元,用于获取标签的TDOA原始数据,其中,所述标签所在的室内场景中预先布置有4个以上超宽带基站,建立空间三维直角坐标系,所述标签的TDOA原始数据由所述超宽带基站通过TDOA方式对标签进行定位所得到;
估计单元,用于利用所述TDOA原始数据,通过三维空间Chan算法估计得到所述标签的预估三维位置;
处理单元,用于对所述标签的预估三维位置做残值加权处理;
计算单元,用于将经过处理的标签的预估三维位置作为高斯-牛顿迭代算法的初值,经迭代运算,得到所述标签的三维空间位置。
结合第二方面,在第二方面的第一种可实现方式中,建立空间三维直角坐标系包括:
设标签坐标(x,y,z),基站坐标(Xi,Yi,Zi),c为电磁波在空气中传播速度,ti为超宽带信号从标签到第i个基站的时间,ti,1为超宽带信号从标签到第i个基站与到第1个基站的时间差,ti,1=ti-t1,ri为标签到第i个基站的真实的空间距离,ri=cti,并表示为ri,1为标签到第i个基站与到第1个基站的距离差ri,1=ri-r1,表示为
结合第二方面,在第二方面的第二种可实现方式中,所述估计单元,用于:
h=Gaza;
式中:
在实际情况下,za中元素r1与(x,y,z)关联,假设存在足够小噪声e,使za成为一个随机向量,其均值为真实值,这时Ga、h与za表示为
设ei,i=1,2,3,4为噪声,za元素表示为
za=[x0+e1,y0+e2,z0+e3,r1 0+e4]T;
新的线性方程可建立为
ψ'=h'-Ga'za';
其中:
对za'求加权最小二乘估计
式中Ψ'误差协方差阵,在ei较小时通过忽略Ψ'计算中得高次项,做近似处理得:
Ψ'=E[ψ'ψ'T]=4B'cov(za)B';
B'=diag{x0-X1,y0-Y1,z0-Z1,r1 0};
结合第二方面,在第二方面的第三种可实现方式中,所述处理单元,用于:
选定一个基站作为定位基准站,将剩余M-1个基站进行分组,基站的参与量至少为4个,分组共种组合,第k种组合记为Sk,表示该种组合所对应基站的集合,在该组合下利用Chan算法估算得到的标签坐标记为zt,k=[xk,yk,zk]T,k=1,2,...,N,第i个基站的坐标记为Ai=[Xi,Yi,Zi];
建立三维平方残值函数:
假设每组经Chan算法估计所得的位置,权值为wk,wk=1/p(zt,k,Sk),则标签位置估计为
结合第二方面,在第二方面的第四种可实现方式中,所述计算单元,用于:
设定适用坐标参数,建立对应三维定位的高斯-牛顿迭代法函数原型;
标签真实坐标为(x,y,z),第i个基站坐标为(Xi,Yi,Zi),并设mi,k为第i个基站测得的第k个TDOA测量值,即mi,k=ri,k-r1,k建立函数原型为
fk(x,y,z,Xi,Yi,Zi)=uk=mi,k-ek,k=1,2,...,n,
式中,ek是统计分布的随机变量误差,均值为零,误差协方差阵Re=[cij],矩阵中第i行j列元素cij=(eij);
利用经过平方残值加权后的标签坐标估计值zrw(xv,yv,zv)与标签真实坐标(x,y,z)建立关系式,并对函数原型fk作泰勒级数展开,保留一介项可得:
x=xv+δx,y=yv+δy,z=zv+δz,
fkv+ak1δx+ak2δy+ak3δz=mi,k-ek,
式中:
定义矩阵与向量:
建立新的方程为L=Aδ+e;
通过做加权最小二乘估计可得δ的解
δ=[ATRe -1A]-1ATRe -1L;
利用残值平方构造加权误差协方差矩阵We为
将构造的加权误差协方差矩阵We带入,可得δ的最小二乘解为
δ=[ATWe -1A]-1ATWe -1L;
则迭代后的zrw'(xv',yv',zv')为
xv'=xv+δx,yv'=yv+δy,zv'=zv+δz;
重复迭代,当满足|δx|+|δy|+|δz|<ε,ε为充分小时,高斯-牛顿迭代收敛,最终可得标签最优估计三维空间位置。
本发明的有益效果如下:
本发明提供的一种基于超宽带通信的室内三维定位方法及装置,通过针对室内场景布置4个以上超宽带基站,通过TDOA方式对标签进行定位,并利用Chan算法对超宽带***获得的TDOA原始数据进行两次加权最小二乘估计,获得标签三维位置的估计值,再利用残值加权法对应用超宽带***产生的非视距误差做平滑处理,得到进一步精确的标签三维位置估计值,将所得估计值作为高斯-牛顿迭代的初始值,经多次迭代运算,最终得到标签三维位置,能够有效适应室内存在的非视距环境,并为基于超宽带通信的室内三维定位提供了一种合理、高精度的三维定位方案。
附图说明
为了更清楚地说明本发明的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,对于本领域普通技术人员而言,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种基于超宽带通信的室内三维定位方法的流程图。
图2为本发明实施例提供的一种基于超宽带通信的室内三维定位方法中TDOA方式三维空间定位原理图。
图3为本发明实施例提供的一种基于超宽带通信的室内三维定位方法中室内三维空间直角坐标系示意图。
图4为本发明实施例提供的一种基于超宽带通信的室内三维定位装置的示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合本发明具体实施例及相应的附图对本发明技术方案进行清楚、完整地描述。显然,所描述的实施例仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。以下结合附图,详细说明本发明各实施例提供的技术方案。
请参阅图1,为本发明实施例提供的一种基于超宽带通信的室内三维定位方法,该方法的执行主体可以是处理器,所述方法具体可以包括如下步骤:
步骤S101,获取标签的TDOA原始数据,其中,标签所在的室内场景中预先布置有4个以上超宽带基站,建立空间三维直角坐标系,标签的TDOA原始数据由超宽带基站通过TDOA方式对标签进行定位所得到。
如图2和图3所示,将超宽带基站依照TDOA定位方式原理,分布在室内空间内,由于进行三维定位,则基站的参与量至少为4个,至少包括基站1、基站2、基站3以及基站4。
在本实施例中,建立空间三维直角坐标系,设标签坐标(x,y,z),基站坐标(Xi,Yi,Zi),c为电磁波在空气中传播速度。ti为超宽带信号从标签到第i个基站的时间,ti,1为超宽带信号从标签到第i个基站与到第1个基站的时间差,ti,1=ti-t1。ri为标签到第i个基站的真实的空间距离,ri=cti,并表示为:
ri,1为标签到第i个基站与到第1个基站的距离差ri,1=ri-r1,表示为:
步骤S102,利用TDOA原始数据,通过三维空间Chan算法估计得到标签的预估三维位置。
在本实施例中,步骤S102具体可以包括如下步骤:
h=Gaza 式(4)
步骤2.2:由于实际情况下超宽带***存在信号时延误差,设为za真实值,即标签的真实值,采用TDOA方式产生的信号时延随机误差n,均值为零,协方差阵为TDOA量测距离为ri真实值,则误差矢量方程及解析式分别为:
步骤2.3:在实际情况下,za中元素r1与(x,y,z)关联,假设存在足够小噪声e,使za成为一个随机向量,其均值为真实值,这时Ga、h与za表示为:
将式(8)带入式(5),可依次求得
设ei,i=1,2,3,4为噪声,za元素表示为:
za=[x0+e1,y0+e2,z0+e3,r1 0+e4]T 式(12)
新的线性方程可建立为:
ψ'=h'-Ga'za' 式(13)
对za'求加权最小二乘估计得到:
式中Ψ'误差协方差阵,在ei较小时通过忽略Ψ'计算中得高次项,做近似处理得
Ψ'=E[ψ'ψ'T]=4B'cov(za)B' 式(15)
B'=diag{x0-X1,y0-Y1,z0-Z1,r1 0} 式(16)
步骤S103,对标签的预估三维位置做残值加权处理。
在本实施例中,步骤S103具体可以包括:
步骤3.1:选定一个基站作为定位基准站,将剩余M-1个基站进行分组,由于进行三维定位,则基站的参与量至少为4个,分组共种组合,第k种组合记为Sk,表示该种组合所对应基站的集合,在该组合下利用Chan算法估算得到的标签坐标记为zt,k=[xk,yk,zk]T,k=1,2,...,N,第i个基站的坐标记为Ai=[Xi,Yi,Zi]。
步骤3.2:建立三维平方残值函数:
假设每组经Chan算法估计所得的位置,权值为wk,wk=1/p(zt,k,Sk),则标签位置估计为:
步骤S104,将经过处理的标签的预估三维位置作为高斯-牛顿迭代算法的初值,经迭代运算,得到标签的三维空间位置。
在本实施例中,步骤S104具体可以包括:
步骤4.1:设定适用坐标参数,建立对应三维定位的高斯-牛顿迭代法函数原型。
标签真实坐标为(x,y,z),第i个基站坐标为(Xi,Yi,Zi),并设mi,k为第i个基站测得的第k个TDOA测量值,即mi,k=ri,k-r1,k建立函数原型为:
fk(x,y,z,Xi,Yi,Zi)=uk=mi,k-ek,k=1,2,...,n 式(20)
式中,ek是统计分布的随机变量误差,均值为零,误差协方差阵Re=[cij],矩阵中第i行j列元素cij=(eij)。
步骤4.2:利用经过平方残值加权后的标签坐标估计值zrw(xv,yv,zv)与标签真实坐标(x,y,z)建立关系式,并对函数原型fk作泰勒级数展开,保留一介项可得
x=xv+δx,y=yv+δy,z=zv+δz 式(21)
fkv+ak1δx+ak2δy+ak3δz=mi,k-ek 式(22)
式中:
定义矩阵与向量
式(22)可建立新的方程为:
L=Aδ+e 式(23)
通过做加权最小二乘估计可得δ的解:
δ=[ATRe -1A]-1ATRe -1L 式(24)
将构造的加权误差协方差矩阵We带入式(24)中,可得δ的最小二乘解为:
δ=[ATWe -1A]-1ATWe -1L 式(25)
则迭代后的zrw'(xv',yv',zv')为:
xv'=xv+δx,yv'=yv+δy,zv'=zv+δz 式(26)
重复迭代,当满足|δx|+|δy|+|δz|<ε,ε为充分小时,高斯-牛顿迭代收敛,最终可得标签最优估计三维空间位置。
请参阅图4,本发明还提供一种基于超宽带通信的室内三维定位装置,该装置包括:
获取单元401,用于获取标签的TDOA原始数据,其中,标签所在的室内场景中预先布置有4个以上超宽带基站,建立空间三维直角坐标系,标签的TDOA原始数据由超宽带基站通过TDOA方式对标签进行定位所得到。
估计单元402,用于利用TDOA原始数据,通过三维空间Chan算法估计得到标签的预估三维位置。
处理单元403,用于对标签的预估三维位置做残值加权处理。
计算单元404,用于将经过处理的标签的预估三维位置作为高斯-牛顿迭代算法的初值,经迭代运算,得到标签的三维空间位置。
在本实施例中,建立空间三维直角坐标系包括:设标签坐标(x,y,z),基站坐标(Xi,Yi,Zi),c为电磁波在空气中传播速度,ti为超宽带信号从标签到第i个基站的时间,ti,1为超宽带信号从标签到第i个基站与到第1个基站的时间差,ti,1=ti-t1,ri为标签到第i个基站的真实的空间距离,ri=cti,并表示为ri,1为标签到第i个基站与到第1个基站的距离差ri,1=ri-r1,表示为
h=Gaza;
式中:
在实际情况下,za中元素r1与(x,y,z)关联,假设存在足够小噪声e,使za成为一个随机向量,其均值为真实值,这时Ga、h与za表示为
设ei,i=1,2,3,4为噪声,za元素表示为
za=[x0+e1,y0+e2,z0+e3,r1 0+e4]T;
新的线性方程可建立为
ψ'=h'-Ga'za';
其中:
对za'求加权最小二乘估计
式中Ψ'误差协方差阵,在ei较小时通过忽略Ψ'计算中得高次项,做近似处理得:
Ψ'=E[ψ'ψ'T]=4B'cov(za)B';
B'=diag{x0-X1,y0-Y1,z0-Z1,r1 0};
在本实施例中,处理单元403,用于:选定一个基站作为定位基准站,将剩余M-1个基站进行分组,基站的参与量至少为4个,分组共种组合,第k种组合记为Sk,表示该种组合所对应基站的集合,在该组合下利用Chan算法估算得到的标签坐标记为zt,k=[xk,yk,zk]T,k=1,2,...,N,第i个基站的坐标记为Ai=[Xi,Yi,Zi];
建立三维平方残值函数:
式中
假设每组经Chan算法估计所得的位置,权值为wk,wk=1/p(zt,k,Sk),则标签位置估计为
在本实施例中,计算单元404,用于:设定适用坐标参数,建立对应三维定位的高斯-牛顿迭代法函数原型;
标签真实坐标为(x,y,z),第i个基站坐标为(Xi,Yi,Zi),并设mi,k为第i个基站测得的第k个TDOA测量值,即mi,k=ri,k-r1,k建立函数原型为fk(x,y,z,Xi,Yi,Zi)=uk=mi,k-ek,k=1,2,...,n,式中,ek是统计分布的随机变量误差,均值为零,误差协方差阵Re=[cij],矩阵中第i行j列元素cij=(eij);
利用经过平方残值加权后的标签坐标估计值zrw(xv,yv,zv)与标签真实坐标(x,y,z)建立关系式,并对函数原型fk作泰勒级数展开,保留一介项可得:
x=xv+δx,y=yv+δy,z=zv+δz,
fkv+ak1δx+ak2δy+ak3δz=mi,k-ek,
式中:
定义矩阵与向量:
建立新的方程为L=Aδ+e(23);
通过做加权最小二乘估计可得δ的解
δ=[ATRe -1A]-1ATRe -1L;
利用残值平方构造加权误差协方差矩阵We为
将构造的加权误差协方差矩阵We带入,可得δ的最小二乘解为
δ=[ATWe -1A]-1ATWe -1L;
则迭代后的zrw'(xv',yv',zv')为
xv'=xv+δx,yv'=yv+δy,zv'=zv+δz;
重复迭代,当满足|δx|+|δy|+|δz|<ε,ε为充分小时,高斯-牛顿迭代收敛,最终可得标签最优估计三维空间位置。
本发明实施例还提供一种存储介质,本发明实施例还提供一种存储介质,所述存储介质中存储有计算机程序,所述计算机程序被处理器执行时实现本发明提供的基于超宽带通信的室内三维定位方法的各实施例中的部分或全部步骤。所述的存储介质可为磁碟、光盘、只读存储记忆体(英文:Read-OnlyMemory,简称:ROM)或随机存储记忆体(英文:RandomAccessMemory,简称:RAM)等。
本领域的技术人员可以清楚地了解到本发明实施例中的技术可借助软件加必需的通用硬件平台的方式来实现。基于这样的理解,本发明实施例中的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例或者实施例的某些部分所述的方法。
本说明书中各个实施例之间相同相似的部分互相参见即可。尤其,对于基于超宽带通信的室内三维定位装置实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例中的说明即可。
以上所述的本发明实施方式并不构成对本发明保护范围的限定。
Claims (10)
1.一种基于超宽带通信的室内三维定位方法,其特征在于,所述方法包括:
获取标签的TDOA原始数据,其中,所述标签所在的室内场景中预先布置有4个以上超宽带基站,建立空间三维直角坐标系,所述标签的TDOA原始数据由所述超宽带基站通过TDOA方式对标签进行定位所得到;
利用所述TDOA原始数据,通过三维空间Chan算法估计得到所述标签的预估三维位置;
对所述标签的预估三维位置做残值加权处理;
将经过处理的标签的预估三维位置作为高斯-牛顿迭代算法的初值,经迭代运算,得到所述标签的三维空间位置。
3.如权利要求1所述的方法,其特征在于,利用所述TDOA原始数据,通过三维空间Chan算法估计得到所述标签的预估三维位置,包括:
h=Gaza;
式中:
在实际情况下,za中元素r1与(x,y,z)关联,假设存在足够小噪声e,使za成为一个随机向量,其均值为真实值,这时Ga、h与za表示为
设ei,i=1,2,3,4为噪声,za元素表示为
za=[x0+e1,y0+e2,z0+e3,r1 0+e4]T;
新的线性方程可建立为
ψ'=h'-Ga'za';
其中:
对za'求加权最小二乘估计
式中Ψ'误差协方差阵,在ei较小时通过忽略Ψ'计算中得高次项,做近似处理得:
Ψ'=E[ψ'ψ'T]=4B'cov(za)B';
B'=diag{x0-X1,y0-Y1,z0-Z1,r1 0};
5.如权利要求1所述的方法,其特征在于,将经过处理的标签的预估三维位置作为高斯-牛顿迭代算法的初值,经迭代运算,得到所述标签的三维空间位置,包括:
设定适用坐标参数,建立对应三维定位的高斯-牛顿迭代法函数原型;
标签真实坐标为(x,y,z),第i个基站坐标为(Xi,Yi,Zi),并设mi,k为第i个基站测得的第k个TDOA测量值,即mi,k=ri,k-r1,k建立函数原型为fk(x,y,z,Xi,Yi,Zi)=uk=mi,k-ek,k=1,2,...,n,式中,ek是统计分布的随机变量误差,均值为零,误差协方差阵Re=[cij],矩阵中第i行j列元素cij=(eij);
利用经过平方残值加权后的标签坐标估计值zrw(xv,yv,zv)与标签真实坐标(x,y,z)建立关系式,并对函数原型fk作泰勒级数展开,保留一介项可得:
x=xv+δx,y=yv+δy,z=zv+δz,
fkv+ak1δx+ak2δy+ak3δz=mi,k-ek,
式中:
定义矩阵与向量:
建立新的方程为
L=Aδ+e(23);
通过做加权最小二乘估计可得δ的解
δ=[ATRe -1A]-1ATRe -1L;
利用残值平方构造加权误差协方差矩阵We为
将构造的加权误差协方差矩阵We带入,可得δ的最小二乘解为
δ=[ATWe -1A]-1ATWe -1L;
则迭代后的zrw'(xv',yv',zv')为
xv'=xv+δx,yv'=yv+δy,zv'=zv+δz;
重复迭代,当满足|δx|+|δy|+|δz|<ε,ε为充分小时,高斯-牛顿迭代收敛,最终可得标签最优估计三维空间位置。
6.一种基于超宽带通信的室内三维定位装置,其特征在于,所述装置包括:
获取单元,用于获取标签的TDOA原始数据,其中,所述标签所在的室内场景中预先布置有4个以上超宽带基站,建立空间三维直角坐标系,所述标签的TDOA原始数据由所述超宽带基站通过TDOA方式对标签进行定位所得到;
估计单元,用于利用所述TDOA原始数据,通过三维空间Chan算法估计得到所述标签的预估三维位置;
处理单元,用于对所述标签的预估三维位置做残值加权处理;
计算单元,用于将经过处理的标签的预估三维位置作为高斯-牛顿迭代算法的初值,经迭代运算,得到所述标签的三维空间位置。
8.如权利要求6所述的装置,其特征在于,所述估计单元,用于:
h=Gaza;
式中:
在实际情况下,za中元素r1与(x,y,z)关联,假设存在足够小噪声e,使za成为一个随机向量,其均值为真实值,这时Ga、h与za表示为
设ei,i=1,2,3,4为噪声,za元素表示为
za=[x0+e1,y0+e2,z0+e3,r1 0+e4]T;
新的线性方程可建立为
ψ'=h'-Ga'za';
其中:
对za'求加权最小二乘估计
式中Ψ'误差协方差阵,在ei较小时通过忽略Ψ'计算中得高次项,做近似处理得:
Ψ'=E[ψ'ψ'T]=4B'cov(za)B';
B'=diag{x0-X1,y0-Y1,z0-Z1,r1 0};
10.如权利要求6所述的装置,其特征在于,所述计算单元,用于:
设定适用坐标参数,建立对应三维定位的高斯-牛顿迭代法函数原型;
标签真实坐标为(x,y,z),第i个基站坐标为(Xi,Yi,Zi),并设mi,k为第i个基站测得的第k个TDOA测量值,即mi,k=ri,k-r1,k建立函数原型为fk(x,y,z,Xi,Yi,Zi)=uk=mi,k-ek,k=1,2,...,n,式中,ek是统计分布的随机变量误差,均值为零,误差协方差阵Re=[cij],矩阵中第i行j列元素cij=(eij);
利用经过平方残值加权后的标签坐标估计值zrw(xv,yv,zv)与标签真实坐标(x,y,z)建立关系式,并对函数原型fk作泰勒级数展开,保留一介项可得:
x=xv+δx,y=yv+δy,z=zv+δz,
fkv+ak1δx+ak2δy+ak3δz=mi,k-ek,
式中:
定义矩阵与向量:
建立新的方程为
L=Aδ+e(23);
通过做加权最小二乘估计可得δ的解
δ=[ATRe -1A]-1ATRe -1L;
利用残值平方构造加权误差协方差矩阵We为
将构造的加权误差协方差矩阵We带入,可得δ的最小二乘解为
δ=[ATWe -1A]-1ATWe -1L;
则迭代后的zrw'(xv',yv',zv')为
xv'=xv+δx,yv'=yv+δy,zv'=zv+δz;
重复迭代,当满足|δx|+|δy|+|δz|<ε,ε为充分小时,高斯-牛顿迭代收敛,最终可得标签最优估计三维空间位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911182827.8A CN110933630A (zh) | 2019-11-27 | 2019-11-27 | 基于超宽带通信的室内三维定位方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911182827.8A CN110933630A (zh) | 2019-11-27 | 2019-11-27 | 基于超宽带通信的室内三维定位方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110933630A true CN110933630A (zh) | 2020-03-27 |
Family
ID=69846707
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911182827.8A Pending CN110933630A (zh) | 2019-11-27 | 2019-11-27 | 基于超宽带通信的室内三维定位方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110933630A (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111352444A (zh) * | 2020-04-23 | 2020-06-30 | 上海交通大学 | 基于无线导航的无人机室外移动平台自主降落方法及*** |
CN111559412A (zh) * | 2020-06-18 | 2020-08-21 | 中车株洲电力机车有限公司 | 一种基于uwb定位的机车对标方法及*** |
CN112738708A (zh) * | 2020-12-18 | 2021-04-30 | 中国电子科技集团公司第五十四研究所 | 一种部分基站位置未知的测向测距定位方法 |
CN112954591A (zh) * | 2021-02-10 | 2021-06-11 | 北京理工大学 | 一种协同分布式定位方法及*** |
CN113063422A (zh) * | 2021-03-22 | 2021-07-02 | 中国科学院国家授时中心 | 一种顾及钟差的5g终端室内定位方法 |
CN113671441A (zh) * | 2021-09-10 | 2021-11-19 | 哈尔滨工程大学 | 一种基于超宽带技术的室内无源实时定位方法 |
CN113804199A (zh) * | 2021-09-17 | 2021-12-17 | 中山大学 | 一种基于Chan氏算法和牛顿法的组合定位方法与*** |
CN114089273A (zh) * | 2021-11-22 | 2022-02-25 | 电子科技大学 | 一种基于gps及uwb的运动平台定位方法 |
CN114353795A (zh) * | 2021-12-06 | 2022-04-15 | 中南设计集团(武汉)工程技术研究院有限公司 | 一种基于uwb设备的室内三维定位***与方法 |
CN114598987A (zh) * | 2020-12-04 | 2022-06-07 | 大唐移动通信设备有限公司 | 定位方法、装置、电子设备及计算机可读存储介质 |
CN115022800A (zh) * | 2022-05-27 | 2022-09-06 | 国网江苏省电力有限公司电力科学研究院 | 一种变电站室内人员自适应定位方法及*** |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080186231A1 (en) * | 2007-02-05 | 2008-08-07 | Daniel Aljadeff | Dual bandwidth time difference of arrival (tdoa) system |
CN109743701A (zh) * | 2018-12-04 | 2019-05-10 | 东南大学 | 基于超宽带通信的室内三维定位方法 |
CN110493742A (zh) * | 2019-08-28 | 2019-11-22 | 哈尔滨工程大学 | 一种用于超宽带的室内三维定位方法 |
-
2019
- 2019-11-27 CN CN201911182827.8A patent/CN110933630A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080186231A1 (en) * | 2007-02-05 | 2008-08-07 | Daniel Aljadeff | Dual bandwidth time difference of arrival (tdoa) system |
CN109743701A (zh) * | 2018-12-04 | 2019-05-10 | 东南大学 | 基于超宽带通信的室内三维定位方法 |
CN110493742A (zh) * | 2019-08-28 | 2019-11-22 | 哈尔滨工程大学 | 一种用于超宽带的室内三维定位方法 |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111352444A (zh) * | 2020-04-23 | 2020-06-30 | 上海交通大学 | 基于无线导航的无人机室外移动平台自主降落方法及*** |
CN111559412A (zh) * | 2020-06-18 | 2020-08-21 | 中车株洲电力机车有限公司 | 一种基于uwb定位的机车对标方法及*** |
CN114598987A (zh) * | 2020-12-04 | 2022-06-07 | 大唐移动通信设备有限公司 | 定位方法、装置、电子设备及计算机可读存储介质 |
CN112738708A (zh) * | 2020-12-18 | 2021-04-30 | 中国电子科技集团公司第五十四研究所 | 一种部分基站位置未知的测向测距定位方法 |
CN112738708B (zh) * | 2020-12-18 | 2022-05-06 | 中国电子科技集团公司第五十四研究所 | 一种部分基站位置未知的测向测距定位方法 |
CN112954591B (zh) * | 2021-02-10 | 2022-04-15 | 北京理工大学 | 一种协同分布式定位方法及*** |
CN112954591A (zh) * | 2021-02-10 | 2021-06-11 | 北京理工大学 | 一种协同分布式定位方法及*** |
CN113063422A (zh) * | 2021-03-22 | 2021-07-02 | 中国科学院国家授时中心 | 一种顾及钟差的5g终端室内定位方法 |
CN113671441A (zh) * | 2021-09-10 | 2021-11-19 | 哈尔滨工程大学 | 一种基于超宽带技术的室内无源实时定位方法 |
CN113671441B (zh) * | 2021-09-10 | 2023-10-03 | 哈尔滨工程大学 | 一种基于超宽带技术的室内无源实时定位方法 |
CN113804199A (zh) * | 2021-09-17 | 2021-12-17 | 中山大学 | 一种基于Chan氏算法和牛顿法的组合定位方法与*** |
CN113804199B (zh) * | 2021-09-17 | 2023-06-13 | 中山大学 | 一种基于Chan氏算法和牛顿法的组合定位方法与*** |
CN114089273A (zh) * | 2021-11-22 | 2022-02-25 | 电子科技大学 | 一种基于gps及uwb的运动平台定位方法 |
CN114089273B (zh) * | 2021-11-22 | 2023-05-26 | 电子科技大学 | 一种基于gps及uwb的运动平台定位方法 |
CN114353795A (zh) * | 2021-12-06 | 2022-04-15 | 中南设计集团(武汉)工程技术研究院有限公司 | 一种基于uwb设备的室内三维定位***与方法 |
CN115022800A (zh) * | 2022-05-27 | 2022-09-06 | 国网江苏省电力有限公司电力科学研究院 | 一种变电站室内人员自适应定位方法及*** |
CN115022800B (zh) * | 2022-05-27 | 2024-02-20 | 国网江苏省电力有限公司电力科学研究院 | 一种变电站室内人员自适应定位方法及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110933630A (zh) | 基于超宽带通信的室内三维定位方法及装置 | |
CN110493742B (zh) | 一种用于超宽带的室内三维定位方法 | |
CN111896914A (zh) | 一种协同定位方法、装置、设备和存储介质 | |
CN110503071A (zh) | 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法 | |
CN106912105B (zh) | 基于pso_bp神经网络的三维定位方法 | |
CN105954712B (zh) | 联合无线电信号复包络和载波相位信息的多目标直接定位方法 | |
CN104080165A (zh) | 一种基于tdoa的室内无线传感器网络定位方法 | |
WO2016112758A1 (zh) | 终端的定位方法及装置 | |
Ho et al. | Source localization using TDOA with erroneous receiver positions | |
CN103379441A (zh) | 一种基于区域分割和曲面拟合的室内定位方法 | |
CN110687500A (zh) | 智能天线获取无线信号到达角的识别和定位方法及*** | |
CN110657806A (zh) | 一种基于CKF、chan解算和Savitzky-Golay平滑滤波的位置解算方法 | |
CN108318854B (zh) | 一种定位方法、装置、电子设备及可读存储介质 | |
CN110850363A (zh) | 一种基于实时定位轨迹数据进行动态滤波优化的方法 | |
CN108445446B (zh) | 一种无源测速定位方法及装置 | |
CN111007456A (zh) | 能时域联合的鲁棒性非视距偏差消除定位方法 | |
CN107592654B (zh) | 一种基于压缩感知的同频多辐射源场强定位方法 | |
CN111263295B (zh) | 一种wlan室内定位方法和装置 | |
CN113567925A (zh) | 一种基于超宽带技术的精准定位方法、***、装置 | |
CN113740802B (zh) | 以自适应噪声估计进行矩阵补全的信号源定位方法和*** | |
CN109613477A (zh) | 一种复杂环境下的tdoa定位追踪方法 | |
CN111277950B (zh) | 一种基于到达时差和到达频差的定位方法、装置及设备 | |
CN113835064B (zh) | 一种协同校正源观测信息的加权多维标度tdoa定位方法 | |
CN113721191A (zh) | 自适应栅格化提升矩阵补全性能的信号源定位方法和*** | |
CN113970762A (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200327 |
|
WD01 | Invention patent application deemed withdrawn after publication |