CN115718276A - TDOA (time difference of arrival) short baseline positioning method and system with zero error of base station position - Google Patents
TDOA (time difference of arrival) short baseline positioning method and system with zero error of base station position Download PDFInfo
- Publication number
- CN115718276A CN115718276A CN202211399700.3A CN202211399700A CN115718276A CN 115718276 A CN115718276 A CN 115718276A CN 202211399700 A CN202211399700 A CN 202211399700A CN 115718276 A CN115718276 A CN 115718276A
- Authority
- CN
- China
- Prior art keywords
- base station
- coordinates
- coordinate system
- radiation source
- base stations
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000005855 radiation Effects 0.000 claims abstract description 103
- 238000012545 processing Methods 0.000 claims abstract description 39
- 230000008447 perception Effects 0.000 claims abstract 2
- 238000013519 translation Methods 0.000 claims description 9
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000010276 construction Methods 0.000 claims description 5
- 230000006870 function Effects 0.000 claims 1
- 230000000717 retained effect Effects 0.000 claims 1
- 238000004364 calculation method Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
Description
技术领域technical field
本发明涉及无线通信技术领域,更具体的说是涉及一种基站位置零误差的TDOA短基线定位方法及系统。The present invention relates to the technical field of wireless communication, and more specifically relates to a TDOA short baseline positioning method and system with zero error in base station position.
背景技术Background technique
无线信号辐射源的精确定位是无线信号处理的重要研究方向,随着无线通讯设备和信息技术的发展,辐射源精确定位技术的应用范围日益广泛,尤其在救援、交通、物流、黑广播查找等领域,高精度辐射源定位的需求和作用与日俱增。The precise positioning of wireless signal radiation source is an important research direction of wireless signal processing. With the development of wireless communication equipment and information technology, the application range of radiation source precise positioning technology is becoming wider and wider, especially in rescue, transportation, logistics, black broadcast search, etc. In the field of radiation, the demand and role of high-precision radiation source positioning are increasing day by day.
非合作辐射源的被动定位技术无需向外辐射电磁波信号,且无需辐射源信号的先验信息,仅根据接收到的辐射源信号提取相关特征参数计算辐射源位置,具备隐蔽性好、设备小型化且成本低、定位精度高、应用场景简单等优势。The passive positioning technology of non-cooperative radiation sources does not need to radiate electromagnetic wave signals, and does not require prior information of radiation source signals. It only extracts relevant characteristic parameters from received radiation source signals to calculate the position of radiation sources, which has good concealment and miniaturized equipment. It has the advantages of low cost, high positioning accuracy, and simple application scenarios.
常用的被动定位方法包括到达时间差(Time Difference of Arrival,TDOA)、到达角(Angle of Arrival,AOA)、接收信号强度(Received Signal Strength,RSS)、到达频差(Frequency Difference of Arrival,FDOA)等,具有各自的优缺点。TDOA根据同一信号达到不同基站接收天线的时间差计算辐射源位置,定位精度最高,三基站实现二维定位,四基站实现三维定位,对基站设备要求相对较高,且基站布局、基站位置精度、同步时钟精度、同步触发信号精度等都会对定位精度产生影响。因为TDOA算法在计算基站之间的接收信号达到时间差后,再结合基站位置解算辐射源位置,因此TDOA算法的定位精度和基站的位置精度相关。Commonly used passive positioning methods include Time Difference of Arrival (TDOA), Angle of Arrival (AOA), Received Signal Strength (RSS), Frequency Difference of Arrival (FDOA), etc. , have their own advantages and disadvantages. TDOA calculates the location of the radiation source based on the time difference between the same signal reaching the receiving antennas of different base stations. The positioning accuracy is the highest. Three base stations realize two-dimensional positioning, and four base stations realize three-dimensional positioning. The requirements for base station equipment are relatively high, and base station layout, base station position accuracy, and synchronization Clock accuracy, synchronous trigger signal accuracy, etc. will all have an impact on positioning accuracy. Because the TDOA algorithm calculates the arrival time difference of the received signals between the base stations, and then calculates the position of the radiation source in combination with the base station position, the positioning accuracy of the TDOA algorithm is related to the position accuracy of the base station.
现有TDOA定位方法的基线长度(基站之间的距离)通常为km级,即长基线,普遍采用GPS/北斗接收机确定基站所处位置。The baseline length (distance between base stations) of the existing TDOA positioning method is usually at the km level, that is, the long baseline, and GPS/Beidou receivers are generally used to determine the location of the base stations.
然而,上述方法存在以下问题:普通GPS/北斗接收机定位误差通常为m级甚至10m级;利用RTK设备定位精度可达m级以上,但成本高昂。尤其在短基线条件下,基线长度最小可至100m,此时TDOA算法必须保证不同基站之间的接收信号到达距离差处于m级时才能精确计算,因此,GPS/北斗接收机的基站定位偏差和不同基站的接收信号到达距离差等于甚至大于同一量级,使得TDOA计算结果偏差极大甚至无法解算。However, the above methods have the following problems: the positioning error of ordinary GPS/Beidou receivers is usually m level or even 10m level; the positioning accuracy of RTK equipment can reach m level or above, but the cost is high. Especially under short baseline conditions, the minimum baseline length can be 100m. At this time, the TDOA algorithm must ensure that the received signal arrival distance difference between different base stations is at the m level, so that the accurate calculation can be performed. Therefore, the base station positioning deviation and The arrival distance difference of the received signals of different base stations is equal to or even greater than the same order of magnitude, which makes the TDOA calculation results deviate greatly and even cannot be solved.
因此,如何提供一种基站位置零误差的TDOA短基线定位方法及系统是本领域技术人员亟需解决的问题。Therefore, how to provide a TDOA short baseline positioning method and system with zero base station position error is an urgent problem to be solved by those skilled in the art.
发明内容Contents of the invention
有鉴于此,本发明提供了一种基站位置零误差的TDOA短基线定位方法及系统,实现基站位置零误差,完全消除基站位置误差对定位精度的影响,并使TDOA短基线定位在工程上得以实现,GPS/北斗接收机仅提供基站的地理位置锚点,用于计算辐射源的实际经纬度坐标,同时,也可用于其他对基站位置误差敏感的定位方法,提高定位精度。In view of this, the present invention provides a TDOA short baseline positioning method and system with zero base station position error, which can realize zero base station position error, completely eliminate the influence of base station position error on positioning accuracy, and enable TDOA short baseline positioning in engineering. To achieve, the GPS/Beidou receiver only provides the geographic anchor point of the base station, which is used to calculate the actual latitude and longitude coordinates of the radiation source. At the same time, it can also be used for other positioning methods that are sensitive to base station position errors to improve positioning accuracy.
为了实现上述目的,本发明采用如下技术方案:In order to achieve the above object, the present invention adopts the following technical solutions:
一种基站位置零误差的TDOA短基线定位方法,包括以下步骤:A TDOA short baseline positioning method with zero error in base station position, comprising the following steps:
S1.利用高精度长度测量仪器测量各基站间的直线距离,基站数量为N,N>3;S1. Use a high-precision length measuring instrument to measure the straight-line distance between each base station, the number of base stations is N, and N>3;
S2.选择任一基站为坐标原点,构建基站的局部坐标系,获取各基站在局部坐标系的坐标;S2. Select any base station as the coordinate origin, build a local coordinate system of the base station, and obtain the coordinates of each base station in the local coordinate system;
S3.获取辐射源信号到各基站的时间,并根据各基站坐标计算辐射源在局部坐标系的估计位置坐标;S3. Obtain the time when the radiation source signal arrives at each base station, and calculate the estimated position coordinates of the radiation source in the local coordinate system according to the coordinates of each base station;
S4.获取任意两个基站在绝对地理坐标系的经纬度坐标,将辐射源在局部坐标系的估计位置坐标转换为辐射源在绝对地理坐标系的地理坐标。S4. Obtain the latitude and longitude coordinates of any two base stations in the absolute geographic coordinate system, and convert the estimated position coordinates of the radiation source in the local coordinate system into geographic coordinates of the radiation source in the absolute geographic coordinate system.
优选的,S2的具体内容包括:Preferably, the specific content of S2 includes:
S21.从N个基站中任选四个基站,并选择任一基站1为坐标原点,按逆时针顺序分别为基站2、基站3和基站4,以基站1沿基站2直线方向为x轴正方向,以基站3和基站4所处方位为y轴正方向方位,构建基站的局部坐标系;S21. Select four base stations from the N base stations, and select any
S22.获取基站1、基站2、基站3和基站4在局部坐标系的坐标为:S22. Obtain the coordinates of
基站1的坐标为:The coordinates of
(x1,y1)=(0,0)(x 1 ,y 1 )=(0,0)
基站2的坐标为:The coordinates of
(x1,y2)=(l12,0)(x 1 ,y 2 )=(l 12, 0)
基站3的坐标为:The coordinates of
x3=l12-l23×cos(α123)x 3 =l 12 -l 23 ×cos(α 123 )
y3=l23×sin(α123)y 3 =l 23 ×sin(α 123 )
基站4的坐标为:The coordinates of
x4=l12-l24×cos(α124)x 4 =l 12 -l 24 ×cos(α 124 )
y4=l24×sin(α124)y 4 =l 24 ×sin(α 124 )
其中,l12、l13、l23和l24分别为各基站间的直线距离,α123和α124为基站间构成的夹角。Wherein, l 12 , l 13 , l 23 and l 24 are the straight-line distances between the base stations respectively, and α 123 and α 124 are the angles formed between the base stations.
优选的,S3的具体内容包括:Preferably, the specific content of S3 includes:
其中,辐射源RF的坐标为(x,y),基站i的坐标为(Xi,Yi),Ri为第i个基站到辐射源的距离,其中:i=1,2...,N,N为基站个数;Among them, the coordinates of the radiation source RF are (x, y), the coordinates of the base station i are (X i , Y i ), and R i is the distance from the i-th base station to the radiation source, where: i=1,2... , N, N is the number of base stations;
Eij=Ei-Ej E ij =E i -E j
Rij=cEij R ij =cE ij
Ei和Ej分别为辐射源信号到达基站i和j的时间,Eij为基站i和j之间的时延差理论值,Rij为基站i和j距离差的理论,c为电波传播速度;E i and E j are the time when the radiation source signal reaches base station i and j respectively, E ij is the theoretical value of delay difference between base station i and j, R ij is the theory of distance difference between base station i and j, c is the wave propagation speed;
fi(x,y)为第i个基站和基站1到辐射源距离的差值:f i (x, y) is the difference between the i-th base station and
第i个基站到基站1的距离差 为实际测量的估计距离差,εi1为估计误差;The distance difference between the i-th base station and
将fi(x,y)在(x0,y0)处泰勒级数展开并只保留前两项可得:Expand f i (x,y) in Taylor series at (x 0 ,y 0 ) and keep only the first two items:
其中,(x0,y0)为预设一个初始值,则x=x0+δx,y=y0+δy,fi,0为fi(x,y)在(x0,y0)处的函数值,上式写为矩阵形式为:Among them, (x 0 , y 0 ) is a preset initial value, then x=x 0 +δ x , y=y 0 +δ y , f i,0 is f i (x,y) in (x 0 , y 0 ), the above formula is written in matrix form as:
Aδ=R+eAδ=R+e
利用加权最小二乘法解上式,得解为:Using the weighted least squares method to solve the above formula, the solution is:
δ=[ATQ-1A]-1ATQ-1Rδ=[A T Q -1 A] -1 A T Q -1 R
其中Q为TDOA协方差矩阵;Where Q is the TDOA covariance matrix;
令x1=x0+δx,y1=y0+δy,重复上述过程,直到δx和δy足够小并满足预先设定的阈值门限ε,使得经过k次迭代得到的辐射源RF的位置(xk,yk)即为估计位置。Set x 1 =x 0 +δ x , y 1 =y 0 +δ y , repeat the above process until δ x and δ y are small enough to meet the preset threshold ε, so that The position (x k , y k ) of the radiation source RF obtained after k iterations is the estimated position.
优选的,S4中利用GPS或北斗接收机获取基站中任意两个基站的经纬度坐标。Preferably, in S4, GPS or Beidou receivers are used to obtain the latitude and longitude coordinates of any two base stations in the base stations.
优选的,S4的具体内容包括:Preferably, the specific content of S4 includes:
S41.根据任意两个基站1和2的经纬度坐标获得坐标系平移量;S41. Obtain the translation amount of the coordinate system according to the latitude and longitude coordinates of any two
S42.根据任意两个基站的经纬度坐标、两基站距离和经纬度转换经验公式计算获得坐标系旋转角;S42. Calculate and obtain the rotation angle of the coordinate system according to the latitude and longitude coordinates of any two base stations, the distance between the two base stations, and the empirical formula for latitude and longitude conversion;
S43.根据坐标系旋转角和辐射源在局部坐标系的估计位置坐标获得辐射源RF在地理坐标系下相对基站A的旋转角;S43. Obtain the rotation angle of the radiation source RF relative to the base station A in the geographic coordinate system according to the rotation angle of the coordinate system and the estimated position coordinates of the radiation source in the local coordinate system;
S44.根据经纬度和坐标经验公式,获取辐射源RF的地理坐标。S44. Acquire the geographical coordinates of the radiation source RF according to the latitude and longitude and the coordinate empirical formula.
优选的,S41中平移量为:Preferably, the amount of translation in S41 is:
S0=(LA1,LO1)S 0 =(LA 1 ,LO 1 )
S42中坐标系旋转角为:The rotation angle of the coordinate system in S42 is:
l12'=Re×(LA2-LA1)l 12' =R e ×(LA 2 -LA 1 )
l22'=Re×(LO2-LO1)×cos(LA1)l 22' =R e ×(LO 2 -LO 1 )×cos(LA 1 )
其中,(LA1,LO1)为基站1的经纬度坐标,(LA2,LO2)为基站2的经纬度坐标,2’和RF’分别为基站2和辐射源RF沿基站1所在纬线上的投影,∠α212’为基站2及2’与基站1构成的夹角,l12'和l22'分别为基站1距离基站2以及2’的距离,Re为基站1所处位置的地球半径;Among them, (LA 1 , LO 1 ) is the latitude and longitude coordinates of
S43中辐射源S在地理坐标下相对A的旋转角坐标系的旋转角为:In S43, the rotation angle of the radiation source S relative to the rotation angle coordinate system of A in geographic coordinates is:
其中,(xk,yk)为辐射源RF在局部坐标系的估计位置坐标;Wherein, (x k , y k ) is the estimated position coordinate of the radiation source RF in the local coordinate system;
S44中辐射源RF的地理坐标(LARF,LORF)为:The geographic coordinates (LA RF , LO RF ) of the radiation source RF in S44 are:
其中,基站1和辐射源RF以及RF’的距离为:Among them, the distance between
l1RF’=l1RFcos(RS)l 1RF' = l 1RF cos(R S )
lRFRF'=l1RFsin(RS)。l RFRF' = l 1RF sin(R S ).
优选的,当基站2位于基站A的西侧即∠α212’大于90度,则旋转角为:Preferably, when
一种基站位置零误差的TDOA短基线定位系统,包括感知基站、高精度长度测量仪器、局部坐标处理模型和地理坐标处理模型;A TDOA short-baseline positioning system with zero error in the position of the base station, including a sensing base station, a high-precision length measuring instrument, a local coordinate processing model, and a geographic coordinate processing model;
感知基站,用于感知辐射源信号并获取辐射源信号到各基站时间,基站数量为N,N>3;Sensing base station, used to sense the radiation source signal and obtain the time from the radiation source signal to each base station, the number of base stations is N, N>3;
高精度长度测量仪器,用于测量各基站间的直线距离;High-precision length measuring instrument for measuring the straight-line distance between base stations;
局部坐标处理模型,用于选择任一基站为坐标原点,构建基站的局部坐标系,获取各基站在局部坐标系的坐标;还用于根据辐射源信号到各基站的时间和各基站坐标,计算辐射源在局部坐标系的估计位置坐标;The local coordinate processing model is used to select any base station as the coordinate origin, construct the local coordinate system of the base station, and obtain the coordinates of each base station in the local coordinate system; it is also used to calculate the Estimated location coordinates of the radiation source in the local coordinate system;
地理坐标处理模型,用于获取任意两个基站在绝对地理坐标系的经纬度坐标,将辐射源在局部坐标系的估计位置坐标转换为辐射源在绝对地理坐标系的地理坐标。The geographic coordinate processing model is used to obtain the latitude and longitude coordinates of any two base stations in the absolute geographic coordinate system, and convert the estimated position coordinates of the radiation source in the local coordinate system into the geographic coordinates of the radiation source in the absolute geographic coordinate system.
优选的,局部坐标处理模型包括局部坐标构建单元、第一数据获取单元和第一数据处理单元;Preferably, the local coordinate processing model includes a local coordinate construction unit, a first data acquisition unit and a first data processing unit;
局部坐标构建单元,用于从N个基站中任选四个基站,并选择任一基站1为坐标原点,按逆时针顺序分别为基站2、基站3和基站4,以基站1沿基站2直线方向为x轴正方向,以基站3和基站4所处方位为y轴正方向方位,构建基站的局部坐标系;The local coordinate construction unit is used to select four base stations from N base stations, and select any
第一数据获取单元,用于根据各基站间的直线距离获取基站1、2、3和4在局部坐标系的坐标;The first data acquisition unit is used to acquire the coordinates of the
第一数据处理单元,用于根据辐射源信号到各基站的时间和各基站坐标,计算辐射源在局部坐标系的估计位置坐标。The first data processing unit is configured to calculate the estimated position coordinates of the radiation source in the local coordinate system according to the time when the radiation source signal arrives at each base station and the coordinates of each base station.
优选的,地理坐标处理模型包括第二数据获取单元、第二数据处理模块和第三数据处理单元;Preferably, the geographic coordinate processing model includes a second data acquisition unit, a second data processing module and a third data processing unit;
第二数据获取单元,用于获取任意两个基站1和2的经纬度坐标,获取两基站距离数据,以及获取辐射源在局部坐标系的估计位置坐标;The second data acquisition unit is configured to acquire the latitude and longitude coordinates of any two
第二数据处理单元,用于根据任意两个基站1和2的经纬度坐标获得坐标系平移量;还用于根据任意两个基站的经纬度坐标、两基站距离和经纬度转换经验公式计算获得坐标系旋转角;The second data processing unit is used to obtain the translation of the coordinate system according to the latitude and longitude coordinates of any two
第三数据处理单元,用于根据坐标系旋转角和辐射源在局部坐标系的估计位置坐标获得辐射源在地理坐标系下相对基站1的旋转角,还用于根据经纬度和坐标经验公式,获取辐射源的地理坐标。The third data processing unit is used to obtain the rotation angle of the radiation source relative to the
经由上述的技术方案可知,与现有技术相比,本发明公开提供了一种基站位置零误差的TDOA短基线定位方法及系统,利用高精度测距仪器准确测量基站之间的实际距离,在TDOA计算过程中实现基站位置零误差,完全消除基站位置误差对定位精度的影响,并使TDOA短基线定位在工程上得以实现;相比于通常采用的利用GPS/北斗接收机仅提供基站的地理位置,再转化为局部坐标系进行TDOA解算的过程,本发明直接用高精度测距结果进行解算,降低算法复杂性的同时大大降低GPS/北斗接收机本身的误差影响。It can be known from the above-mentioned technical solutions that, compared with the prior art, the present invention discloses a TDOA short baseline positioning method and system with zero error in the position of the base station, and uses a high-precision ranging instrument to accurately measure the actual distance between the base stations. In the process of TDOA calculation, the zero error of the base station position is realized, which completely eliminates the influence of the base station position error on the positioning accuracy, and enables the TDOA short baseline positioning to be realized in engineering; In the process of converting the position into a local coordinate system for TDOA calculation, the present invention directly uses the high-precision ranging results for calculation, which reduces the complexity of the algorithm and greatly reduces the error influence of the GPS/Beidou receiver itself.
附图说明Description of drawings
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。In order to more clearly illustrate the technical solutions in the embodiments of the present invention or the prior art, the following will briefly introduce the drawings that need to be used in the description of the embodiments or the prior art. Obviously, the accompanying drawings in the following description are only It is an embodiment of the present invention, and those skilled in the art can also obtain other drawings according to the provided drawings without creative work.
图1附图为本发明提供的四基站TDOA短基线定位实施方案结构示意图;The accompanying drawing of Fig. 1 is the schematic structural diagram of the four-base station TDOA short baseline positioning implementation scheme provided by the present invention;
图2附图为本发明提供的任意两基站A和B以及辐射源在地理坐标中位置示意图。FIG. 2 is a schematic diagram of the geographical coordinates of any two base stations A and B and radiation sources provided by the present invention.
具体实施方式Detailed ways
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The following will clearly and completely describe the technical solutions in the embodiments of the present invention with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only some, not all, embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts belong to the protection scope of the present invention.
本发明实施例公开了一种基站位置零误差的TDOA短基线定位方法,包括以下步骤:The embodiment of the present invention discloses a TDOA short baseline positioning method with zero error in base station position, comprising the following steps:
S1.利用高精度长度测量仪器测量各基站间的直线距离,基站数量为N,N>3;S1. Use a high-precision length measuring instrument to measure the straight-line distance between each base station, the number of base stations is N, and N>3;
S2.选择任一基站为坐标原点,构建基站的局部坐标系,获取各基站在局部坐标系的坐标;S2. Select any base station as the coordinate origin, build a local coordinate system of the base station, and obtain the coordinates of each base station in the local coordinate system;
S3.获取辐射源信号到各基站的时间,并根据各基站坐标计算辐射源在局部坐标系的估计位置坐标;S3. Obtain the time when the radiation source signal arrives at each base station, and calculate the estimated position coordinates of the radiation source in the local coordinate system according to the coordinates of each base station;
S4.获取任意两个基站在绝对地理坐标系的经纬度坐标,将辐射源在局部坐标系的估计位置坐标转换为辐射源在绝对地理坐标系的地理坐标。S4. Obtain the latitude and longitude coordinates of any two base stations in the absolute geographic coordinate system, and convert the estimated position coordinates of the radiation source in the local coordinate system into geographic coordinates of the radiation source in the absolute geographic coordinate system.
在实际应用中,利用卷尺、激光测距仪、望远镜测距仪和全站仪等高精度长度测量仪器测量各基站间的直线距离。In practical applications, high-precision length measuring instruments such as tape measure, laser rangefinder, telescope rangefinder and total station are used to measure the straight-line distance between base stations.
高精度测距仪测得的基站之间距离误差可达到厘米级,倾角误差达到一度以内,误差可忽略不计。从而可计算得到无误差的基站间相对坐标,使得在定位计算结算过程中完全消除基站位置误差对定位精度造成的影响。The distance error between the base stations measured by the high-precision range finder can reach the centimeter level, and the inclination angle error can reach within one degree, and the error can be ignored. Therefore, error-free relative coordinates between base stations can be calculated, so that the influence of base station position errors on positioning accuracy can be completely eliminated during the positioning calculation and settlement process.
优选的,S2的具体内容包括:Preferably, the specific content of S2 includes:
S21.从N个基站中任选四个基站,并选择任一基站1为坐标原点,按逆时针顺序分别为基站2、基站3和基站4,以基站1沿基站2直线方向为x轴正方向,以基站3和基站4所处方位为y轴正方向方位,构建基站的局部坐标系;S21. Select four base stations from the N base stations, and select any
S22.获取基站1、基站2、基站3和基站4在局部坐标系的坐标为:S22. Obtain the coordinates of
基站1的坐标为:The coordinates of
(x1,y1)=(0,0)(x 1 ,y 1 )=(0,0)
基站2的坐标为:The coordinates of
(x1,y2)=(l12,0)(x 1 ,y 2 )=(l 12 ,0)
基站3的坐标为:The coordinates of
x3=l12-l23×cos(α123)x 3 =l 12 -l 23 ×cos(α 123 )
y3=l23×sin(α123)y 3 =l 23 ×sin(α 123 )
基站4的坐标为:The coordinates of
x4=l12-l24×cos(α124)x 4 =l 12 -l 24 ×cos(α 124 )
y4=l24×sin(α124)y 4 =l 24 ×sin(α 124 )
其中,l12、l13、l23和l24分别为各基站间的直线距离,α123和α124为基站间构成的夹角。Wherein, l 12 , l 13 , l 23 and l 24 are the straight-line distances between the base stations respectively, and α 123 and α 124 are the angles formed between the base stations.
在本实施例中,基站A、B、C和D的顺序按照逆时针依次定义,以保证C和D基站的纵坐标为均为正值,便于后续方位估计,且相对方位与实际相符,如图1。In this embodiment, the order of base stations A, B, C, and D is defined counterclockwise to ensure that the ordinates of base stations C and D are all positive values, which is convenient for subsequent orientation estimation, and the relative orientation is consistent with the actual situation, as shown in figure 1.
在实际应用中,如果需要计算辐射源的三维坐标,则利用望远镜测距仪、全站仪等高精度长度测量仪器同时测量基站间的水平夹角,根据余弦定理计算各基站的z坐标。In practical applications, if it is necessary to calculate the three-dimensional coordinates of the radiation source, high-precision length measuring instruments such as telescope range finders and total stations are used to measure the horizontal angle between the base stations at the same time, and the z coordinates of each base station are calculated according to the cosine law.
在实际应用中,采用两步最小二乘Chan算法或泰勒级数Taylor展开等算法求解方法计算目标辐射源位置,本实施以Taylor算法为例。In practical applications, two-step least squares Chan algorithm or Taylor series Taylor expansion are used to calculate the position of the target radiation source. This implementation uses the Taylor algorithm as an example.
为了进一步实施上述技术方案,S3的具体内容包括:In order to further implement the above technical solutions, the specific content of S3 includes:
其中,辐射源RF的坐标为(x,y),基站i的坐标为(Xi,Yi),Ri为第i个基站到辐射源的距离,其中:i=1,2...,N,N为基站个数;Among them, the coordinates of the radiation source RF are (x, y), the coordinates of the base station i are (X i , Y i ), and R i is the distance from the i-th base station to the radiation source, where: i=1,2... , N, N is the number of base stations;
Eij=Ei-Ej E ij =E i -E j
Rij=cEij R ij =cE ij
Ei和Ej分别为辐射源信号到达基站i和j的时间,Eij为基站i和j之间的时延差理论值,Rij为基站i和j距离差的理论,c为电波传播速度;E i and E j are the time when the radiation source signal reaches base station i and j respectively, E ij is the theoretical value of delay difference between base station i and j, R ij is the theory of distance difference between base station i and j, c is the wave propagation speed;
fi(x,y)为第i个基站和基站1到辐射源距离的差值:f i (x, y) is the difference between the i-th base station and
第i个基站到基站1的距离差 为实际测量的估计距离差,εi1为估计误差;The distance difference between the i-th base station and
将fi(x,y)在(x0,y0)处泰勒级数展开并只保留前两项可得:Expand f i (x,y) in Taylor series at (x 0 ,y 0 ) and keep only the first two items:
其中,(x0,y0)为预设一个初始值,则x=x0+δx,y=y0+δy,fi,0为fi(x,y)在(x0,y0)处的函数值,上式写为矩阵形式为:Among them, (x 0 , y 0 ) is a preset initial value, then x=x 0 +δ x , y=y 0 +δ y , f i,0 is f i (x,y) in (x 0 , y 0 ), the above formula is written in matrix form as:
Aδ=R+eAδ=R+e
利用加权最小二乘法解上式,得解为:Using the weighted least squares method to solve the above formula, the solution is:
δ=[ATQ-1A]-1ATQ-1Rδ=[A T Q -1 A] -1 A T Q -1 R
其中Q为TDOA协方差矩阵;Where Q is the TDOA covariance matrix;
令x1=x0+δx,y1=y0+δy,重复上述过程,直到δx和δy足够小并满足预先设定的阈值门限ε,使得经过k次迭代得到的辐射源RF的位置(xk,yk)即为估计位置。Set x 1 =x 0 +δ x , y 1 =y 0 +δ y , repeat the above process until δ x and δ y are small enough to meet the preset threshold ε, so that The position (x k , y k ) of the radiation source RF obtained after k iterations is the estimated position.
为了进一步实施上述技术方案,S4中利用GPS或北斗接收机获取基站中任意两个基站的经纬度坐标。In order to further implement the above technical solution, in S4, the GPS or Beidou receiver is used to obtain the latitude and longitude coordinates of any two base stations in the base stations.
为了进一步实施上述技术方案,S4的具体内容包括:In order to further implement the above technical solutions, the specific content of S4 includes:
S41.根据任意两个基站1和2的经纬度坐标获得坐标系平移量;S41. Obtain the translation amount of the coordinate system according to the latitude and longitude coordinates of any two
S42.根据任意两个基站的经纬度坐标、两基站距离和经纬度转换经验公式计算获得坐标系旋转角;S42. Calculate and obtain the rotation angle of the coordinate system according to the latitude and longitude coordinates of any two base stations, the distance between the two base stations, and the empirical formula for latitude and longitude conversion;
S43.根据坐标系旋转角和辐射源在局部坐标系的估计位置坐标获得辐射源RF在地理坐标系下相对基站1的旋转角;S43. Obtain the rotation angle of the radiation source RF relative to the
S44.根据经纬度和坐标经验公式,获取辐射源RF的地理坐标。S44. Acquire the geographical coordinates of the radiation source RF according to the latitude and longitude and the coordinate empirical formula.
为了进一步实施上述技术方案,S41中平移量为:In order to further implement the above technical scheme, the amount of translation in S41 is:
S0=(LA1,LO1)S 0 =(LA 1 ,LO 1 )
S42中坐标系旋转角为:The rotation angle of the coordinate system in S42 is:
l12'=Re×(LA2-LA1)l 12' =R e ×(LA 2 -LA 1 )
l22'=Re×(LO2-LO1)×cos(LA1)l 22' =R e ×(LO 2 -LO 1 )×cos(LA 1 )
其中,(LA1,LO1)为基站1的经纬度坐标,(LA2,LO2)为基站2的经纬度坐标,2’和RF’分别为基站2和辐射源RF沿基站1所在纬线上的投影,∠α212’为基站2及2’与基站1构成的夹角,l12'和l22'分别为基站1距离基站2以及2’的距离,Re为基站1所处位置的地球半径;Among them, (LA 1 , LO 1 ) is the latitude and longitude coordinates of
在本实施中,考虑到基站间距离的尺度相对地球弧度极小,采用经验公式转换坐标的误差可忽略。In this implementation, considering that the scale of the distance between base stations is extremely small relative to the earth's radian, the error of converting the coordinates by using the empirical formula can be ignored.
S43中辐射源S在地理坐标下相对A的旋转角坐标系的旋转角为:In S43, the rotation angle of the radiation source S relative to the rotation angle coordinate system of A in geographic coordinates is:
其中,(xk,yk)为辐射源RF在局部坐标系的估计位置坐标;Wherein, (x k , y k ) is the estimated position coordinate of the radiation source RF in the local coordinate system;
S44中辐射源RF的地理坐标(LARF,LORF)为:The geographic coordinates (LA RF , LO RF ) of the radiation source RF in S44 are:
其中,基站1和辐射源RF以及RF’的距离为:Among them, the distance between
l1RF’=l1RFcos(RS)l 1RF' = l 1RF cos(R S )
lRFRF'=l1RFsin(RS)。l RFRF' = l 1RF sin(R S ).
在另一实施例中,由于取值范围为考虑到B可能位于A的西侧,因此并不一定等于必须考虑B相对于A的实际方位判断。In another embodiment, due to The value range is Considering that B may be on the west side of A, it is not necessarily equal to The actual orientation judgment of B relative to A must be considered.
为了进一步实施上述技术方案,当基站2位于基站A的西侧即∠α212’大于90度,则旋转角为:In order to further implement the above technical solution, when the
一种基站位置零误差的TDOA短基线定位系统,包括感知基站、高精度长度测量仪器、局部坐标处理模型和地理坐标处理模型A TDOA short-baseline positioning system with zero error in the position of the base station, including a sensing base station, a high-precision length measuring instrument, a local coordinate processing model, and a geographic coordinate processing model
感知基站,用于感知辐射源信号并获取辐射源信号到各基站时间,基站数量为N,N>3;Sensing base station, used to sense the radiation source signal and obtain the time from the radiation source signal to each base station, the number of base stations is N, N>3;
高精度长度测量仪器,用于测量各基站间的直线距离;High-precision length measuring instrument for measuring the straight-line distance between base stations;
局部坐标处理模型,用于选择任一基站为坐标原点,构建基站的局部坐标系,获取各基站在局部坐标系的坐标;还用于根据辐射源信号到各基站的时间和各基站坐标,计算辐射源在局部坐标系的估计位置坐标;The local coordinate processing model is used to select any base station as the coordinate origin, construct the local coordinate system of the base station, and obtain the coordinates of each base station in the local coordinate system; it is also used to calculate the Estimated location coordinates of the radiation source in the local coordinate system;
地理坐标处理模型,用于获取任意两个基站在绝对地理坐标系的经纬度坐标,将辐射源在局部坐标系的估计位置坐标转换为辐射源在绝对地理坐标系的地理坐标。The geographic coordinate processing model is used to obtain the latitude and longitude coordinates of any two base stations in the absolute geographic coordinate system, and convert the estimated position coordinates of the radiation source in the local coordinate system into the geographic coordinates of the radiation source in the absolute geographic coordinate system.
为了进一步实施上述技术方案,局部坐标处理模型包括局部坐标构建单元、第一数据获取单元和第一数据处理单元;In order to further implement the above technical solution, the local coordinate processing model includes a local coordinate construction unit, a first data acquisition unit and a first data processing unit;
局部坐标构建单元,用于从N个基站中任选四个基站,并选择任一基站1为坐标原点,按逆时针顺序分别为基站2、基站3和基站4,以基站1沿基站2直线方向为x轴正方向,以基站3和基站4所处方位为y轴正方向方位,构建基站的局部坐标系;The local coordinate construction unit is used to select four base stations from N base stations, and select any
第一数据获取单元,用于根据各基站间的直线距离获取基站1、2、3和4在局部坐标系的坐标;The first data acquisition unit is used to acquire the coordinates of the
第一数据处理单元,用于根据辐射源信号到各基站的时间和各基站坐标,计算辐射源在局部坐标系的估计位置坐标。The first data processing unit is configured to calculate the estimated position coordinates of the radiation source in the local coordinate system according to the time when the radiation source signal arrives at each base station and the coordinates of each base station.
为了进一步实施上述技术方案,地理坐标处理模型包括第二数据获取单元、第二数据处理模块和第三数据处理单元;In order to further implement the above technical solution, the geographic coordinate processing model includes a second data acquisition unit, a second data processing module and a third data processing unit;
第二数据获取单元,用于获取任意两个基站1和2的经纬度坐标,获取两基站距离数据,以及获取辐射源在局部坐标系的估计位置坐标;The second data acquisition unit is configured to acquire the latitude and longitude coordinates of any two
第二数据处理单元,用于根据任意两个基站1和2的经纬度坐标获得坐标系平移量;还用于根据任意两个基站的经纬度坐标、两基站距离和经纬度转换经验公式计算获得坐标系旋转角;The second data processing unit is used to obtain the translation of the coordinate system according to the latitude and longitude coordinates of any two
第三数据处理单元,用于根据坐标系旋转角和辐射源在局部坐标系的估计位置坐标获得辐射源在地理坐标系下相对基站1的旋转角,还用于根据经纬度和坐标经验公式,获取辐射源的地理坐标The third data processing unit is used to obtain the rotation angle of the radiation source relative to the
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。Each embodiment in this specification is described in a progressive manner, each embodiment focuses on the difference from other embodiments, and the same and similar parts of each embodiment can be referred to each other. As for the device disclosed in the embodiment, since it corresponds to the method disclosed in the embodiment, the description is relatively simple, and for the related information, please refer to the description of the method part.
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。The above description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the invention. Therefore, the present invention will not be limited to the embodiments shown herein, but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211399700.3A CN115718276A (en) | 2022-11-09 | 2022-11-09 | TDOA (time difference of arrival) short baseline positioning method and system with zero error of base station position |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211399700.3A CN115718276A (en) | 2022-11-09 | 2022-11-09 | TDOA (time difference of arrival) short baseline positioning method and system with zero error of base station position |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115718276A true CN115718276A (en) | 2023-02-28 |
Family
ID=85255539
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211399700.3A Pending CN115718276A (en) | 2022-11-09 | 2022-11-09 | TDOA (time difference of arrival) short baseline positioning method and system with zero error of base station position |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115718276A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117805864A (en) * | 2023-12-29 | 2024-04-02 | 无锡卡尔曼导航技术有限公司南京技术中心 | A positioning calculation and optimization method |
-
2022
- 2022-11-09 CN CN202211399700.3A patent/CN115718276A/en active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117805864A (en) * | 2023-12-29 | 2024-04-02 | 无锡卡尔曼导航技术有限公司南京技术中心 | A positioning calculation and optimization method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11856483B2 (en) | Method and system for radiolocation asset tracking via a mesh network | |
CN103293512B (en) | Positioned using this earthwave propagation model | |
US8630804B2 (en) | Method for geolocating an object by multitelemetry | |
US7570213B2 (en) | Method and apparatus for detecting and locating intrusion in a wireless network | |
US20190360804A1 (en) | Systems and methods for determining when an estimated altitude of a mobile device can be used for calibration or location determination | |
CA2667916A1 (en) | Method and device for determination of the position of a terminal in a mobile communication network | |
CN114501300A (en) | Distributed positioning algorithm based on space environment error model | |
CN104101863A (en) | Locating system based on intelligent mobile device and locating method | |
Lategahn et al. | Tdoa and rss based extended kalman filter for indoor person localization | |
Lv et al. | Geometry influence on GDOP in TOA and AOA positioning systems | |
Guo et al. | Large-scale indoor localization solution for pervasive smartphones using corrected acoustic signals and data-driven PDR | |
CN108508404A (en) | A kind of localization method and system based on aerial array | |
Guo et al. | Virtual wireless device-constrained robust extended Kalman filters for smartphone positioning in indoor corridor environment | |
CN115718276A (en) | TDOA (time difference of arrival) short baseline positioning method and system with zero error of base station position | |
RU2624790C1 (en) | Dynamic positioning method of mobile objects | |
CN115979256A (en) | Multi-source collaborative pose determination method, device and system based on artificial beacon | |
Liu et al. | Data-driven antenna delay calibration for UWB devices for network positioning | |
Fokin et al. | Topology search using dilution of precision criterion for enhanced 5G positioning service area | |
KR101058098B1 (en) | A terminal and a system for measuring its own location according to the location information of another terminal and the reliability of the location information and a method for measuring the location | |
RU137394U1 (en) | DEVICE FOR PROCESSING INFORMATION OF NETWORK DISTANCED IN THE SPACE OF PELENGATION POST | |
Jiang et al. | Analysis of Positioning Error for Two‐Dimensional Location System | |
KR101459915B1 (en) | Method of Localization | |
Tan et al. | Positioning techniques for fewer than four GPS satellites | |
Jiang et al. | Hybrid TOA-TDOA Positioning Algorithm in AIS | |
CN112198501A (en) | Direct positioning method and device for single motion station |
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 |