CN110231638B - 一种无线网络下的载波相位定位方法及装置 - Google Patents
一种无线网络下的载波相位定位方法及装置 Download PDFInfo
- Publication number
- CN110231638B CN110231638B CN201910580131.4A CN201910580131A CN110231638B CN 110231638 B CN110231638 B CN 110231638B CN 201910580131 A CN201910580131 A CN 201910580131A CN 110231638 B CN110231638 B CN 110231638B
- Authority
- CN
- China
- Prior art keywords
- fixed point
- mobile terminal
- carrier phase
- position information
- estimated position
- 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
-
- 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
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/43—Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
- G01S19/44—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
-
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Signal Processing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明实施例提供了一种无线网络下的载波相位定位方法及装置,根据移动终端在各时刻的第一估计位置信息和第二估计位置信息,计算移动终端在各时刻的联合估计位置信息;基于各固定点相对于参考固定点的差分载波相位测量值,计算各固定点相对于移动终端的整数模糊度的浮动解及浮动解的协方差矩阵,并根据浮动解及协方差矩阵,计算各固定点相对于移动终端的整数模糊度的固定解;利用整数模糊度的固定解,修正各固定点相对于参考固定点的差分载波相位测量值,并根据修正后的各固定点相对于参考固定点的差分载波相位测量值,确定移动终端的实际位置信息,可以加快求解整数模糊度的速度和提高整数模糊度的精确性,从而提高无线网络定位的精度。
Description
技术领域
本发明涉及卫星定位技术领域,特别是涉及一种无线网络下的载波相位定位方法及装置。
背景技术
随着科学技术的发展,卫星定位的应用也越来越广泛,例如,卫星定位可以应用于勘测、绘图、航空等方面。并且,在不同的卫星定位方法中可能会出现多种定位误差,因此,提高定位的精度就显得尤为重要。
相关技术中,可以通过测量TDOA(Time Difference of Arrival,到达时间差)的定位方法进行位置定位。但是,若存在其它信号干扰等情况,实际的TDOA测量会有较大的波动,会使得位置定位的结果也具有较大波动,从而降低了无线网络定位的精度。
发明内容
本发明实施例的目的在于提供一种无线网络下的载波相位定位方法及装置,以实现提高无线网络定位的精度。具体技术方案如下:
第一方面,本发明实施例提供了一种无线网络下的载波相位定位方法,所述方法包括:
获取待定位区域中多个固定点的位置信息、移动终端在初始时刻的初始估计位置信息、所述移动终端在各时刻测量到的所述各固定点发送信号的载波相位值以及所述各固定点的预设载波相位测量噪声;
根据所述各固定点的位置信息、所述初始估计位置信息以及在所述各时刻所述各固定点发送信号的载波相位值,计算所述移动终端在所述各时刻的第一估计位置信息,其中,在所述初始时刻,所述第一估计位置信息为所述初始估计位置信息;
利用预设的时间差定位算法,计算所述移动终端在所述各时刻的第二估计位置信息,并根据所述移动终端在所述各时刻的第一估计位置信息和第二估计位置信息,计算所述移动终端在所述各时刻的联合估计位置信息,其中,在所述初始时刻,所述联合估计位置信息为所述初始估计位置信息;
根据所述移动终端在所述各时刻的联合估计位置信息、所述各固定点的位置信息、所述各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,所述参考固定点为所述多个固定点中的任一固定点;
基于所述各固定点相对于所述参考固定点的差分载波相位测量值,计算所述各固定点相对于所述移动终端的整数模糊度的浮动解及所述浮动解的协方差矩阵,并根据所述浮动解及所述协方差矩阵,利用最小二乘模糊度去相关算法,计算所述各固定点相对于所述移动终端的整数模糊度的固定解;
利用所述各固定点相对于所述移动终端的整数模糊度的固定解,修正所述各固定点相对于所述参考固定点的差分载波相位测量值,并根据修正后的所述各固定点相对于所述参考固定点的差分载波相位测量值,利用预设定位算法,确定所述移动终端的实际位置信息。
可选的,所述初始估计位置信息为在所述初始时刻由预设的时间差定位算法测量得到的;
所述根据所述各固定点的位置信息、所述初始估计位置信息以及在所述各时刻所述各固定点发送信号的载波相位值,计算所述移动终端在所述各时刻的第一估计位置信息,包括:
确定所述移动终端在相邻两个时刻测量到的所述各固定点发送信号的载波相位值的差值表达式,所述差值表达式为:
其中,φj(t)为在所述时刻t固定点j发送信号的载波相位值,φj(t-1)为在所述时刻(t-1)固定点j发送信号的载波相位值,(aj,bj)为固定点j的位置信息,(x(t),y(t))为所述移动终端在所述时刻t的实际位置信息,为所述移动终端在所述时刻(t-1)的第一估计位置信息;
对所述各固定点对应的差值表达式进行变换,得到所述各固定点对应的变换表达式,所述变换表达式为:
Rj(t)=(aj-x(t))2+(bj-y(t))2
将所述各固定点对应的变化表达式与参考固定点的变化表达式作差,得到线性方程组,所述线性方程组为:
Cx=b
其中,aij为ai与aj的差值、bij为bi与bj的差值,Kj=aj 2+bj 2,M为所述固定点的数量,
利用最小二乘法得到所述线性方程组的解,作为所述移动终端在所述各时刻的第一估计位置信息。
可选的,所述根据所述移动终端在所述各时刻的第一估计位置信息和第二估计位置信息,计算所述移动终端在所述各时刻的联合估计位置信息,包括:
根据所述移动终端在所述各时刻的第一估计位置信息,计算所述移动终端在相邻两个时刻的估计位置变化量,所述估计位置变化量为:
根据所述移动终端在所述各时刻的第二估计位置信息及所述估计位置变化量,通过联合迭代公式进行迭代,得到所述移动终端在所述各时刻的联合估计位置信息,所述联合迭代公式为:
PCP(t+1)=PFUSION(t)+ΔPCP(t+1)
PFUSION(t+1)=wTDOAPT(t+1)+wcpPCP(t+1)
其中,PFUSION(t)为所述移动终端在所述时刻t的联合估计位置信息,PFUSION(t+1)为所述移动终端在所述时刻(t+1)的联合估计位置信息,PT(t+1)为所述移动终端在所述时刻(t+1)的第二估计位置信息,并且,wTDOA+wcp=1,wTDOA为所述移动终端的第二估计位置信息的权重系数,wcp为所述移动终端的第一估计位置信息的权重系数。
可选的,根据所述移动终端在所述各时刻的联合估计位置信息、所述各固定点的位置信息、所述各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,包括:
获取预设载波相位表达式,所述预设载波相位表达式为:
其中,(xF (t),yF (t))为所述移动终端在所述时刻t的联合估计位置信息,Nj为所述固定点j相对于所述移动终端的初始整数模糊度、nj为所述固定点j的预设载波相位测量噪声,λ为载波波长;
将所述预设载波相位表达式中的非线性部分进行泰勒展开,得到展开后的所述各固定点相对于参考固定点的差分载波相位测量值表达式,并基于所述差分载波相位测量值表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,所述差分载波相位测量值表达式为:
其中,为所述差分载波相位测量值, 为所述预设载波相位表达式与常量的差值,ξ=(ζ(1) ζ(2) ... ζ(Z)N)T,ζ(t)=(xF (t),yF (t))T,n=(n(1) n(2)... n(Z))T,Z为周期数,H为常量矩阵,
可选的,所述基于所述各固定点相对于所述参考固定点的差分载波相位测量值,计算所述各固定点相对于所述移动终端的整数模糊度的浮动解及所述浮动解的协方差矩阵,包括:
利用最小二乘法求解所述差分载波相位测量值,得到所述未知数的浮动解及协方差矩阵;
提取所述未知数的浮动解的后(M-1)位,作为所述各固定点相对于所述移动终端的整数模糊度的浮动解;
将所述协方差矩阵进行分块处理,得到分块矩阵,所述分块矩阵为:
其中,Qζζ为2K×2K矩阵,QNN为(m-1)×(m-1)矩阵;
确定所述分块矩阵中的QNN为所述各固定点相对于所述移动终端的整数模糊度的浮动解的协方差矩阵。
可选的,所述利用所述各固定点相对于所述移动终端的整数模糊度的固定解,修正所述各固定点相对于所述参考固定点的差分载波相位测量值,包括:
利用所述各固定点相对于所述移动终端的整数模糊度的固定解,将所述各固定点相对于所述参考固定点的差分载波相位测量值修正为:
第二方面,本发明实施例提供了一种无线网络下的载波相位定位装置,所述装置包括:
获取模块,用于获取待定位区域中多个固定点的位置信息、移动终端在初始时刻的初始估计位置信息、所述移动终端在各时刻测量到的所述各固定点发送信号的载波相位值以及所述各固定点的预设载波相位测量噪声;
第一估计位置信息计算模块,用于根据所述各固定点的位置信息、所述初始估计位置信息以及在所述各时刻所述各固定点发送信号的载波相位值,计算所述移动终端在所述各时刻的第一估计位置信息,其中,在所述初始时刻,所述第一估计位置信息为所述初始估计位置信息;
联合估计位置信息计算模块,用于利用预设的时间差定位算法,计算所述移动终端在所述各时刻的第二估计位置信息,并根据所述移动终端在所述各时刻的第一估计位置信息和第二估计位置信息,计算所述移动终端在所述各时刻的联合估计位置信息,其中,在所述初始时刻,所述联合估计位置信息为所述初始估计位置信息;
差分载波相位测量值确定模块,用于根据所述移动终端在所述各时刻的联合估计位置信息、所述各固定点的位置信息、所述各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,所述参考固定点为所述多个固定点中的任一固定点;
固定解计算模块,用于基于所述各固定点相对于所述参考固定点的差分载波相位测量值,计算所述各固定点相对于所述移动终端的整数模糊度的浮动解及所述浮动解的协方差矩阵,并根据所述浮动解及所述协方差矩阵,利用最小二乘模糊度去相关算法,计算所述各固定点相对于所述移动终端的整数模糊度的固定解;
实际位置信息确定模块,用于利用所述各固定点相对于所述移动终端的整数模糊度的固定解,修正所述各固定点相对于所述参考固定点的差分载波相位测量值,并根据修正后的所述各固定点相对于所述参考固定点的差分载波相位测量值,利用预设定位算法,确定所述移动终端的实际位置信息。
可选的,所述初始估计位置信息为在所述初始时刻由预设的时间差定位算法测量得到的;
所述第一估计位置信息计算模块,包括:
差值表达式确定子模块,用于确定所述移动终端在相邻两个时刻测量到的所述各固定点发送信号的载波相位值的差值表达式,所述差值表达式为:
其中,φj(t)为在所述时刻t固定点j发送信号的载波相位值,φj(t-1)为在所述时刻(t-1)固定点j发送信号的载波相位值,(aj,bj)为固定点j的位置信息,(x(t),y(t))为所述移动终端在所述时刻t的实际位置信息,为所述移动终端在所述时刻(t-1)的第一估计位置信息;
变换表达式获取子模块,用于对所述各固定点对应的差值表达式进行变换,得到所述各固定点对应的变换表达式,所述变换表达式为:
Rj(t)=(aj-x(t))2+(bj-y(t))2
线性方程组获取子模块,用于将所述各固定点对应的变化表达式与参考固定点的变化表达式作差,得到线性方程组,所述线性方程组为:
Cx=b
其中,aij为ai与aj的差值、bij为bi与bj的差值,M为所述固定点的数量,
求解子模块,用于利用最小二乘法得到所述线性方程组的解,作为所述移动终端在所述各时刻的第一估计位置信息。
可选的,所述联合估计位置信息计算模块,包括:
估计位置变化量计算子模块,用于根据所述移动终端在所述各时刻的第一估计位置信息,计算所述移动终端在相邻两个时刻的估计位置变化量,所述估计位置变化量为:
联合估计位置信息获取子模块,根据所述移动终端在所述各时刻的第二估计位置信息及所述估计位置变化量,通过联合迭代公式进行迭代,得到所述移动终端在所述各时刻的联合估计位置信息,所述联合迭代公式为:
PCP(t+1)=PFUSION(t)+ΔPCP(t+1)
PFUSION(t+1)=wTDOAPT(t+1)+wcpPCP(t+1)
其中,PFUSION(t)为所述移动终端在所述时刻t的联合估计位置信息,PFUSION(t+1)为所述移动终端在所述时刻(t+1)的联合估计位置信息,PT(t+1)为所述移动终端在所述时刻(t+1)的第二估计位置信息,并且,wTDOA+wcp=1,wTDOA为所述移动终端的第二估计位置信息的权重系数,wcp为所述移动终端的第一估计位置信息的权重系数。
可选的,所述差分载波相位测量值确定模块,包括:
预设载波相位表达式子模块,用于获取预设载波相位表达式,所述预设载波相位表达式为:
其中,(xF (t),yF (t))为所述移动终端在所述时刻t的联合估计位置信息,Nj为所述固定点j相对于所述移动终端的初始整数模糊度、nj为所述固定点j的预设载波相位测量噪声,λ为载波波长;
差分载波相位测量值表达式确定子模块,用于将所述预设载波相位表达式中的非线性部分进行泰勒展开,得到展开后的所述各固定点相对于参考固定点的差分载波相位测量值表达式,并基于所述差分载波相位测量值表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,所述差分载波相位测量值表达式为:
其中,为所述差分载波相位测量值, 为所述预设载波相位表达式与常量的差值,ξ=(ζ(1) ζ(2) ... ζ(Z)N)T,ζ(t)=(xF (t),yF (t))T,n=(n(1) n(2)... n(Z))T,Z为周期数,H为常量矩阵,
可选的,所述固定解计算模块,包括:
未知数的浮动解及协方差矩阵获取子模块,用于利用最小二乘法求解所述差分载波相位测量值,得到所述未知数的浮动解及协方差矩阵;
整数模糊度的浮动解获取子模块,用于提取所述未知数的浮动解的后(M-1)位,作为所述各固定点相对于所述移动终端的整数模糊度的浮动解;
矩阵分块子模块,用于将所述协方差矩阵进行分块处理,得到分块矩阵,所述分块矩阵为:
其中,Qζζ为2K×2K矩阵,QNN为(m-1)×(m-1)矩阵;
整数模糊度的浮动解的协方差矩阵确定子模块,用于确定所述分块矩阵中的QNN为所述各固定点相对于所述移动终端的整数模糊度的浮动解的协方差矩阵。
可选的,所述实际位置信息确定模块,包括:
差分载波相位测量值修正子模块,用于利用所述各固定点相对于所述移动终端的整数模糊度的固定解,将所述各固定点相对于所述参考固定点的差分载波相位测量值修正为:
第三方面,本发明实施例提供了一种电子设备,包括处理器、通信接口、存储器和通信总线,其中,所述处理器、所述通信接口、所述存储器通过所述通信总线完成相互间的通信;
存储器,用于存放计算机程序;
处理器,用于执行存储器上所存放的所述计算机程序时,实现上述第一方面任一所述的无线网络下的载波相位定位方法。
第四方面,本发明实施例提供了一种计算机可读存储介质,所述计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现上述第一方面任一所述的无线网络下的载波相位定位方法。
本发明实施例提供的无线网络下的载波相位定位方法方法及装置,根据移动终端在各时刻的第一估计位置信息和第二估计位置信息,计算移动终端在各时刻的联合估计位置信息;基于各固定点相对于参考固定点的差分载波相位测量值,计算各固定点相对于移动终端的整数模糊度的浮动解及浮动解的协方差矩阵,并根据浮动解及协方差矩阵,计算各固定点相对于移动终端的整数模糊度的固定解;利用整数模糊度的固定解,修正各固定点相对于参考固定点的差分载波相位测量值,并根据修正后的各固定点相对于参考固定点的差分载波相位测量值,确定移动终端的实际位置信息。由于载波相位测量值中的整数模糊度的取值会影响定位的精度,在上述方法中,加快了求解整数模糊度的速度和提高了整数模糊度的精确性,从而进一步提高了无线网络定位的精度。
当然,实施本发明的任一产品或方法必不一定需要同时达到以上所述的所有优点。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种无线网络下的载波相位定位方法的实施例一的流程示意图;
图2为本发明实施例提供的一种无线网络下的载波相位定位方法的实施例二的流程示意图;
图3为本发明实施例提供的一种无线网络下的载波相位定位方法的仿真场景的示意图;
图4为本发明实施例提供的一种在到达时间差测量方差下的仿真结果的示意图;
图5为本发明实施例提供的一种在载波相位测量方差下的仿真结果的示意图;
图6为本发明实施例提供的一种载波相位的定位误差对应CDF的示意图;
图7为本发明实施例提供的一种无线网络下的载波相位定位装置的结构示意图;
图8为本发明实施例的电子设备的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为了提高无线网络定位的精度,本发明实施例提供了一种无线网络下的载波相位定位方法及装置,以下分别进行详细说明。
本发明实施例提供的无线网络下的载波相位定位方法可以由处于无线网络下的移动终端执行。
图1为本发明实施例提供的一种无线网络下的载波相位定位方法的实施例一的流程示意图,如图1所示,本发明实施例的方法可以包括:
S101,获取待定位区域中多个固定点的位置信息、移动终端在初始时刻的初始估计位置信息、移动终端在各时刻测量到的各固定点发送信号的载波相位值以及各固定点的预设载波相位测量噪声。
其中,移动终端在初始时刻的初始估计位置信息可以由TDOA方法测量得到,在此不对TDOA这种测量方法进行详细的说明。各固定点的预设载波相位测量噪声服从均值为0的高斯分布。
S102,根据各固定点的位置信息、初始估计位置信息以及在各时刻各固定点发送信号的载波相位值,计算移动终端在各时刻的第一估计位置信息。
其中,在初始时刻,第一估计位置信息为初始估计位置信息。
可选的,对相邻两个时刻测量到的各固定点发送信号的载波相位值的差值表达式进行变换后,可以得到各固定点对应的变换表达式,然后,将各固定点对应的变换表达式与参考固定点的变化表达式作差,可以得到关于移动终端在各时刻的第一估计位置信息的线性方程组,通过求解该线性方程组,就可以得到移动终端在各时刻的第一估计位置信息。其中,参考固定点为多个固定点中的任一固定点。
S103,利用预设的时间差定位算法,计算移动终端在各时刻的第二估计位置信息,并根据移动终端在各时刻的第一估计位置信息和第二估计位置信息,计算移动终端在各时刻的联合估计位置信息。
其中,在初始时刻,联合估计位置信息为初始估计位置信息,也就是利用预设的时间差定位算法,在初始时刻得到的移动终端在各时刻的第二估计位置信息。
S104,根据移动终端在各时刻的联合估计位置信息、各固定点的位置信息、各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定各固定点相对于参考固定点的差分载波相位测量值。
其中,参考固定点为多个固定点中的任一固定点。
具体实现时,利用移动终端在各时刻的联合估计位置信息、各固定点的位置信息、各固定点的预设载波相位测量噪声,对预设载波相位进行化解与约束,从而确定各固定点相对于参考固定点的差分载波相位测量值。
S105,基于各固定点相对于参考固定点的差分载波相位测量值,计算各固定点相对于移动终端的整数模糊度的浮动解及浮动解的协方差矩阵,并根据浮动解及协方差矩阵,利用最小二乘模糊度去相关算法,计算各固定点相对于移动终端的整数模糊度的固定解。
可选的,根据噪声向量的协方差矩阵,可以对各固定点相对于参考固定点的差分载波相位测量值对应的方程进行求解,从而得到各固定点相对于移动终端的整数模糊度的浮动解及浮动解的协方差矩阵,进一步求解各固定点相对于移动终端的整数模糊度的固定解。
S106,利用各固定点相对于移动终端的整数模糊度的固定解,修正各固定点相对于参考固定点的差分载波相位测量值,并根据修正后的各固定点相对于参考固定点的差分载波相位测量值,利用预设定位算法,确定移动终端的实际位置信息。
利用各固定点相对于移动终端的整数模糊度的固定解,修正后的各固定点相对于参考固定点的差分载波相位测量值的精度得到提升。根据精度得到提升后的各固定点相对于参考固定点的差分载波相位测量值,利用预设定位算法,从而确定移动终端的实际位置信息。
由于载波相位测量值中的整数模糊度的取值会影响定位的精度,通过应用本发明实施例提供的无线网络下的载波相位定位方法,加快了求解整数模糊度的速度和提高了整数模糊度的精确性,从而进一步提高了无线网络定位的精度。
下面以一个具体的实现方式为例对本发明实施例的无线网络下的载波相位定位方法进行说明,图2为本发明实施例提供的一种无线网络下的载波相位定位方法的实施例二的流程示意图,如图2所示,本实施例的方法可以包括:
S201,获取待定位区域中多个固定点的位置信息、移动终端在初始时刻的初始估计位置信息、移动终端在各时刻测量到的各固定点发送信号的载波相位值以及各固定点的预设载波相位测量噪声。
上述步骤S201与图1所示实施例一中的步骤S101类似,在此不再赘述。
S202,利用纯载波相位测量估计相对位置。
上述步骤S202就是图1所示的本发明实施例一中的步骤S102:根据各固定点的位置信息、初始估计位置信息以及在各时刻各固定点发送信号的载波相位值,计算移动终端在各时刻的第一估计位置信息。这里的,上述步骤S202中的相对位置就是上述步骤S102中的移动终端在各时刻的第一估计位置信息。
具体实现时,可以采用以下步骤a1-a4计算移动终端在各时刻的第一估计位置信息:
步骤a1,确定移动终端在相邻两个时刻测量到的各固定点发送信号的载波相位值的差值表达式,该差值表达式为下面的公式(1),公式(1)具体如下:
其中,φj(t)为在时刻t固定点j发送信号的载波相位值,φj(t-1)为在时刻(t-1)固定点j发送信号的载波相位值,(aj,bj)为固定点j的位置信息,(x(t),y(t))为移动终端在时刻t的实际位置信息,为移动终端在时刻(t-1)的第一估计位置信息。
步骤a2,对各固定点对应的差值表达式进行变换,得到各固定点对应的变换表达式。
此时,上述公式(2)中等号的左边均为已知项,将上述公式(2)中等号的左边记为Rj(t),从而得到各固定点对应的变换表达式,该变换表达式为下面的公式(3),公式(3)具体如下:
Rj(t)=(aj-x(t))2+(bj-y(t))2 (3)
步骤a3,将各固定点对应的变化表达式与参考固定点的变化表达式作差,得到线性方程组。
假设参考固定点为固定点1,那么将各固定点对应的变化表达式与参考固定点的变化表达式作差,得到下面的公式(4),公式(4)具体如下:
-2aj1x(t)-2bj1y(t)=(Rj(t)-R1(t))-(Kj-K1) (4)
将上述线性方程组表示为向量形式,得到下面的公式(5),公式(5)具体如下:
Cx=b (5)
其中,aij为ai与aj的差值、bij为bi与bj的差值,M为固定点的数量,
步骤a4,利用最小二乘法得到上述线性方程组的解,作为移动终端在各时刻的第一估计位置信息。
上述线性方程组的解如下述表达式(6)所示,表达式(6)具体如下:
S203,利用到达时间差定位算法与载波相位测量联合估计绝对位置。
上述步骤S203就是图1所示的本发明实施例一中的步骤S103:利用预设的时间差定位算法,计算移动终端在各时刻的第二估计位置信息,并根据移动终端在各时刻的第一估计位置信息和第二估计位置信息,计算移动终端在各时刻的联合估计位置信息。这里的,上述步骤S203中的联合估计绝对位置就是上述步骤S103中的移动终端在各时刻的联合估计位置信息。
上述到达时间差定位算法也就是TDOA定位方法。
具体实现时,可以采用以下步骤b1和步骤b2计算移动终端在各时刻的联合估计位置信息:
步骤b1,根据移动终端在各时刻的第一估计位置信息,计算移动终端在相邻两个时刻的估计位置变化量,该估计位置变化量如下述表达式(7)所示,表达式(7)具体如下:
步骤b2,根据移动终端在各时刻的第二估计位置信息及估计位置变化量,通过联合迭代公式进行迭代,得到移动终端在各时刻的联合估计位置信息,该联合迭代公式如下述公式(8)所示,公式(8)具体如下:
其中,PFUSION(t)为移动终端在时刻t的联合估计位置信息,PFUSION(t)=(xF(t),yF(t)),PFUSION(t+1)为移动终端在时刻(t+1)的联合估计位置信息,PTDOA(t+1)为移动终端在时刻(t+1)的第二估计位置信息,并且,wTDOA+wcp=1,wTDOA为移动终端的第二估计位置信息的权重系数,wcp为移动终端的第一估计位置信息的权重系数。并且,当t=0时,PFUSION(0)=PTDOA(0)。
S204,将载波相位测量方程线性化并求整数模糊度的浮动解。
上述步骤S204中的“将载波相位测量方程线性化”就是图1所示的本发明实施例一中的步骤S104中的“根据移动终端在各时刻的联合估计位置信息、各固定点的位置信息、各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定各固定点相对于参考固定点的差分载波相位测量值”,并且,上述步骤S204中的“求整数模糊度的浮动解”就是图1所示的本发明实施例一中的步骤S105中的“基于各固定点相对于参考固定点的差分载波相位测量值,计算各固定点相对于移动终端的整数模糊度的浮动解”。
具体实现时,首先,可以采用以下步骤c1-c3确定各固定点相对于参考固定点的差分载波相位测量值:
步骤c1,获取预设载波相位表达式,预设载波相位表达式为表达式(9),表达式(9)具体如下:
其中,(xF(t),yF(t))为移动终端在时刻t的联合估计位置信息,Ni为固定点i相对于移动终端的初始整数模糊度、ni为固定点i的预设载波相位测量噪声,λ为载波波长;
步骤c2,将预设载波相位表达式中的非线性部分进行泰勒展开,得到展开后的各固定点相对于参考固定点的差分载波相位测量值表达式。
其中,
步骤c3,基于差分载波相位测量值表达式,确定各固定点相对于参考固定点的差分载波相位测量值。
当参考固定点为固定点1时,各固定点相对于参考固定点的差分载波相位测量值为下述表达式(12),表达式(12)具体如下:
其中,(·)i1=(·)i-(·)1,将上述表达式(12)写成向量的形式,得到表达式(13),表达式(13)具体如下:
可选的,假设从t=1时刻开始,锁相环将载波相位锁定,并在接下来连续的Z个周期内保持不失锁,由在这Z个周期内的测量值可进一步得到差分载波相位测量值表达式为表达式(14),表达式(14)具体如下:
其次,可以采用以下步骤c4-c7计算各固定点相对于移动终端的整数模糊度的浮动解:
步骤c4,利用最小二乘法求解差分载波相位测量值,得到未知数的浮动解及协方差矩阵。
具体的,利用最小二乘法求解上述差分载波相位测量值,得到未知数ξ的浮动解为表达式(15),表达式(15)具体如下:
步骤c5,提取未知数的浮动解的后(M-1)位,作为各固定点相对于移动终端的整数模糊度的浮动解。
具体的,各固定点相对于移动终端的整数模糊度的浮动解为未知数的浮动解的后(M-1)位,那么,各固定点相对于移动终端的整数模糊度的浮动解为下述表达式(16),表达式(16)具体如下:
Nfloat=[ξfloat](2K+1):(2K+M-1) (16)
步骤c6,将上述未知数ξ的协方差矩阵进行分块处理,得到分块矩阵为表达式(17),表达式(17)具体如下:
其中,Qζζ为2K×2K矩阵,QNN为(m-1)×(m-1)矩阵。
步骤c7,确定分块矩阵中的QNN为各固定点相对于移动终端的整数模糊度的浮动解的协方差矩阵。
S205,利用最小二乘模糊度去相关算法求解整数模糊度的固定解。
上述步骤S205就是图1所示的本发明实施例一中的步骤S 105中的“根据浮动解及协方差矩阵,利用最小二乘模糊度去相关算法(LAMBDA算法),计算各固定点相对于移动终端的整数模糊度的固定解”。
具体实现时,将解算出的浮动解Nfloat及其协方差矩阵QN作为参数输入LAMBDA算法中,求得整数模糊度的固定解。
S206,利用整数模糊度的固定解修正载波相位测量值并定位。
上述步骤S206就是图1所示的本发明实施例一中的步骤S106:利用各固定点相对于移动终端的整数模糊度的固定解,修正各固定点相对于参考固定点的差分载波相位测量值,并根据修正后的各固定点相对于参考固定点的差分载波相位测量值,利用预设定位算法,确定移动终端的实际位置信息。
具体实现时,利用各固定点相对于移动终端的整数模糊度的固定解,将各固定点相对于参考固定点的差分载波相位测量值修正为下述表达式(18),表达式(18)具体如下:
本发明实施例提供的无线网络下的载波相位定位方法,根据移动终端在各时刻的第一估计位置信息和第二估计位置信息,计算移动终端在各时刻的联合估计位置信息;基于各固定点相对于参考固定点的差分载波相位测量值,计算各固定点相对于移动终端的整数模糊度的浮动解及浮动解的协方差矩阵,并根据浮动解及协方差矩阵,计算各固定点相对于移动终端的整数模糊度的固定解;利用整数模糊度的固定解,修正各固定点相对于参考固定点的差分载波相位测量值,并根据修正后的各固定点相对于参考固定点的差分载波相位测量值,确定移动终端的实际位置信息。由于载波相位测量值中的整数模糊度的取值会影响定位的精度,在上述方法中,加快了求解整数模糊度的速度和提高了整数模糊度的精确性,从而进一步提高了无线网络定位的精度。
对于上述实施例提供的无线网络下的载波相位定位方法,可以采用以下的仿真方式进行验证。下面由三个部分对这种仿真方式进行说明:
第一部分,仿真场景及参数设置:
图3为本发明实施例提供的一种无线网络下的载波相位定位方法的仿真场景的示意图,如图3所示,其中编号为1、3、6、7和12的基站被选为参与定位的基站,3号基站被选为参考基站。
在上述无线网络下的载波相位定位方法的仿真场景下,参数设置如下述表1所示:
表1
参数符号 | 参数名称 | 参数值 |
f<sub>c</sub> | 载波中心频率 | 2GHz |
λ | 载波波长 | 0.15m |
M | 参与定位的固定锚节点个数 | 5 |
σ<sub>TOA</sub> | TOA测量噪声的标准差 | 10λ |
σ<sub>CARR</sub> | 载波相位测量噪声的标准差 | 0.05λ |
K | 整数模糊度解算时长 | 10s |
v | 物体运动速度 | 3km/h |
Sim_time | 仿真次数 | 1000 |
第二部分,仿真结果:
在本仿真方式中,对于整数模糊度解算的性能可以用整数模糊度向量中平均每个元素的EPE(Error per Element,误差)来衡量,计算EPE的方法为下述表达式(19),表达式(19)具体如下:
其中,Nreal表示真实的整数模糊度。
图4为本发明实施例提供的一种在到达时间差测量方差下的仿真结果的示意图,如图4所示。图5为本发明实施例提供的一种在载波相位测量方差下的仿真结果的示意图,如图5所示。图4、图5中的横坐标表示EPE的取值范围,纵坐标表示次数。图4表示在不同的TDOA测量方差下的EPE统计结果,图4中包括3个TDOA测量方差:0.1m、0.15m和0.2m。图5表示在不同的载波相位测量方差下的EPE统计结果,图5中包括3个载波相位测量方差0.3mm、1mm和2mm。
可以看出在不同的测量方差下,本方案的EPE大多集中在0-1范围内,结果较为准确。整周模糊度解算的性能对载波相位的测量方差较为敏感。
将去除整数模糊度之后(即,修正后的整数模糊度)的差分载波相位测量值运用于定位中,具体的定位算法与TDOA定位算法相同。图6为本发明实施例提供的一种载波相位的定位误差对应CDF(Cumulative Distribution Function,累积分布函数)的示意图。如图6所示,在不同的EPE下,载波相位的定位误差对应不同的CDF,图6中横坐标表示定位精度,单位为米,纵坐标表示CDF的取值。根据图6可以发现,在EPE≤2的情况下,载波相位的定位精度能够达到毫米级。
第三部分,仿真结论:
由表1和图4、图5可以看出,本发明实施例提供的解算整数模糊度的方法能够在10s的时间内完成载波相位整数模糊度解算,并且在载波相位测量方差为0.3mm时,整数模糊度固定解向量中平均每个元素的误差在95%左右的概率下均在1以内。根据上述仿真结果,不难发现,本发明实施例提供的无线网络下的载波相位定位方法对于解决无线网络中的载波相位整数模糊度问题具有较快的速度和较好的精确度。
在图6中,在EPE≤2的情况下,本发明实施例提供的无线网络下的载波相位定位方法90%的概率下误差在0.04m以内。根据上述仿真结果,不难发现,本发明实施例提供的无线网络下的载波相位定位方法能够达到厘米级的精度。
相应于上述方法实施例,图7为本发明实施例提供的一种无线网络下的载波相位定位装置的结构示意图,如图7所示,该无线网络下的载波相位定位装置可以包括:
获取模块710,获取待定位区域中多个固定点的位置信息、移动终端在初始时刻的初始估计位置信息、移动终端在各时刻测量到的各固定点发送信号的载波相位值以及各固定点的预设载波相位测量噪声;
第一估计位置信息计算模块720,根据各固定点的位置信息、初始估计位置信息以及在各时刻各固定点发送信号的载波相位值,计算移动终端在各时刻的第一估计位置信息;
联合估计位置信息计算模块730,利用预设的时间差定位算法,计算移动终端在各时刻的第二估计位置信息,并根据移动终端在各时刻的第一估计位置信息和第二估计位置信息,计算移动终端在各时刻的联合估计位置信息;
差分载波相位测量值确定模块740,根据移动终端在各时刻的联合估计位置信息、各固定点的位置信息、各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定各固定点相对于参考固定点的差分载波相位测量值;
固定解计算模块750,基于各固定点相对于参考固定点的差分载波相位测量值,计算各固定点相对于移动终端的整数模糊度的浮动解及浮动解的协方差矩阵,并根据浮动解及协方差矩阵,利用最小二乘模糊度去相关算法,计算各固定点相对于移动终端的整数模糊度的固定解;
实际位置信息确定模块760,利用各固定点相对于移动终端的整数模糊度的固定解,修正各固定点相对于参考固定点的差分载波相位测量值,并根据修正后的各固定点相对于参考固定点的差分载波相位测量值,利用预设定位算法,确定移动终端的实际位置信息。
可选的,上述第一估计位置信息计算模块720,可以包括:
差值表达式确定子模块,用于确定移动终端在相邻两个时刻测量到的各固定点发送信号的载波相位值的差值表达式,差值表达式为:
其中,φj(t)为在时刻t固定点j发送信号的载波相位值,φj(t-1)为在时刻(t-1)固定点j发送信号的载波相位值,(aj,bj)为固定点j的位置信息,(x(t),y(t))为移动终端在时刻t的实际位置信息,为移动终端在时刻(t-1)的第一估计位置信息。
变换表达式获取子模块,用于对各固定点对应的差值表达式进行变换,得到各固定点对应的变换表达式,变换表达式为:
Rj(t)=(aj-x(t))2+(bj-y(t))2
线性方程组获取子模块,用于将各固定点对应的变化表达式与参考固定点的变化表达式作差,得到线性方程组,线性方程组为:
Cx=b
其中,aij为ai与aj的差值、bij为bi与bj的差值,Kj=aj 2+bj 2,M为固定点的数量,
求解子模块,用于利用最小二乘法得到线性方程组的解,作为移动终端在各时刻的第一估计位置信息。
可选的,上述联合估计位置信息计算模块730,可以包括:
估计位置变化量计算子模块,用于根据移动终端在各时刻的第一估计位置信息,计算移动终端在相邻两个时刻的估计位置变化量,估计位置变化量为:
联合估计位置信息获取子模块,根据移动终端在各时刻的第二估计位置信息及估计位置变化量,通过联合迭代公式进行迭代,得到移动终端在各时刻的联合估计位置信息,联合迭代公式为:
PCP(t+1)=PFUSION(t)+ΔPCP(t+1)
PFUSION(t+1)=wTDOAPT(t+1)+wcpPCP(t+1)
其中,PFUSION(t)为移动终端在时刻t的联合估计位置信息,PFUSION(t+1)为移动终端在时刻(t+1)的联合估计位置信息,PT(t+1)为移动终端在时刻(t+1)的第二估计位置信息,并且,wTDOA+wcp=1,wTDOA为移动终端的第二估计位置信息的权重系数,wcp为移动终端的第一估计位置信息的权重系数。
可选的,上述差分载波相位测量值确定模块740,可以包括:
预设载波相位表达式子模块,用于获取预设载波相位表达式,预设载波相位表达式为:
其中,(xF (t),yF (t))为移动终端在时刻t的联合估计位置信息,Nj为固定点j相对于移动终端的初始整数模糊度、nj为固定点j的预设载波相位测量噪声,λ为载波波长;
差分载波相位测量值表达式确定子模块,用于将预设载波相位表达式中的非线性部分进行泰勒展开,得到展开后的各固定点相对于参考固定点的差分载波相位测量值表达式,并基于差分载波相位测量值表达式,确定各固定点相对于参考固定点的差分载波相位测量值,差分载波相位测量值表达式为:
其中,为差分载波相位测量值, 为预设载波相位表达式与常量的差值,ξ=(ζ(1) ζ(2) ... ζ(Z)N)T,ζ(t)=(x(t) y(t))T,n=(n(1) n(2) ...n(Z))T,Z为周期数,H为常量矩阵,
可选的,上述固定解计算模块750,可以包括:
未知数的浮动解及协方差矩阵获取子模块,用于利用最小二乘法求解差分载波相位测量值,得到未知数的浮动解及协方差矩阵;
整数模糊度的浮动解获取子模块,用于提取未知数的浮动解的后(M-1)位,作为各固定点相对于移动终端的整数模糊度的浮动解;
矩阵分块子模块,用于将协方差矩阵进行分块处理,得到分块矩阵,分块矩阵为:
其中,Qζζ为2K×2K矩阵,QNN为(m-1)×(m-1)矩阵;
整数模糊度的浮动解的协方差矩阵确定子模块,用于确定分块矩阵中的QNN为各固定点相对于移动终端的整数模糊度的浮动解的协方差矩阵。
可选的,上述实际位置信息确定模块760,可以包括:
差分载波相位测量值修正子模块,用于利用各固定点相对于移动终端的整数模糊度的固定解,将各固定点相对于参考固定点的差分载波相位测量值修正为:
应用本发明实施例,可以加快求解整数模糊度的速度和提高整数模糊度的精确性,从而进一步提高了无线网络定位的精度。
本发明实施例还提供了一种电子设备,如图8所示,包括处理器801、通信接口802、存储器803和通信总线804,其中,处理器801,通信接口802,存储器803通过通信总线804完成相互间的通信,
存储器803,用于存放计算机程序;
处理器801,用于执行存储器803上所存放的计算机程序时,实现如下步骤:
获取待定位区域中多个固定点的位置信息、移动终端在初始时刻的初始估计位置信息、移动终端在各时刻测量到的各固定点发送信号的载波相位值以及各固定点的预设载波相位测量噪声;
根据各固定点的位置信息、初始估计位置信息以及在各时刻各固定点发送信号的载波相位值,计算移动终端在各时刻的第一估计位置信息;
利用预设的时间差定位算法,计算移动终端在各时刻的第二估计位置信息,并根据移动终端在各时刻的第一估计位置信息和第二估计位置信息,计算移动终端在各时刻的联合估计位置信息;
根据移动终端在各时刻的联合估计位置信息、各固定点的位置信息、各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定各固定点相对于参考固定点的差分载波相位测量值;
基于各固定点相对于参考固定点的差分载波相位测量值,计算各固定点相对于移动终端的整数模糊度的浮动解及浮动解的协方差矩阵,并根据浮动解及协方差矩阵,利用最小二乘模糊度去相关算法,计算各固定点相对于移动终端的整数模糊度的固定解;
利用各固定点相对于移动终端的整数模糊度的固定解,修正各固定点相对于参考固定点的差分载波相位测量值,并根据修正后的各固定点相对于参考固定点的差分载波相位测量值,利用预设定位算法,确定移动终端的实际位置信息。
可选的,处理器801执行存储器803上所存放的计算机程序时,可以执行上述任一无线网络下的载波相位定位方法。
应用本发明实施例,可以加快求解整数模糊度的速度和提高整数模糊度的精确性,从而进一步提高了无线网络定位的精度。
上述电子设备提到的通信总线可以是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,现场可编程门阵列)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
另外,相应于上述实施例所提供的无线网络下的载波相位定位方法,本发明实施例提供了一种计算机可读存储介质,计算机可读存储介质内存储有计算机程序,计算机程序被处理器执行时实现本发明实施例的无线网络下的载波相位定位方法的所有步骤。
应用本发明实施例,可以加快求解整数模糊度的速度和提高整数模糊度的精确性,从而进一步提高了无线网络定位的精度。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个......”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于装置、电子设备以及计算机可读存储介质实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
以上所述仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本发明的保护范围内。
Claims (8)
1.一种无线网络下的载波相位定位方法,其特征在于,所述方法包括:
获取待定位区域中多个固定点的位置信息、移动终端在初始时刻的初始估计位置信息、所述移动终端在各时刻测量到的所述各固定点发送信号的载波相位值以及所述各固定点的预设载波相位测量噪声;
根据所述各固定点的位置信息、所述初始估计位置信息以及在所述各时刻所述各固定点发送信号的载波相位值,计算所述移动终端在所述各时刻的第一估计位置信息,其中,在所述初始时刻,所述第一估计位置信息为所述初始估计位置信息;
利用预设的时间差定位算法,计算所述移动终端在所述各时刻的第二估计位置信息,并根据所述移动终端在所述各时刻的第一估计位置信息和第二估计位置信息,计算所述移动终端在所述各时刻的联合估计位置信息,其中,在所述初始时刻,所述联合估计位置信息为所述初始估计位置信息;
根据所述移动终端在所述各时刻的联合估计位置信息、所述各固定点的位置信息、所述各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,所述参考固定点为所述多个固定点中的任一固定点;
基于所述各固定点相对于所述参考固定点的差分载波相位测量值,计算所述各固定点相对于所述移动终端的整数模糊度的浮动解及所述浮动解的协方差矩阵,并根据所述浮动解及所述协方差矩阵,利用最小二乘模糊度去相关算法,计算所述各固定点相对于所述移动终端的整数模糊度的固定解;
利用所述各固定点相对于所述移动终端的整数模糊度的固定解,修正所述各固定点相对于所述参考固定点的差分载波相位测量值,并根据修正后的所述各固定点相对于所述参考固定点的差分载波相位测量值,利用预设定位算法,确定所述移动终端的实际位置信息;
所述根据所述移动终端在所述各时刻的第一估计位置信息和第二估计位置信息,计算所述移动终端在所述各时刻的联合估计位置信息,包括:
根据所述移动终端在所述各时刻的第一估计位置信息,计算所述移动终端在相邻两个时刻的估计位置变化量,所述估计位置变化量为:
根据所述移动终端在所述各时刻的第二估计位置信息及所述估计位置变化量,通过联合迭代公式进行迭代,得到所述移动终端在所述各时刻的联合估计位置信息,所述联合迭代公式为:
PCP(t+1)=PFUSION(t)+ΔPCP(t+1)
PFUSION(t+1)=wTDOAPT(t+1)+wcpPCP(t+1)
其中,PFUSION(t)为所述移动终端在所述时刻t的联合估计位置信息,PFUSION(t+1)为所述移动终端在所述时刻(t+1)的联合估计位置信息,PT(t+1)为所述移动终端在所述时刻(t+1)的第二估计位置信息,并且,wTDOA+wcp=1,wTDOA为所述移动终端的第二估计位置信息的权重系数,wcp为所述移动终端的第一估计位置信息的权重系数。
2.根据权利要求1所述的方法,其特征在于,所述初始估计位置信息为在所述初始时刻由预设的时间差定位算法测量得到的;
所述根据所述各固定点的位置信息、所述初始估计位置信息以及在所述各时刻所述各固定点发送信号的载波相位值,计算所述移动终端在所述各时刻的第一估计位置信息,包括:
确定所述移动终端在相邻两个时刻测量到的所述各固定点发送信号的载波相位值的差值表达式,所述差值表达式为:
其中,φj(t)为在所述时刻t固定点j发送信号的载波相位值,φj(t-1)为在所述时刻(t-1)固定点j发送信号的载波相位值,(aj,bj)为固定点j的位置信息,(x(t),y(t))为所述移动终端在所述时刻t的实际位置信息,为所述移动终端在所述时刻(t-1)的第一估计位置信息;
对所述各固定点对应的差值表达式进行变换,得到所述各固定点对应的变换表达式,所述变换表达式为:
Rj(t)=(aj-x(t))2+(bj-y(t))2
将所述各固定点对应的变化表达式与参考固定点的变化表达式作差,得到线性方程组,所述线性方程组为:
Cx=b
其中,aij为ai与aj的差值、bij为bi与bj的差值,Kj=aj 2+bj 2,M为所述固定点的数量,
利用最小二乘法得到所述线性方程组的解,作为所述移动终端在所述各时刻的第一估计位置信息。
3.根据权利要求1所述的方法,其特征在于,根据所述移动终端在所述各时刻的联合估计位置信息、所述各固定点的位置信息、所述各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,包括:
获取预设载波相位表达式,所述预设载波相位表达式为:
其中,(xF (t),yF (t))为所述移动终端在所述时刻t的联合估计位置信息,Nj为所述固定点j相对于所述移动终端的初始整数模糊度、nj为所述固定点j的预设载波相位测量噪声,λ为载波波长;
将所述预设载波相位表达式中的非线性部分进行泰勒展开,得到展开后的所述各固定点相对于参考固定点的差分载波相位测量值表达式,并基于所述差分载波相位测量值表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,所述差分载波相位测量值表达式为:
其中,为所述差分载波相位测量值, 为所述预设载波相位表达式与常量的差值,ξ=(ζ(1) ζ(2) ... ζ(Z) N)T,ζ(t)=(xF (t),yF (t))T,n=(n(1) n(2) ... n(Z))T,Z为周期数,H为常量矩阵,
6.一种无线网络下的载波相位定位装置,其特征在于,所述装置包括:
获取模块,用于获取待定位区域中多个固定点的位置信息、移动终端在初始时刻的初始估计位置信息、所述移动终端在各时刻测量到的所述各固定点发送信号的载波相位值以及所述各固定点的预设载波相位测量噪声;
第一估计位置信息计算模块,用于根据所述各固定点的位置信息、所述初始估计位置信息以及在所述各时刻所述各固定点发送信号的载波相位值,计算所述移动终端在所述各时刻的第一估计位置信息,其中,在所述初始时刻,所述第一估计位置信息为所述初始估计位置信息;
联合估计位置信息计算模块,用于利用预设的时间差定位算法,计算所述移动终端在所述各时刻的第二估计位置信息,并根据所述移动终端在所述各时刻的第一估计位置信息和第二估计位置信息,计算所述移动终端在所述各时刻的联合估计位置信息,其中,在所述初始时刻,所述联合估计位置信息为所述初始估计位置信息;
差分载波相位测量值确定模块,用于根据所述移动终端在所述各时刻的联合估计位置信息、所述各固定点的位置信息、所述各固定点的预设载波相位测量噪声以及预设载波相位表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,所述参考固定点为所述多个固定点中的任一固定点;
固定解计算模块,用于基于所述各固定点相对于所述参考固定点的差分载波相位测量值,计算所述各固定点相对于所述移动终端的整数模糊度的浮动解及所述浮动解的协方差矩阵,并根据所述浮动解及所述协方差矩阵,利用最小二乘模糊度去相关算法,计算所述各固定点相对于所述移动终端的整数模糊度的固定解;
实际位置信息确定模块,用于利用所述各固定点相对于所述移动终端的整数模糊度的固定解,修正所述各固定点相对于所述参考固定点的差分载波相位测量值,并根据修正后的所述各固定点相对于所述参考固定点的差分载波相位测量值,利用预设定位算法,确定所述移动终端的实际位置信息;
所述联合估计位置信息计算模块,包括:
估计位置变化量计算子模块,用于根据所述移动终端在所述各时刻的第一估计位置信息,计算所述移动终端在相邻两个时刻的估计位置变化量,所述估计位置变化量为:
联合估计位置信息获取子模块,根据所述移动终端在所述各时刻的第二估计位置信息及所述估计位置变化量,通过联合迭代公式进行迭代,得到所述移动终端在所述各时刻的联合估计位置信息,所述联合迭代公式为:
PCP(t+1)=PFUSION(t)+ΔPCP(t+1)
PFUSION(t+1)=wTDOAPT(t+1)+wcpPCP(t+1)
其中,PFUSION(t)为所述移动终端在所述时刻t的联合估计位置信息,PFUSION(t+1)为所述移动终端在所述时刻(t+1)的联合估计位置信息,PT(t+1)为所述移动终端在所述时刻(t+1)的第二估计位置信息,并且,wTDOA+wcp=1,wTDOA为所述移动终端的第二估计位置信息的权重系数,wcp为所述移动终端的第一估计位置信息的权重系数。
7.根据权利要求6所述的装置,其特征在于,所述初始估计位置信息为在所述初始时刻由预设的时间差定位算法测量得到的;
所述第一估计位置信息计算模块,包括:
差值表达式确定子模块,用于确定所述移动终端在相邻两个时刻测量到的所述各固定点发送信号的载波相位值的差值表达式,所述差值表达式为:
其中,φj(t)为在所述时刻t固定点j发送信号的载波相位值,φj(t-1)为在所述时刻(t-1)固定点j发送信号的载波相位值,(aj,bj)为固定点j的位置信息,(x(t),y(t))为所述移动终端在所述时刻t的实际位置信息,为所述移动终端在所述时刻(t-1)的第一估计位置信息;
变换表达式获取子模块,用于对所述各固定点对应的差值表达式进行变换,得到所述各固定点对应的变换表达式,所述变换表达式为:
Rj(t)=(aj-x(t))2+(bj-y(t))2
线性方程组获取子模块,用于将所述各固定点对应的变化表达式与参考固定点的变化表达式作差,得到线性方程组,所述线性方程组为:
Cx=b
其中,aij为ai与aj的差值、bij为bi与bj的差值,Kj=aj 2+bj 2,M为所述固定点的数量,
求解子模块,用于利用最小二乘法得到所述线性方程组的解,作为所述移动终端在所述各时刻的第一估计位置信息。
8.根据权利要求6所述的装置,其特征在于,所述差分载波相位测量值确定模块,包括:
预设载波相位表达式子模块,用于获取预设载波相位表达式,所述预设载波相位表达式为:
其中,(xF (t),yF (t))为所述移动终端在所述时刻t的联合估计位置信息,Nj为所述固定点j相对于所述移动终端的初始整数模糊度、nj为所述固定点j的预设载波相位测量噪声,λ为载波波长;
差分载波相位测量值表达式确定子模块,用于将所述预设载波相位表达式中的非线性部分进行泰勒展开,得到展开后的所述各固定点相对于参考固定点的差分载波相位测量值表达式,并基于所述差分载波相位测量值表达式,确定所述各固定点相对于参考固定点的差分载波相位测量值,所述差分载波相位测量值表达式为:
其中,为所述差分载波相位测量值, 为所述预设载波相位表达式与常量的差值,ξ=(ζ(1) ζ(2) ... ζ(Z) N)T,ζ(t)=(xF (t),yF (t))T,n=(n(1) n(2) ... n(Z))T,Z为周期数,H为常量矩阵,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910580131.4A CN110231638B (zh) | 2019-06-28 | 2019-06-28 | 一种无线网络下的载波相位定位方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910580131.4A CN110231638B (zh) | 2019-06-28 | 2019-06-28 | 一种无线网络下的载波相位定位方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110231638A CN110231638A (zh) | 2019-09-13 |
CN110231638B true CN110231638B (zh) | 2021-06-04 |
Family
ID=67857569
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910580131.4A Active CN110231638B (zh) | 2019-06-28 | 2019-06-28 | 一种无线网络下的载波相位定位方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110231638B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115379382A (zh) * | 2020-05-14 | 2022-11-22 | 大唐移动通信设备有限公司 | 一种信息上报方法、装置、设备及可读存储介质 |
US11601913B2 (en) * | 2021-03-29 | 2023-03-07 | Locaila, Inc | Method and apparatus for positioning |
CN114466448B (zh) * | 2020-11-10 | 2023-04-11 | 大唐移动通信设备有限公司 | 定位方法、装置及处理器可读存储介质 |
CN112566242B (zh) * | 2020-12-03 | 2022-05-06 | 北京邮电大学 | 一种基于贝叶斯估计的定位方法、装置及电子设备 |
CN113091742B (zh) * | 2021-03-30 | 2023-11-17 | 北京邮电大学 | 一种融合定位方法、装置、电子设备及存储介质 |
CN114514525B (zh) * | 2021-06-09 | 2022-10-25 | 深圳大学 | 载波频率、初始相位、相位噪声的估计方法和相关设备 |
CN117204075A (zh) * | 2022-04-08 | 2023-12-08 | 北京小米移动软件有限公司 | 上行定位方法、装置、设备及存储介质 |
CN115166798A (zh) * | 2022-06-27 | 2022-10-11 | 北京邮电大学 | 轨道交通场景下的模糊度固定方法、装置及列车定位终端 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8400351B2 (en) * | 2009-02-22 | 2013-03-19 | Trimble Navigation Limited | GNSS moving base positioning |
CN103576175B (zh) * | 2013-11-06 | 2016-01-20 | 西南交通大学 | 一种双频多星座gnss整周模糊度otf解算方法 |
CN104635249B (zh) * | 2015-02-12 | 2017-05-03 | 东南大学 | 一种顾及FCBs的精密单点定位模糊度快速固定方法 |
WO2019032004A1 (en) * | 2017-08-11 | 2019-02-14 | Telefonaktiebolaget Lm Ericsson (Publ) | METHODS AND APPARATUSES FOR ESTIMATING A POSITION OF A WIRELESS DEVICE USING GLOBAL NAVIGATION SYSTEM SIGNALS |
CN109541658A (zh) * | 2018-12-27 | 2019-03-29 | 中国电子科技集团公司第二十研究所 | 一种用于卫星导航相对定位的虚拟点融合观测量生成方法 |
-
2019
- 2019-06-28 CN CN201910580131.4A patent/CN110231638B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110231638A (zh) | 2019-09-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110231638B (zh) | 一种无线网络下的载波相位定位方法及装置 | |
CN109782240B (zh) | 一种基于递推修正的多传感器系统误差配准方法和系统 | |
CN109085564B (zh) | 一种定位方法及装置 | |
CN113091742B (zh) | 一种融合定位方法、装置、电子设备及存储介质 | |
CN109029368B (zh) | 像方补偿的遥感影像/sar影像高精度几何定位后处理方法 | |
JP2001318136A (ja) | 重み付きリッジ回帰を使用する位置決定方法 | |
CN110798886B (zh) | 一种定位方法及装置 | |
CN112394383B (zh) | 一种卫星与5g基站组合定位方法及装置 | |
CN111385743A (zh) | 一种位置估计方法、装置及电子设备 | |
CN108566677B (zh) | 一种指纹定位方法及装置 | |
CN110927751B (zh) | 一种基于载波相位测量的阵列天线自适应校正实现方法 | |
CN113189625B (zh) | 基于单星干涉仪测向系统的误差校正方法、装置及卫星 | |
US20110181462A1 (en) | System and Method for Positioning with GNSS Using Multiple Integer Candidates | |
CN107613458A (zh) | 一种tdoa条件下最优联合时间同步与定位的定位方法 | |
CN111766580B (zh) | Sar遥感卫星大数据的逐次递推精化地面位置的方法 | |
CN111915570B (zh) | 基于反向传播神经网络的大气延迟估计方法 | |
CN109541541B (zh) | 一种室内三角定位精度修正方法及装置 | |
CN113866767B (zh) | 一种基于盲ncs的宽波束sar自聚焦方法 | |
CN115728787A (zh) | 基于对流层校正的定位方法、装置、设备和介质 | |
CN111435168A (zh) | 一种定位方法及装置 | |
CN112782741B (zh) | 基于rtk定位的模糊度固定方法及定位终端 | |
CN112566242B (zh) | 一种基于贝叶斯估计的定位方法、装置及电子设备 | |
CN111398956B (zh) | 多基高比星载sar三维定位rd方程优化配权方法 | |
CN110261853B (zh) | 一种极化合成孔径雷达的定标处理方法及装置 | |
CN112526449B (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 |