CN110856104B - 一种联合最小二乘和三边定位的超宽带室内定位方法 - Google Patents
一种联合最小二乘和三边定位的超宽带室内定位方法 Download PDFInfo
- Publication number
- CN110856104B CN110856104B CN201911128414.1A CN201911128414A CN110856104B CN 110856104 B CN110856104 B CN 110856104B CN 201911128414 A CN201911128414 A CN 201911128414A CN 110856104 B CN110856104 B CN 110856104B
- Authority
- CN
- China
- Prior art keywords
- lambda
- positioning
- equation
- equal
- line segment
- 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.)
- Expired - Fee Related
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/02—Services making use of location information
- H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
-
- 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
-
- 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
- H04W64/006—Locating users or terminals or network equipment for network management purposes, e.g. mobility management with additional information processing, e.g. for direction or speed determination
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
一种联合最小二乘和三边定位的超宽带室内定位方法,属于信号处理领域。包括以下步骤:获取4个锚节点与标签间的距离信息;处理测距数据得到关于锚节点平面对称的2个坐标解;根据2个对称解得到标签精确的位置坐标;输出计算得到的标签位置坐标。本发明提出了一种联合最小二乘和三边定位的超宽带室内定位方法,该定位方法通过利用所获取到的距离信息,利用改进的最小二乘和三边定位的联合算法对测距结果进行两步解算处理,从而得到更加精确的定位结果,并且耗时较短。
Description
技术领域
本发明涉及一种联合最小二乘和三边定位的超宽带室内定位方法,属于信号处理领域。
背景技术
随着室内定位技术的发展,超宽带定位技术已经被广泛地应用到各种室内场所中。超宽带技术具有穿透能力强、抗多径衰减能力强、抗干扰能力好以及安全性好等特点。在使用超宽带技术进行室内定位时,最重要的指标则是对待测目标的定位精度,如果不能够实时获得待测目标的精确位置,室内定位技术也就失去了意义。
传统的超宽带定位算法有最小二乘法、Chan算法以及Taylor级数算法等,但是它们在对目标位置进行解算时具有计算量大、定位误差较大等缺点。
发明内容
本发明提出了一种联合最小二乘和三边定位的超宽带室内定位方法,为了解决超宽带定位系统对待测目标的定位问题。
一种联合最小二乘和三边定位的超宽带室内定位方法,所述定位方法包括以下步骤:
步骤一:在对标签进行定位时,4个锚节点的位置固定且已知,设4个锚节点的坐标分别为A1(x1,y1,z1),A2(x2,y2,z2),A3(x3,y3,z3),A4(x4,y4,z4),标签的坐标设为(x,y,z),得到z1=z2=z3=z4,
利用锚节点A1、A2、A3对标签进行定位,设标签到锚节点A1、A2、A3的距离分别为d1、d2、d3,则标签到锚节点A1、A2、A3的距离di可以建立的方程如式(1)所示:
di 2=(x-xi)2+(y-yi)2+(z-zi)2
=(x2+y2+z2)-2xxi-2yyi-2zzi+(xi 2+yi 2+zi 2)
=R-2xxi-2yyi-2zzi+Ki(i=1,2,3) (1)
步骤二:将i=1,2,3分别带入式(1),组成由3个方程构成的方程组,并且将前2个方程依次减去第3个方程,得到下列矩阵关系如式(2)所示:
将公式(2)写成:AX=B,
步骤三:由最小二乘估计:
X=(ATA)-1ATB (3)
求出当前标签的x、y坐标,由于锚节点A1的位置为所建立坐标系的原点,则可以根据式:
求得关于当前4个锚节点构成平面的2个对称解:
步骤四:在基于锚节点A1、A2、A3求解出的定位结果的基础上,利用第四个锚节点A4对坐标结果进行优化,设2个对称解分别为X1,X2,SC为锚节点A4的位置,r为球的半径,接收到锚节点A4与标签T0间的距离值,
假设球与线段有交点,设球与线段相交的点为X=X1+λ(X2-X1),将该点带入球面方程:
(SC-X)2=r2 (6)
将球面方程转换为式(7)的形式:
αλ2+βλ+γ=0 (7)
得到方程的2个根如式(8)所示:
步骤五:针对不同情况对应的λ的取值对z轴坐标进行优化;
步骤六:每当接收到新的测距信息时,重复步骤一到步骤五,计算出当前时刻标签的精确位置,实现对标签运动轨迹的精确追踪。
进一步的,具体的,球面与线段的位置关系分为以下几种:
情况一:线段X1X2在球体之外,没有交点,此时λ1<0且λ2<0,令λ=min{|λ1|,|λ2|},则定位结果X=X2+0.5λ(X2-X1),
情况二:线段X1X2在球体之内,没有交点,此时λ1<0,λ2>1或者λ2<0,λ1>1,则定位结果X=X2+0.5(X2-X1),
情况三:线段X1X2与球体只有一个交点,此时0<λ1<1,λ2<0||λ2>1或者0<λ2<1,λ1<0||λ1>1,令λ={λ1,λ2|λ∈(0,1)},如果λ≤0.5,λ=0.5λ;如果λ>0.5,λ=λ-0.5(1-λ),则定位结果X=X2+λ(X2-X1),
情况四:线段X1X2与球体有两个交点,此时0<λ1<1并且0<λ2<1,令
λ=(λ1+λ2)/2,则定位结果X=X2+λ(X2-X1),
情况五:线段X1X2与球体相切,只有一个交点,此时λ1=λ2,令λ=λ1=λ2,当λ≤0.25,λ=0.5λ;当0.25<λ≤0.5,λ=λ-0.5(0.5-λ);当0.5<λ≤0.75,λ=λ-0.5(λ-0.5);当λ>0.75,λ=λ-0.5(1-λ),则定位结果X=X2+λ(X2-X1)。
本发明的主要优点是:本发明提出了一种联合最小二乘和三边定位的超宽带室内定位方法,该定位方法通过利用所获取到的距离信息,利用改进的最小二乘和三边定位的联合算法对测距结果进行两步解算处理,从而得到更加精确的定位结果,并且耗时较短。
附图说明
图1为超宽带定位系统示意图;
图2为标签位置解算流程图;
图3为z轴坐标优化示意图;
图4为步骤六中各个情况的优化示意图,其中,图4(a)为情况一的示意图;图4(b)为情况二的示意图;图4(c)为情况三的示意图;图4(d)为情况四的示意图;图4(e)为情况五的示意图。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明公开了一种联合最小二乘和三边定位的超宽带室内定位方法的一实施例,所述定位方法包括以下步骤:
步骤一:在对标签进行定位时,4个锚节点的位置固定且已知,设4个锚节点的坐标分别为A1(x1,y1,z1),A2(x2,y2,z2),A3(x3,y3,z3),A4(x4,y4,z4),标签的坐标设为(x,y,z),由于4个锚节点在实际配置时要求处在同一高度,因此可得z1=z2=z3=z4,
利用锚节点A1、A2、A3对标签进行定位,设标签到锚节点A1、A2、A3的距离分别为d1、d2、d3,则标签到锚节点A1、A2、A3的距离di可以建立的方程如式(1)所示:
di 2=(x-xi)2+(y-yi)2+(z-zi)2
=(x2+y2+z2)-2xxi-2yyi-2zzi+(xi 2+yi 2+zi 2)
=R-2xxi-2yyi-2zzi+Ki(i=1,2,3) (1)
步骤二:将i=1,2,3分别带入式(1),组成由3个方程构成的方程组,并且将前2个方程依次减去第3个方程,得到下列矩阵关系如式(2)所示:
将公式(2)写成:AX=B,
步骤三:由最小二乘估计:
X=(ATA)-1ATB (3)
可以求出当前标签的x、y坐标,由于锚节点A1的位置为所建立坐标系的原点,则可以根据式:
可以求得关于当前4个锚节点构成平面的2个对称解:
步骤四:在基于锚节点A1、A2、A3求解出的定位结果的基础上,再利用第四个锚节点A4对坐标结果进行优化,主要是对于z轴上面的优化。设2个对称解分别为X1,X2,SC为锚节点A4的位置,r为球的半径,也就是接收到锚节点A4与标签T0间的距离值,z轴坐标优化如图3所示。
假设球与线段有交点,设球与线段相交的点为X=X1+λ(X2-X1),将该点带入球面方程:
(SC-X)2=r2 (6)
将球面方程转换为式(7)的形式:
αλ2+βλ+γ=0 (7)
得到方程的2个根如式(8)所示:
步骤五:球面与线段X1X2的位置关系决定了λ的值,因此需要针对不同情况对应的λ的取值对z轴坐标进行优化;
步骤六:每当接收到新的测距信息时,重复步骤一到步骤五,计算出当前时刻标签的精确位置,最终实现对标签运动轨迹的精确追踪。
参照图4所示,在本部分优选实施例中,具体的,球面与线段的位置关系分为以下几种:
情况一:线段X1X2在球体之外,没有交点,此时λ1<0且λ2<0,令λ=min{|λ1|,|λ2|},则定位结果X=X2+0.5λ(X2-X1),
情况二:线段X1X2在球体之内,没有交点,此时λ1<0,λ2>1或者λ2<0,λ1>1,则定位结果X=X2+0.5(X2-X1),
情况三:线段X1X2与球体只有一个交点,此时0<λ1<1,λ2<0||λ2>1或者0<λ2<1,λ1<0||λ1>1,令λ={λ1,λ2|λ∈(0,1)},如果λ≤0.5,λ=0.5λ;如果λ>0.5,λ=λ-0.5(1-λ),则定位结果X=X2+λ(X2-X1),
情况四:线段X1X2与球体有两个交点,此时0<λ1<1并且0<λ2<1,令λ=(λ1+λ2)/2,则定位结果X=X2+λ(X2-X1),
情况五:线段X1X2与球体相切,只有一个交点,此时λ1=λ2,令λ=λ1=λ2,当λ≤0.25,λ=0.5λ;当0.25<λ≤0.5,λ=λ-0.5(0.5-λ);当0.5<λ≤0.75,λ=λ-0.5(λ-0.5);当λ>0.75,λ=λ-0.5(1-λ),则定位结果X=X2+λ(X2-X1)。
具体的,本发明主要针对超宽带定位系统对待测目标的定位问题而提出。超宽带定位系统中一共有5个节点,其中包括4个锚节点和1个标签。4个锚节点的位置坐标已知,并以第一个锚节点A1作为该系统的坐标原点,而标签的位置坐标未知,需要利用其与4个锚节点的信息交互来解算出标签的位置坐标。超宽带定位系统示意图如图1所示,其中A1、A2、A3、A4为4个锚节点,T0为标签。本发明在对标签进行位置解算的流程如图2所示,其中第二步是利用改进的最小二乘算法实现的,第三步是利用改进的三边定位算法实现的。
Claims (2)
1.一种联合最小二乘和三边定位的超宽带室内定位方法,其特征在于,所述定位方法包括以下步骤:
步骤一:在对标签进行定位时,4个锚节点的位置固定且已知,设4个锚节点的坐标分别为A1(x1,y1,z1),A2(x2,y2,z2),A3(x3,y3,z3),A4(x4,y4,z4),标签的坐标设为(x,y,z),得到z1=z2=z3=z4,
利用锚节点A1、A2、A3对标签进行定位,设标签到锚节点A1、A2、A3的距离分别为d1、d2、d3,则标签到锚节点A1、A2、A3的距离di可以建立的方程如式(1)所示:
di 2=(x-xi)2+(y-yi)2+(z-zi)2
=(x2+y2+z2)-2xxi-2yyi-2zzi+(xi 2+yi 2+zi 2)
=R-2xxi-2yyi-2zzi+Ki(i=1,2,3) (1)
步骤二:将i=1,2,3分别带入式(1),组成由3个方程构成的方程组,并且将前2个方程依次减去第3个方程,得到下列矩阵关系如式(2)所示:
将公式(2)写成:AX=B,
步骤三:由最小二乘估计:
X=(ATA)-1ATB (3)
求出当前标签的x、y坐标,由于锚节点A1的位置为所建立坐标系的原点,则可以根据式:
求得关于当前3个锚节点构成平面的2个对称解:
步骤四:在基于锚节点A1、A2、A3求解出的定位结果的基础上,利用第四个锚节点A4对坐标结果进行优化,设2个对称解分别为X1,X2,SC为锚节点A4的位置,r为球的半径,接收到锚节点A4与标签T0间的距离值,
假设球与线段有交点,设球与线段相交的点为X=X1+λ(X2-X1),将该点带入球面方程:
(SC-X)2=r2 (6)
将球面方程转换为式(7)的形式:
αλ2+βλ+γ=0 (7)
得到方程的2个根如式(8)所示:
步骤五:针对不同情况对应的λ的取值对z轴坐标进行优化;
步骤六:每当接收到新的测距信息时,重复步骤一到步骤五,计算出当前时刻标签的精确位置,实现对标签运动轨迹的精确追踪。
2.根据权利要求1所述的一种联合最小二乘和三边定位的超宽带室内定位方法,其特征在于,在步骤五中,具体的,球面与线段的位置关系分为以下几种:
情况一:线段X1X2在球体之外,没有交点,此时λ1<0且λ2<0,令λ=min{|λ1|,|λ2|},则定位结果X=X2+0.5λ(X2-X1),
情况二:线段X1X2在球体之内,没有交点,此时λ1<0,λ2>1或者λ2<0,λ1>1,则定位结果X=X2+0.5(X2-X1),
情况三:线段X1X2与球体只有一个交点,此时0<λ1<1,λ2<0||λ2>1或者
0<λ2<1,λ1<0||λ1>1,令λ={λ1,λ2|λ∈(0,1)},如果λ≤0.5,λ新=0.5λ;如果λ>0.5,λ新=λ-0.5(1-λ),则定位结果X=X2+λ新(X2-X1),
情况四:线段X1X2与球体有两个交点,此时0<λ1<1并且0<λ2<1,令λ=(λ1+λ2)/2,则定位结果X=X2+λ(X2-X1),
情况五:线段X1X2与球体相切,只有一个交点,此时λ1=λ2,令λ=λ1=λ2,当λ≤0.25,λ=0.5λ;当0.25<λ≤0.5,λ新=λ-0.5(0.5-λ);当0.5<λ≤0.75,λ新=λ-0.5(λ-0.5);当λ>0.75,λ新=λ-0.5(1-λ),则定位结果X=X2+λ新(X2-X1)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911128414.1A CN110856104B (zh) | 2019-11-18 | 2019-11-18 | 一种联合最小二乘和三边定位的超宽带室内定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911128414.1A CN110856104B (zh) | 2019-11-18 | 2019-11-18 | 一种联合最小二乘和三边定位的超宽带室内定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110856104A CN110856104A (zh) | 2020-02-28 |
CN110856104B true CN110856104B (zh) | 2021-02-19 |
Family
ID=69602050
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911128414.1A Expired - Fee Related CN110856104B (zh) | 2019-11-18 | 2019-11-18 | 一种联合最小二乘和三边定位的超宽带室内定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110856104B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111540056A (zh) * | 2020-04-20 | 2020-08-14 | 爱知世元(北京)网络股份有限公司 | 一种ar智能导览方法和ar智能导览系统 |
CN113568021B (zh) * | 2021-08-10 | 2024-02-13 | 广东师大维智信息科技有限公司 | 一种室内外一体化精准定位的方法及系统 |
CN114594421B (zh) * | 2022-02-15 | 2022-11-18 | 湖北大学 | 一种基于最小二乘法与卡尔曼滤波器的移动靶点位置计算方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103338516A (zh) * | 2013-07-19 | 2013-10-02 | 大连理工大学 | 一种基于总体最小二乘的无线传感器网络两步定位方法 |
CN106358291A (zh) * | 2016-10-27 | 2017-01-25 | 观宇能源科技(上海)有限公司 | 一种基于信号强度的三边测量定位方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2307902B1 (en) * | 2008-07-04 | 2013-09-25 | Commonwealth Scientific and Industrial Research Organisation | Wireless localisation system |
US8700202B2 (en) * | 2010-11-30 | 2014-04-15 | Trimble Navigation Limited | System for positioning a tool in a work space |
CN103941231A (zh) * | 2014-05-13 | 2014-07-23 | 李建 | 超声射频信号联合处理的室内定位系统及定位方法 |
CN108594173A (zh) * | 2018-05-18 | 2018-09-28 | 浙江优勝科技有限公司 | 一种实现uwb的超宽带室内定位系统的设计方法 |
CN109884586A (zh) * | 2019-03-07 | 2019-06-14 | 广东工业大学 | 基于超带宽的无人机定位方法、装置、系统及存储介质 |
CN110376627A (zh) * | 2019-07-24 | 2019-10-25 | 东南大学 | 一种复杂环境中自适应的绝对定位方法及定位系统 |
-
2019
- 2019-11-18 CN CN201911128414.1A patent/CN110856104B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103338516A (zh) * | 2013-07-19 | 2013-10-02 | 大连理工大学 | 一种基于总体最小二乘的无线传感器网络两步定位方法 |
CN106358291A (zh) * | 2016-10-27 | 2017-01-25 | 观宇能源科技(上海)有限公司 | 一种基于信号强度的三边测量定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110856104A (zh) | 2020-02-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110856104B (zh) | 一种联合最小二乘和三边定位的超宽带室内定位方法 | |
CN109884586A (zh) | 基于超带宽的无人机定位方法、装置、系统及存储介质 | |
CN107271957B (zh) | 基于tdoa和toa的室内三维定位方法 | |
CN106814367B (zh) | 一种超宽带定位节点的自主位置测量方法 | |
CN105068550A (zh) | 一种基于拍卖模式的水下机器人多目标选择策略 | |
CN107169557A (zh) | 一种对布谷鸟优化算法进行改进的方法 | |
CN110333480B (zh) | 一种基于聚类的单无人机多目标aoa定位方法 | |
CN108375754A (zh) | Wsn中基于移动节点初始状态和移动状态的节点定位方法 | |
CN112584311B (zh) | 一种基于wknn融合的室内三维空间指纹定位方法 | |
CN104684081A (zh) | 基于距离聚类遴选锚节点的无线传感器网络节点定位算法 | |
CN111381209A (zh) | 一种测距定位的方法及装置 | |
CN112444778A (zh) | 一种基于dbscan的参考点加权三边质心定位方法 | |
CN109255837B (zh) | 一种用于激光雷达点云数据处理的高效b样条曲面的构造方法 | |
CN110658492A (zh) | 一种室内目标与散射体位置优化的迭代方法 | |
CN113794983B (zh) | 一种基于非线性几何约束优化的多目标室内定位方法 | |
CN107504862B (zh) | 一种全方位高精度激光定位方法 | |
CN109859287A (zh) | 一种自动生成矢量扇形的方法 | |
CN117607798A (zh) | 基于uwb的toa三维定位改进算法及其装置 | |
CN105160698A (zh) | 一种三角化射线跟踪路径搜索方法 | |
CN108387936A (zh) | 一种可控震源资料初至高效拾取方法及层析静校正方法 | |
CN109561384B (zh) | 一种复合噪声条件下的无线传感器网络节点定位方法 | |
CN106803266A (zh) | 一种船体复杂外板点云肋骨线提取方法及装置 | |
CN110986782A (zh) | 适用于机械手的标定方法 | |
CN114051207B (zh) | 信号干扰下超宽带精确定位方法、装置及电子设备 | |
CN115685128A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210219 Termination date: 20211118 |
|
CF01 | Termination of patent right due to non-payment of annual fee |