CN110798886B - 一种定位方法及装置 - Google Patents
一种定位方法及装置 Download PDFInfo
- Publication number
- CN110798886B CN110798886B CN201911067212.0A CN201911067212A CN110798886B CN 110798886 B CN110798886 B CN 110798886B CN 201911067212 A CN201911067212 A CN 201911067212A CN 110798886 B CN110798886 B CN 110798886B
- Authority
- CN
- China
- Prior art keywords
- target
- base station
- distance
- matrix
- difference
- 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
Links
Images
Classifications
-
- 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/003—Locating users or terminals or network equipment for network management purposes, e.g. mobility management locating network equipment
-
- 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
- H04W84/00—Network topologies
- H04W84/02—Hierarchically pre-organised networks, e.g. paging networks, cellular networks, WLAN [Wireless Local Area Network] or WLL [Wireless Local Loop]
- H04W84/04—Large scale networks; Deep hierarchical networks
- H04W84/06—Airborne or Satellite Networks
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Astronomy & Astrophysics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Mobile Radio Communication Systems (AREA)
Abstract
本发明实施例提供了一种定位方法及装置,获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及定位系统中其他各基站发送的探测信号到达目标的各第二到达时刻;根据第一到达时刻及各第二到达时刻,确定第一基站与其他各基站发送的探测信号到达目标的时间差;根据传输时长及时间差,确定第一基站到目标的距离,及第一基站与其他各基站到目标的距离差;根据距离及各距离差,确定目标的位置信息。本发明实施例中,根据距离可以确定与第一基站的距离相等的多个位置点,基于第一基站与其他各基站到目标的距离差,从很多个与第一基站的距离相等的位置点中,筛选出个别位置点进行定位,从而提高了目标定位的准确度。
Description
技术领域
本发明涉及定位技术领域,特别是涉及一种定位方法及装置。
背景技术
目前,在定位技术中,全球卫星定位系统技术应用较为广泛,已经可以满足室外行人的服务需求,然而,在城市建筑密集区域以室内环境下,高楼等障碍物的遮挡使得卫星定位信号的传播受到阻碍,全球卫星定位系统在这些环境下无法得到精准的定位结果。
因此,基于无线信号进行定位的技术被提出,目标可以与一个基站进行通信,基站发送探测信号,记录下发送探测信号的发送时刻,目标在接收到探测信号后,立即回复响应信号,基站接收到响应信号,并记录下接收到响应信号的接收时刻,将接收时刻与发送时刻作差,得到的时间差即为一个信号从发出到返回的总时长,该总时长乘以空速再除以2即得到了基站与目标的距离,由于基站的位置往往是固定的,基于计算出的距离可以大致判断出目标的位置。
然而,在基站的空间范围内,实际有很多个位置点与该基站的距离相等,即基于计算出的距离所确定的目标的位置并不是唯一的,导致定位结果不准确。
发明内容
本发明实施例的目的在于提供一种定位方法及装置,以提高目标定位的准确度。具体技术方案如下:
第一方面,本发明实施例提供了一种定位方法,该方法包括:
获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及所述定位系统中除所述第一基站以外的其他各基站发送的探测信号到达所述目标的各第二到达时刻,其中,所述定位系统包括多个基站,所述第一基站为所述多个基站中与所述目标相互通信的基站;
根据所述第一到达时刻及所述各第二到达时刻,确定所述第一基站与所述其他各基站发送的探测信号到达所述目标的时间差;
根据所述传输时长,确定所述第一基站到所述目标的距离,并根据所述时间差,确定所述第一基站与所述其他各基站到所述目标的距离差;
根据所述距离及各距离差,确定所述目标的位置信息。
特别的,所述根据所述距离及各距离差,确定所述目标的位置信息,包括:
对所述各距离差进行线性化变换,得到线性化变换结果;
根据所述距离及所述线性化变换结果,构建第一线性化矩阵,所述第一线性化矩阵为:
其中,
(x,y)为所述目标的位置坐标,(x0,y0)为所述第一基站的位置坐标,(xi,yi)为所述其他各基站的位置坐标,d0为根据所述传输时长确定的所述第一基站到所述目标的距离,r0为所述第一基站和所述目标间的真实距离,xi,0=(x0-xi)为所述第一基站与所述其他各基站到所述目标的横坐标的差值,yi,0=(y0-yi)为所述第一基站与所述其他各基站到所述目标的纵坐标的差值,di,0为所述第一基站与所述其他各基站到所述目标的距离差,为构建第一线性化矩阵的误差向量,i表示所述其他各基站中的第i个基站,i=1,2,…M-1,M≥3,M为所述定位系统中所有基站的总数;
根据所述线性化矩阵,利用最小二乘法,计算所述目标的位置信息。
特别的,所述距离及所述距离差包括转换误差,所述转换误差为将时间数据转换为距离数据所产生的误差,所述时间数据包括所述传输时长及所述时间差,所述距离数据包括所述距离及所述距离差;
所述根据所述线性化矩阵,利用最小二乘法,计算所述目标的位置信息,包括:
根据所述线性化矩阵,利用最小二乘法,对所述目标进行初步定位,得到初步定位结果,所述初步定位结果包括所述目标的横纵坐标及所述目标到所述第一基站的距离;
获取所述定位系统中各基站的位置信息;
根据所述初步定位结果、所述各基站的位置信息及所述线性化矩阵,计算包含各转换误差的第一误差向量,并基于所述第一误差向量,确定关于所述目标的位置的第一加权矩阵,其中,所述第一误差向量为:
其中,
e0为将所述传输时长转换为所述距离产生的误差,ei为将所述时间差转换为所述距离差产生的误差,(x',y')为所述初步定位结果得到的所述目标的横纵坐标;
根据所述第一加权矩阵,利用最小二乘法,确定所述目标的位置信息。
特别的,所述根据所述第一加权矩阵,利用最小二乘法,确定所述目标的位置信息,包括:
根据所述第一加权矩阵,利用最小二乘法,对所述目标进行二次定位,得到二次定位结果,所述二次定位结果包括所述目标的横纵坐标及所述目标到所述第一基站的距离;
根据所述二次定位结果,构建第二线性化矩阵及所述目标的位置信息对角阵,所述第二线性化矩阵为:
ε=h′-G′Δu
其中,
(x0,y0)为所述第一基站的位置坐标,r0为所述第一基站和所述目标间的真实距离,ex为所述目标实际位置的横坐标与所述二次定位结果得到的横坐标间的误差,ey为所述目标实际位置的纵坐标与所述二次定位结果得到的纵坐标间的误差,er为r0与所述二次定位结果得到的所述目标到所述第一基站的距离间的误差,ε为构建所述第二线性化矩阵的误差向量,
所述位置信息对角阵为:
其中,(x”,y”,r0”)为所述二次定位结果得到的所述目标的横纵坐标及所述目标到所述第一基站的距离;
根据所述第二线性化矩阵及所述位置信息对角阵,利用最小二乘法,确定所述目标的位置信息。
特别的,所述基于所述第一误差向量及所述其他各基站的位置信息,确定关于所述目标的位置的第一加权矩阵,包括:
根据所述第一误差向量,计算所述第一误差向量的协方差矩阵,所述协方差矩阵为:
对所述协方差矩阵进行运算,得到第一加权矩阵,所述第一加权矩阵为:
本发明实施例还提供一种定位装置,该装置包括:
获取模块,用于获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及所述定位系统中除所述第一基站以外的其他各基站发送的探测信号到达所述目标的各第二到达时刻,其中,所述定位系统包括多个基站,所述第一基站为所述多个基站中与所述目标相互通信的基站;
第一确定模块,用于根据所述第一到达时刻及所述各第二到达时刻,确定所述第一基站与所述其他各基站发送的探测信号到达所述目标的时间差;
第二确定模块,用于根据所述传输时长,确定所述第一基站到所述目标的距离,并根据所述时间差,确定所述第一基站与所述其他各基站到所述目标的距离差;
定位模块,用于根据所述距离及各距离差,确定所述目标的位置信息。
特别的,所述定位模块,具体包括:
转换模块,用于对所述各距离差进行线性化变换,得到线性化变换结果;
构建模块,用于根据所述距离及所述线性化变换结果,构建第一线性化矩阵,所述第一线性化矩阵为:
其中,
(x,y)为所述目标的位置坐标,(x0,y0)为所述第一基站的位置坐标,(xi,yi)为所述其他各基站的位置坐标,d0为根据所述传输时长确定的所述第一基站到所述目标的距离,r0为所述第一基站和所述目标间的真实距离,xi,0=(x0-xi)为所述第一基站与所述其他各基站到所述目标的横坐标的差值,yi,0=(y0-yi)为所述第一基站与所述其他各基站到所述目标的纵坐标的差值,di,0为所述第一基站与所述其他各基站到所述目标的距离差,为构建第一线性化矩阵的误差向量,i表示所述其他各基站中的第i个基站,i=1,2,…M-1,M≥3,M为所述定位系统中所有基站的总数;
计算模块,用于根据所述线性化矩阵,利用最小二乘法,计算所述目标的位置信息。
特别的,所述距离及所述距离差包括转换误差,所述转换误差为将时间数据转换为距离数据所产生的误差,所述时间数据包括所述传输时长及所述时间差,所述距离数据包括所述距离及所述距离差;
所述计算模块,具体用于:
根据所述线性化矩阵,利用最小二乘法,对所述目标进行初步定位,得到初步定位结果,所述初步定位结果包括所述目标的横纵坐标及所述目标到所述第一基站的距离;
获取所述定位系统中各基站的位置信息;
根据所述初步定位结果、所述各基站的位置信息及所述线性化矩阵,计算包含各转换误差的第一误差向量,并基于所述第一误差向量,确定关于所述目标的位置的第一加权矩阵,其中,所述第一误差向量为:
其中,
e0为将所述传输时长转换为所述距离产生的误差,ei为将所述时间差转换为所述距离差产生的误差,(x',y')为所述初步定位结果得到的所述目标的横纵坐标;
根据所述第一加权矩阵,利用最小二乘法,确定所述目标的位置信息。
特别的,在所述根据所述第一加权矩阵,利用加权最小二乘法,确定所述目标的位置信息时,所述计算模块,具体用于:
根据所述第一加权矩阵,利用加权最小二乘法,对所述目标进行二次定位,得到二次定位结果,所述二次定位结果包括所述目标的横纵坐标及所述目标到所述第一基站的距离;
根据所述二次定位结果,构建第二线性化矩阵及所述目标的位置信息对角阵,所述第二线性化矩阵为:
ε=h′-G′Δu
其中,
(x0,y0)为所述第一基站的位置坐标,r0为所述第一基站和所述目标间的真实距离,ex为所述目标实际位置的横坐标与所述二次定位结果得到的横坐标间的误差,ey为所述目标实际位置的纵坐标与所述二次定位结果得到的纵坐标间的误差,er为r0与所述二次定位结果得到的所述目标到所述第一基站的距离间的误差,ε为构建所述第二线性化矩阵的误差向量,
所述位置信息对角阵为:
其中,(x”,y”,r0”)为所述二次定位结果得到的所述目标的横纵坐标及所述目标到所述第一基站的距离;
根据所述第二线性化矩阵及所述位置信息对角阵,利用最小二乘法,确定所述目标的位置信息。
特别的,在所述基于所述第一误差向量及所述其他各基站的位置信息,确定关于所述目标的位置的第一加权矩阵时,所述计算模块,具体用于:
根据所述第一误差向量,计算所述第一误差向量的协方差矩阵,所述协方差矩阵为:
对所述协方差矩阵进行运算,得到第一加权矩阵,所述第一加权矩阵为:
本发明实施例提供一种定位方法及装置,获取定位系统中第一基站发出的探测信号到达目标的第一到达时刻及传输时长,以及定位系统中除第一基站以外的其他各基站发出的探测信号到达目标的各第二到达时刻,其中,定位系统包括多个基站,第一基站为多个基站中与目标相互通信的基站;根据第一到达时刻及各第二到达时刻,确定第一基站与其他各基站发出的探测信号到达目标的时间差;根据传输时长,确定第一基站到目标的距离,并根据时间差,确定第一基站与其他各基站到目标的距离差;根据距离及距离差,确定目标的位置。
本发明中利用定位系统中第一基站发出的探测信号到达目标的传输时长,确定第一基站到目标的距离,并利用第一基站发出的探测信号到达目标的第一到达时刻、其他各基站发出的探测信号到达目标的各第二到达时刻,确定第一基站与其他各基站发出的探测信号到达目标的时间差,并根据时间差得到第一基站与其他各基站到目标的距离差,然后根据距离和距离差,计算出目标的位置。应用本发明,根据距离可以确定与第一基站的距离相等的多个位置点,而不同的位置点与其余基站的距离是不同的,基于第一基站与其他各基站到目标的距离差,从很多个与第一基站的距离相等的位置点中,筛选出个别位置点进行定位,从而提高了目标定位的准确度。当然,实施本发明的任一产品或方法必不一定需要同时达到以上所述的所有优点。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种定位方法流程图。
图2为本发明实施例提供的一种定位装置结构示意图。
图3为本发明实施例提供的一种电子设备结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例公开了一种定位方法及装置,以下分别进行详细说明。
参见图1,图1为本发明实施例提供的一种定位方法流程图,具体技术方案包括:
S101:获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及定位系统中除第一基站以外的其他各基站发送的探测信号到达目标的各第二到达时刻,其中,定位系统包括多个基站,第一基站为多个基站中与目标相互通信的基站。
S102:根据第一到达时刻及各第二到达时刻,确定第一基站与其他各基站发送的探测信号到达目标的时间差。
S103:根据传输时长,确定第一基站到目标的距离,并根据时间差,确定第一基站与其他各基站到目标的距离差。
S104:根据距离及各距离差,确定目标的位置信息。
应用本发明,根据距离可以确定与第一基站的距离相等的多个位置点,而不同的位置点与其余基站的距离是不同的,基于第一基站与其他各基站到目标的距离差,从很多个与第一基站的距离相等的位置点中,筛选出个别位置点进行定位,从而提高了目标定位的准确度。
定位过程中目标可以接收到来自多个基站的探测信号,并且与其中的第一基站相互通信。第一基站发送探测信号,记录下发送探测信号的发送时刻,目标在接收到探测信号后,立即向第一基站回复响应信号,第一基站接收到响应信号,并记录下接收到响应信号的接收时刻,将接收时刻与发送时刻作差,得到的时间差即为一个信号从发出到返回的总时长,该总时长除以2即得到了第一基站发送的探测信号到达目标的传输时长。
目标在接收到第一基站发出的探测信号时,记录下第一到达时刻;在接收到定位系统中除第一基站以外的其他各基站发送的探测信号时,记录下各第二到达时刻;第一基站发送的探测信号到达目标的过程时间为传输时长,其他各基站发送的探测信号到达目标的过程时间为其他各传输时长,第一到达时刻与各第二到达时刻作差,得到传输时长与其他各传输时长间的时间差。
传输时长记作t0,时间差记作ti,0,c是无线信号在空气中的传播速度,传输时长乘以速度,得到第一基站到目标的空间距离,即距离。其他各基站与目标间的空间距离为其他各距离,时间差乘以速度,得到距离与其他各距离间的距离差。将距离记作d0,将距离差记作di,0,则:
ct0=d0
cti,0=di,0
第一基站的位置表示为a0=(x0,y0)T,其他各基站的位置表示为ai=(xi,yi)T,i=1,2,…M-1,M≥3,M为定位系统中所有基站的总数,目标的位置表示为u=(x,y)T,将传输时长转换为距离产生的误差记作e0,将时间差转换为距离差产生的误差记作ei,则用位置坐标表示距离和距离差,可以构建定位方程组:
特别的,S104具体可以包括:
对各距离差进行线性化变换,得到线性化变换结果;
根据距离及线性化变换结果,构建第一线性化矩阵,第一线性化矩阵为:
其中,
(x,y)为目标的位置坐标,(x0,y0)为第一基站的位置坐标,(xi,yi)为其他各基站的位置坐标,d0为根据传输时长确定的第一基站到目标的距离,r0为第一基站和目标间的真实距离,xi,0=(x0-xi)为第一基站与其他各基站到目标的横坐标的差值,yi,0=(y0-yi)为第一基站与其他各基站到目标的纵坐标的差值,di,0为第一基站与其他各基站到目标的距离差,为构建第一线性化矩阵的误差向量,i表示其他各基站中的第i个基站,i=1,2,…M-1,M≥3,M为定位系统中所有基站的总数;
根据线性化矩阵,利用最小二乘法,计算目标的位置信息。
对定位方程组中表示距离差的等式进行线性化变化:
对线性化变化的等式进行简化,可以的到:
特别的,距离及距离差包括转换误差,转换误差为将时间数据转换为距离数据所产生的误差,时间数据包括传输时长及时间差,距离数据包括距离及距离差;
根据线性化矩阵,利用最小二乘法,计算目标的位置信息,包括:
根据线性化矩阵,利用最小二乘法,对目标进行初步定位,得到初步定位结果,初步定位结果包括目标的横纵坐标及目标到所述第一基站的距离;
获取定位系统中各基站的位置信息;
根据初步定位结果、各基站的位置信息及线性化矩阵,计算包含各转换误差的第一误差向量,并基于第一误差向量,确定关于目标的位置的第一加权矩阵,其中,第一误差向量为:
其中,
e0为将传输时长转换为距离产生的误差,ei为将时间差转换为距离差产生的误差,(x',y')为初步定位结果得到的所述目标的横纵坐标;
根据第一加权矩阵,利用最小二乘法,确定目标的位置信息。
假设向量中各项相同,则根据Gw=h,使用线性最小二乘可以求得初步定位结果w'=(x',y',r0')T,x'、y'、r0'分别为初步定位结果得到的目标的横纵坐标及目标到所述第一基站的距离,求解w'的过程为:
w'=(GTG)-1GTh
这里,e0与ei是不相关的。然后,根据第一误差向量,确定关于目标的位置的第一加权矩阵W,根据第一加权矩阵,确定目标的位置信息。
特别的,根据第一加权矩阵,利用最小二乘法,确定目标的位置信息,包括:
根据第一加权矩阵,利用最小二乘法,对目标进行二次定位,得到二次定位结果,二次定位结果包括目标的横纵坐标及目标到第一基站的距离;
根据二次定位结果,构建第二线性化矩阵及目标的位置信息对角阵,第二线性化矩阵为:
ε=h′-G′Δu
其中,
(x0,y0)为第一基站的位置坐标,r0为第一基站和目标间的真实距离,ex为目标实际位置的横坐标与二次定位结果得到的横坐标间的误差,ey为目标实际位置的纵坐标与二次定位结果得到的纵坐标间的误差,er为r0与二次定位结果得到的目标到第一基站的距离间的误差,ε为构建第二线性化矩阵的误差向量,所述位置信息对角阵为:
其中,(x”,y”,r0”)为二次定位结果得到的目标的横纵坐标及目标到第一基站的距离;
根据第二线性化矩阵及位置信息对角阵,利用最小二乘法,确定目标的位置信息。
即,根据第一加权矩阵W和矩阵关系式使用加权最小二乘得到二次定位结果w”=(x”,y”,r0”)T,x”、y”、r0”分别为二次定位结果得到的目标的横纵坐标及目标到所述第一基站的距离,求解w”的过程为:
w”=(GTWG)-1GTWh
根据二次定位结果,带入x、y与r0的约束关系,构建第二线性化矩阵:
ε=h′-G′Δu
其中,
并构建目标的位置信息对角阵:
根据第二线性化矩阵及位置信息对角阵,利用加权最小二乘法,求解Δu,求解过程为:
根据Δu确定目标的位置信息:
由此,可以计算出关于位置信息的两个结果s1、s2,从s1、s2中确定距离二次定位结果得到的目标点(x”,y”)较近的一个为最终定位结果u。
特别的,基于第一误差向量及其他各基站的位置信息,确定关于目标的位置的第一加权矩阵,包括:
根据第一误差向量,计算第一误差向量的协方差矩阵,协方差矩阵为:
对协方差矩阵进行运算,得到第一加权矩阵,第一加权矩阵为:
本发明实施例还提供一种定位装置,参见图2,该装置包括获取模块210、第一确定模块220、第二确定模块230、定位模块240,其中:
获取模块210,用于获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及定位系统中除第一基站以外的其他各基站发送的探测信号到达目标的各第二到达时刻,其中,定位系统包括多个基站,第一基站为多个基站中与目标相互通信的基站。
第一确定模块220,用于根据第一到达时刻及各第二到达时刻,确定第一基站与其他各基站发送的探测信号到达目标的时间差。
第二确定模块230,用于根据传输时长,确定第一基站到目标的距离,并根据时间差,确定第一基站与其他各基站到目标的距离差。
定位模块240,用于根据距离及各距离差,确定目标的位置信息。
特别的,定位模块240,具体可以包括:
转换模块2401,用于对各距离差进行线性化变换,得到线性化变换结果;
构建模块2402,用于根据距离及线性化变换结果,构建第一线性化矩阵,第一线性化矩阵为:
其中,
(x,y)为目标的位置坐标,(x0,y0)为第一基站的位置坐标,(xi,yi)为其他各基站的位置坐标,d0为根据传输时长确定的第一基站到目标的距离,r0为第一基站和目标间的真实距离,xi,0=(x0-xi)为第一基站与其他各基站到目标的横坐标的差值,yi,0=(y0-yi)为第一基站与其他各基站到目标的纵坐标的差值,di,0为第一基站与其他各基站到目标的距离差,为构建第一线性化矩阵的误差向量,i表示其他各基站中的第i个基站,i=1,2,…M-1,M≥3,M为定位系统中所有基站的总数;
计算模块2403,用于根据线性化矩阵,利用最小二乘法,计算目标的位置信息。
特别的,距离及距离差包括转换误差,转换误差为将时间数据转换为距离数据所产生的误差,时间数据包括传输时长及时间差,距离数据包括距离及距离差;
计算模块2403,具体可以用于:
根据线性化矩阵,利用最小二乘法,对目标进行初步定位,得到初步定位结果,初步定位结果包括目标的横纵坐标及目标到所述第一基站的距离;
获取定位系统中各基站的位置信息;
根据初步定位结果、各基站的位置信息及线性化矩阵,计算包含各转换误差的第一误差向量,并基于第一误差向量,确定关于目标的位置的第一加权矩阵,其中,第一误差向量为:
其中,
e0为将传输时长转换为距离产生的误差,ei为将时间差转换为距离差产生的误差,(x',y')为初步定位结果得到的所述目标的横纵坐标;
根据第一加权矩阵,利用最小二乘法,确定目标的位置信息。
特别的,在根据第一加权矩阵,利用最小二乘法,确定目标的位置信息时,计算模块2403,具体可以用于:
根据第一加权矩阵,利用最小二乘法,对目标进行二次定位,得到二次定位结果,二次定位结果包括目标的横纵坐标及目标到第一基站的距离;
根据二次定位结果,构建第二线性化矩阵及目标的位置信息对角阵,第二线性化矩阵为:
ε=h′-G′Δu
其中,
(x0,y0)为第一基站的位置坐标,r0为第一基站和目标间的真实距离,ex为目标实际位置的横坐标与二次定位结果得到的横坐标间的误差,ey为目标实际位置的纵坐标与二次定位结果得到的纵坐标间的误差,er为r0与二次定位结果得到的目标到第一基站的距离间的误差,ε为构建第二线性化矩阵的误差向量,所述位置信息对角阵为:
其中,(x”,y”,r0”)为二次定位结果得到的目标的横纵坐标及目标到第一基站的距离;
根据第二线性化矩阵及位置信息对角阵,利用最小二乘法,确定目标的位置信息。
特别的,在基于第一误差向量及其他各基站的位置信息,确定关于目标的位置的第一加权矩阵时,计算模块2403,具体可以用于:
根据第一误差向量,计算第一误差向量的协方差矩阵,协方差矩阵为:
对协方差矩阵进行运算,得到第一加权矩阵,第一加权矩阵为:
应用本发明,根据距离可以确定与第一基站的距离相等的多个位置点,而不同的位置点与其余基站的距离是不同的,基于第一基站与其他各基站到目标的距离差,从很多个与第一基站的距离相等的位置点中,筛选出个别位置点进行定位,从而提高了目标定位的准确度。
本发明实施例还提供了一种电子设备,如图3所示,包括处理器301、通信接口302、存储器303和通信总线304,其中,处理器301,通信接口302,存储器303通过通信总线304完成相互间的通信,
存储器303,用于存放计算机程序;
处理器301,用于执行存储器303上所存放的程序时,实现如下步骤:
获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及定位系统中除第一基站以外的其他各基站发送的探测信号到达目标的各第二到达时刻,其中,定位系统包括多个基站,第一基站为多个基站中与目标相互通信的基站;
根据第一到达时刻及各第二到达时刻,确定第一基站与其他各基站发送的探测信号到达目标的时间差;
根据传输时长,确定第一基站到目标的距离,并根据时间差,确定第一基站与其他各基站到目标的距离差;
根据距离及各距离差,确定目标的位置信息。
上述电子设备提到的通信总线可以是PCI(Peripheral ComponentInterconnect,外设部件互连标准)总线或EISA(Extended Industry StandardArchitecture,扩展工业标准结构)总线等。该通信总线可以分为地址总线、数据总线、控制总线等。为便于表示,图中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
通信接口用于上述电子设备与其他设备之间的通信。
存储器可以包括RAM(Random Access Memory,随机存取存储器),也可以包括NVM(Non-Volatile Memory,非易失性存储器),例如至少一个磁盘存储器。可选的,存储器还可以是至少一个位于远离前述处理器的存储装置。
上述的处理器可以是通用处理器,包括CPU(Central Processing Unit,中央处理器)、NP(Network Processor,网络处理器)等;还可以是DSP(Digital Signal Processor,数字信号处理器)、ASIC(Application Specific Integrated Circuit,专用集成电路)、FPGA(Field-Programmable Gate Array,现场可编程门阵列)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
本实施例中,处理器301通过读取存储器303中存储的机器可执行指令,被机器可执行指令促使能够实现:获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及定位系统中除第一基站以外的其他各基站发送的探测信号到达目标的各第二到达时刻,其中,定位系统包括多个基站,第一基站为多个基站中与目标相互通信的基站;根据第一到达时刻及各第二到达时刻,确定第一基站与其他各基站发送的探测信号到达目标的时间差;根据传输时长,确定第一基站到目标的距离,并根据时间差,确定第一基站与其他各基站到目标的距离差;根据距离及各距离差,确定目标的位置信息。本发明实施例中,根据距离可以确定与第一基站的距离相等的多个位置点,而不同的位置点与其余基站的距离是不同的,基于第一基站与其他各基站到目标的距离差,从很多个与第一基站的距离相等的位置点中,筛选出个别位置点进行定位,从而提高了目标定位的准确度。
本发明实施例还提供一种计算机可读存储介质,其中计算机可读存储介质内存储有计算机程序,计算机程序被处理器执行时至少实现如下步骤:
获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及定位系统中除第一基站以外的其他各基站发送的探测信号到达目标的各第二到达时刻,其中,定位系统包括多个基站,第一基站为多个基站中与目标相互通信的基站;
根据第一到达时刻及各第二到达时刻,确定第一基站与其他各基站发送的探测信号到达目标的时间差;
根据传输时长,确定第一基站到目标的距离,并根据时间差,确定第一基站与其他各基站到目标的距离差;
根据距离及各距离差,确定目标的位置信息。
本实施例中,机器可读存储介质在运行时执行本发明实施例所提供的方法的计算机程序,因此能够实现:获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及定位系统中除第一基站以外的其他各基站发送的探测信号到达目标的各第二到达时刻,其中,定位系统包括多个基站,第一基站为多个基站中与目标相互通信的基站;根据第一到达时刻及各第二到达时刻,确定第一基站与其他各基站发送的探测信号到达目标的时间差;根据传输时长,确定第一基站到目标的距离,并根据时间差,确定第一基站与其他各基站到目标的距离差;根据距离及各距离差,确定目标的位置信息。本发明实施例中,根据距离可以确定与第一基站的距离相等的多个位置点,而不同的位置点与其余基站的距离是不同的,基于第一基站与其他各基站到目标的距离差,从很多个与第一基站的距离相等的位置点中,筛选出个别位置点进行定位,从而提高了目标定位的准确度。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于装置、电子设备和计算机可读存储介质实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
以上所述仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本发明的保护范围内。
Claims (8)
1.一种目标定位方法,其特征在于,所述方法包括:
获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及所述定位系统中除所述第一基站以外的其他各基站发送的探测信号到达所述目标的各第二到达时刻,其中,所述定位系统包括多个基站,所述第一基站为所述多个基站中与所述目标相互通信的基站;
根据所述第一到达时刻及所述各第二到达时刻,确定所述第一基站与所述其他各基站发送的探测信号到达所述目标的时间差;
根据所述传输时长,确定所述第一基站到所述目标的距离,并根据所述时间差,确定所述第一基站与所述其他各基站到所述目标的距离差;
根据所述距离及各距离差,确定所述目标的位置信息;
所述根据所述距离及各距离差,确定所述目标的位置信息,包括:
对所述各距离差进行线性化变换,得到线性化变换结果;
根据所述距离及所述线性化变换结果,构建第一线性化矩阵,所述第一线性化矩阵为:
其中,
(x,y)为所述目标的位置坐标,(x0,y0)为所述第一基站的位置坐标,(xi,yi)为所述其他各基站的位置坐标,d0为根据所述传输时长确定的所述第一基站到所述目标的距离,r0为所述第一基站和所述目标间的真实距离,xi,0=(x0-xi)为所述第一基站与所述其他各基站到所述目标的横坐标的差值,yi,0=(y0-yi)为所述第一基站与所述其他各基站到所述目标的纵坐标的差值,di,0为所述第一基站与所述其他各基站到所述目标的距离差,为构建第一线性化矩阵的误差向量,i表示所述其他各基站中的第i个基站,i=1,2,…M-1,M≥3,M为所述定位系统中所有基站的总数;
根据所述线性化矩阵,利用最小二乘法,计算所述目标的位置信息;
所述对所述各距离差进行线性化变换,得到线性化变换结果;根据所述距离及所述线性化变换结果,构建第一线性化矩阵,包括:
对定位方程组中表示距离差的等式进行线性化变化:
对线性化变化的等式进行简化,可以的到:
根据简化后的等式,将定位方程组变换为矩阵形式。
2.根据权利要求1所述方法,其特征在于,所述距离及所述距离差包括转换误差,所述转换误差为将时间数据转换为距离数据所产生的误差,所述时间数据包括所述传输时长及所述时间差,所述距离数据包括所述距离及所述距离差;
所述根据所述线性化矩阵,利用最小二乘法,计算所述目标的位置信息,包括:
根据所述线性化矩阵,利用最小二乘法,对所述目标进行初步定位,得到初步定位结果,所述初步定位结果包括所述目标的横纵坐标及所述目标到所述第一基站的距离;
获取所述定位系统中各基站的位置信息;
根据所述初步定位结果、所述各基站的位置信息及所述线性化矩阵,计算包含各转换误差的第一误差向量,并基于所述第一误差向量,确定关于所述目标的位置的第一加权矩阵,其中,所述第一误差向量为:
其中,
e0为将所述传输时长转换为所述距离产生的误差,ei为将所述时间差转换为所述距离差产生的误差,(x',y')为所述初步定位结果得到的所述目标的横纵坐标;
根据所述第一加权矩阵,利用最小二乘法,确定所述目标的位置信息。
3.根据权利要求2所述的方法,其特征在于,所述根据所述第一加权矩阵,利用最小二乘法,确定所述目标的位置信息,包括:
根据所述第一加权矩阵,利用最小二乘法,对所述目标进行二次定位,得到二次定位结果,所述二次定位结果包括所述目标的横纵坐标及所述目标到所述第一基站的距离;
根据所述二次定位结果,构建第二线性化矩阵及所述目标的位置信息对角阵,所述第二线性化矩阵为:
ε=h′-G′Δu
其中,
ex为所述目标实际位置的横坐标与所述二次定位结果得到的横坐标间的误差,
ey为所述目标实际位置的纵坐标与所述二次定位结果得到的纵坐标间的误差,
er为r0与所述二次定位结果得到的所述目标到所述第一基站的距离间的误差,
ε为构建所述第二线性化矩阵的误差向量,
所述位置信息对角阵为:
其中,(x”,y”,r0”)为所述二次定位结果得到的所述目标的横纵坐标及所述目标到所述第一基站的距离;
根据所述第二线性化矩阵及所述位置信息对角阵,利用最小二乘法,确定所述目标的位置信息。
5.一种定位装置,其特征在于,所述装置包括:
获取模块,用于获取定位系统中第一基站发送的探测信号到达目标的第一到达时刻及传输时长,以及所述定位系统中除所述第一基站以外的其他各基站发送的探测信号到达所述目标的各第二到达时刻,其中,所述定位系统包括多个基站,所述第一基站为所述多个基站中与所述目标相互通信的基站;
第一确定模块,用于根据所述第一到达时刻及所述各第二到达时刻,确定所述第一基站与所述其他各基站发送的探测信号到达所述目标的时间差;
第二确定模块,用于根据所述传输时长,确定所述第一基站到所述目标的距离,并根据所述时间差,确定所述第一基站与所述其他各基站到所述目标的距离差;
定位模块,用于根据所述距离及各距离差,确定所述目标的位置信息;
所述定位模块,具体包括:
转换模块,用于对所述各距离差进行线性化变换,得到线性化变换结果;
构建模块,用于根据所述距离及所述线性化变换结果,构建第一线性化矩阵,所述第一线性化矩阵为:
其中,
(x,y)为所述目标的位置坐标,(x0,y0)为所述第一基站的位置坐标,(xi,yi)为所述其他各基站的位置坐标,d0为根据所述传输时长确定的所述第一基站到所述目标的距离,r0为所述第一基站和所述目标间的真实距离,xi,0=(x0-xi)为所述第一基站与所述其他各基站到所述目标的横坐标的差值,yi,0=(y0-yi)为所述第一基站与所述其他各基站到所述目标的纵坐标的差值,di,0为所述第一基站与所述其他各基站到所述目标的距离差,为构建第一线性化矩阵的误差向量,i表示所述其他各基站中的第i个基站,i=1,2,…M-1,M≥3,M为所述定位系统中所有基站的总数;
计算模块,用于根据所述线性化矩阵,利用最小二乘法,计算所述目标的位置信息;
所述构建模块,具体用于:
对定位方程组中表示距离差的等式进行线性化变化:
对线性化变化的等式进行简化,可以的到:
根据简化后的等式,将定位方程组变换为矩阵形式。
6.根据权利要求5所述装置,其特征在于,所述距离及所述距离差包括转换误差,所述转换误差为将时间数据转换为距离数据所产生的误差,所述时间数据包括所述传输时长及所述时间差,所述距离数据包括所述距离及所述距离差;
所述计算模块,具体用于:
根据所述线性化矩阵,利用最小二乘法,对所述目标进行初步定位,得到初步定位结果,所述初步定位结果包括所述目标的横纵坐标及所述目标到所述第一基站的距离;
获取所述定位系统中各基站的位置信息;
根据所述初步定位结果、所述各基站的位置信息及所述线性化矩阵,计算包含各转换误差的第一误差向量,并基于所述第一误差向量,确定关于所述目标的位置的第一加权矩阵,其中,所述第一误差向量为:
其中,
e0为将所述传输时长转换为所述距离产生的误差,ei为将所述时间差转换为所述距离差产生的误差,(x',y')为所述初步定位结果得到的所述目标的横纵坐标;
根据所述第一加权矩阵,利用最小二乘法,确定所述目标的位置信息。
7.根据权利要求6所述的装置,其特征在于,在所述根据所述第一加权矩阵,利用最小二乘法,确定所述目标的位置信息时,所述计算模块,具体用于:
根据所述第一加权矩阵,利用最小二乘法,对所述目标进行二次定位,得到二次定位结果,所述二次定位结果包括所述目标的横纵坐标及所述目标到所述第一基站的距离;
根据所述二次定位结果,构建第二线性化矩阵及所述目标的位置信息对角阵,所述第二线性化矩阵为:
ε=h′-G′Δu
其中,
ex为所述目标实际位置的横坐标与所述二次定位结果得到的横坐标间的误差,
ey为所述目标实际位置的纵坐标与所述二次定位结果得到的纵坐标间的误差,
er为r0与所述二次定位结果得到的所述目标到所述第一基站的距离间的误差,
ε为构建所述第二线性化矩阵的误差向量,
所述位置信息对角阵为:
其中,(x”,y”,r0”)为所述二次定位结果得到的所述目标的横纵坐标及所述目标到所述第一基站的距离;
根据所述第二线性化矩阵及所述位置信息对角阵,利用最小二乘法,确定所述目标的位置信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911067212.0A CN110798886B (zh) | 2019-11-04 | 2019-11-04 | 一种定位方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911067212.0A CN110798886B (zh) | 2019-11-04 | 2019-11-04 | 一种定位方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110798886A CN110798886A (zh) | 2020-02-14 |
CN110798886B true CN110798886B (zh) | 2021-01-01 |
Family
ID=69442558
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911067212.0A Active CN110798886B (zh) | 2019-11-04 | 2019-11-04 | 一种定位方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110798886B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111263299B (zh) * | 2020-03-03 | 2021-04-23 | 中国科学技术大学 | 一种定位方法、装置、电子设备及存储介质 |
CN112073905B (zh) * | 2020-09-15 | 2022-10-28 | Oppo广东移动通信有限公司 | 距离差确定方法、数据帧传输方法及相关产品 |
CN112543415B (zh) * | 2020-12-24 | 2024-02-23 | 安标国家矿用产品安全标志中心有限公司 | 一种确定最大动态定位误差的方法及系统 |
CN115308685B (zh) * | 2022-07-14 | 2024-02-02 | 南京信息工程大学 | 一种基于多基站通信伪距信息的外辐射源目标定位方法 |
CN117676790A (zh) * | 2022-08-19 | 2024-03-08 | 中兴通讯股份有限公司 | 感知同步的方法和设备、计算机可读介质 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106054227A (zh) * | 2016-07-04 | 2016-10-26 | 西北工业大学 | 惯导辅助下的伪距差值单星高动态定位方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7729707B2 (en) * | 2006-10-24 | 2010-06-01 | Aeroscout, Inc. | Method and system for synchronization offset reduction in a TDOA location system |
CN104270814B (zh) * | 2014-09-30 | 2017-12-12 | 南京沃旭通讯科技有限公司 | 一种基于TDOA和ToF混合的定位方法及系统 |
CN107205268A (zh) * | 2017-04-24 | 2017-09-26 | 广西大学 | 一种基于无线通信基站的三维定位方法 |
CN109709513A (zh) * | 2019-01-25 | 2019-05-03 | 中广核研究院有限公司 | 一种室内应用于核电站定位方法及系统 |
-
2019
- 2019-11-04 CN CN201911067212.0A patent/CN110798886B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106054227A (zh) * | 2016-07-04 | 2016-10-26 | 西北工业大学 | 惯导辅助下的伪距差值单星高动态定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110798886A (zh) | 2020-02-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110798886B (zh) | 一种定位方法及装置 | |
CN107659893B (zh) | 一种误差补偿方法、装置、电子设备及可读存储介质 | |
CN111294731B (zh) | Uwb室内定位方法、装置、电子设备及存储介质 | |
CN1965247B (zh) | 用于确定位置数据的方法 | |
JP4934441B2 (ja) | 無線ノード位置推定方法、システム、及びその処理装置 | |
US9660740B2 (en) | Signal strength distribution establishing method and wireless positioning system | |
CN104396321A (zh) | 终端定位方法及定位装置 | |
CN108242962B (zh) | 一种基于测量报告的室内信号传播损耗计算方法及装置 | |
CN111505570A (zh) | 基于线性搜索的超宽带二维定位方法 | |
CN108549049B (zh) | 一种射线追踪辅助的贝叶斯指纹定位方法及装置 | |
CN112469066A (zh) | 5g网络覆盖评估方法及装置 | |
CN108495265B (zh) | 一种室内定位方法、装置及计算设备 | |
CN113935402B (zh) | 时差定位模型的训练方法、装置及电子设备 | |
CN113189541B (zh) | 一种定位方法、装置及设备 | |
CN113923772A (zh) | 基站标定方法和装置、计算机设备以及存储介质 | |
CN111263295B (zh) | 一种wlan室内定位方法和装置 | |
CN110996248B (zh) | 一种基于rss的凸优化无线传感器网络定位方法 | |
KR102118981B1 (ko) | 비콘 신호와 핑거프린트 맵 기반의 실내 측위 방법 및 시스템 | |
KR20140119333A (ko) | 위치 정확도 향상을 위한 위치 측위 방법 및 장치 | |
CN111343573B (zh) | 根据环境差异标校在线rssi值的指纹定位方法及装置 | |
CN100385993C (zh) | 无线通信系统中利用数字地图信息实现终端定位的方法 | |
CN108981713B (zh) | 一种混合无线自适应导航方法及装置 | |
CN109121080B (zh) | 一种室内定位方法、装置、移动终端及存储介质 | |
CN113203424A (zh) | 多传感器的数据融合方法、装置及相关设备 | |
CN112584489A (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 |