CN104422921A - 一种基于方位和自时差测量的固定单站无源定位*** - Google Patents
一种基于方位和自时差测量的固定单站无源定位*** Download PDFInfo
- Publication number
- CN104422921A CN104422921A CN201310369622.7A CN201310369622A CN104422921A CN 104422921 A CN104422921 A CN 104422921A CN 201310369622 A CN201310369622 A CN 201310369622A CN 104422921 A CN104422921 A CN 104422921A
- Authority
- CN
- China
- Prior art keywords
- delta
- target
- theta
- angle
- ratio
- 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
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
- G01S1/00—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith
- G01S1/72—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith using ultrasonic, sonic or infrasonic waves
- G01S1/76—Systems for determining direction or position line
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
对运动目标的纯方位观测问题的研究已具有60多年历史,本发明公开了一种基于方位和自时差测量获得移动目标运动参数的固定单站无源定位方法,在运动目标相邻移动距离不相等的一般情况下,通过充分利用简单的平面几何关系和自时差测量方程,以及迭代计算方法,完整和准确的给出了求解运动目标的航向角、移动速度和移动时差、目标与单测向站之间径向距离等参量的解析计算公式,所提出的新方法突破了在一般情形下,现有固定单站纯方位无源探测仅能获得目标航向,以及速度与初始距离比值的局限性。
Description
技术领域
本发明涉及无线电定位测量技术领域,具体涉及一种固定单站对移动目标的无源定位方法。
背景技术
在被动测量的情况下,仅仅利用目标的方位信息,估计目标运动参数的过程,称为纯方位目标运动分析(BTMA)。对运动目标的纯方位观测问题的研究已具有60多年历史,已有的经典分析表明,在二维平面上,当目标不是在相对于单观测站的径向方向运动时,利用静止单观测站所测量到的匀速直线运动目标的方位以及时差,仅可以估计出目标的航向角、目标通过航路勾径点的时刻、以及速度与初距的比值。
此外,已有的研究也表明,如在推导过程中限定:被测目标从一个位置移动到另一个位置的移动时间差或移动距离相等,则目标与观测站之间的距离就能够被解析求解。但这种附加条件极大的限制了工程可应用性,事实上,对于单站测向定位方式,除非是对于定周期的脉冲信号,一般情况下被测目标从一个位置移动到另一个位置的移动时间差或移动距离差是无法通过直接测量获得的。
纯方位目标运动分析的一个最主要的应用领域是水下无源定位,在水下一般只能通过声波来传送信息,而声传感器通常只能获得目标的方位信息。伴随着海洋开发活动的日益发展,对于海底地貌勘测、水文数据采集、水下搜索以及水下机器人的应用等等的需要,都已经使得水下无源定位技术越来越受到人们的重视,并在海底作业中发挥着越来越重要的作用。例如,长时期潜伏于水下的锚系潜器***,可用于长时间监测记录海洋环境噪声,并具有探测、定位、记录过往舰船目标信息和远程通信的功能,是海洋环境监测的一种重要装备。
发明内容
针对现有纯方位目标运动定位方法所存在的不足,本发明的目的是针对运动目标相邻移动距离不相等的一般情况,充分利用简单的平面几何关系和自时差测量方程,以及迭代计算方法,完整和准确的给出了求解运动目标航向角、移动速度和移动时差、目标与观测站之间径向距离等参量的解析计算公式,所提出的新方法突破了在一般情形下,固定单站纯方位无源探测仅能获得目标航向,以及速度与初始距离比值的局限性。
现有的纯方位目标运动分析的研究历史似乎是十分复杂而又艰难的,其经典的求解方法之所以得不到完整的定位解。原因在于仅利用了距离与速度之间的关系。事实上,必须注意的事实是:在现有的纯方位目标运动分析中是包含有目标移动时差测量的,因此,基于几何和时差约束条件,通过DOA和TOA测量,固定单站的纯方位无源定位是完全能被解析分析的,且通过一次迭代计算,即可消除在自时差测量方程中所存有的不稳定特性,并获得准确的计算结果。
本发明是通过如下技术方案实现的:
假设移动目标近似匀速直线运动,首先利用自时差方程和前置角与观测方位角之间的几何关系证明目标端相邻移动距离之比能间接地由观测处相邻观测时差之比近似估算;然后,利用前置角与观测方位角之间的几何关系解出目标端的前置角和目标的航向角。随后的分析表明,一旦利用近似估算所得到的前置角来直接解算目标端相邻移动距离的比值,并再次利用前置角与观测方位角之间的几何关系进行一次迭代计算,则即可获得准确度足够高的前置角,且由此就能直接从自时差方程准确的求得移动目标的各个运动参数。
具体包括以下步骤:
步骤1、测向基准
固定单站可利用其它定位装置或定位***确定自身的地理位置,并设定测向基准,测向基准和地理位置坐标可在初始安置固定观测站时利用外置设备设定,亦能在固定单站观测平台上直接安置相关的用于确定测向基准及地理位置坐标的模块或***,对于极为简单的应用场合,测向基准和地理位置的设定也可被省略;
步骤2、目标方位的测量
利用测向设备连续探测目标的方位θi,且在假定目标近似为匀速直线运动的条件下,测向单元至少必须连续进行三次测向,由此亦能获得方位的相邻角度差Δθi=θi+1-θi;
步骤3、观测时差的测量
在测量及记录目标方位的同时,利用时间记录设备检测和记录时间的绝对值Ti,并由此获得两次相邻测向之间的观测时差ΔTi=Ti+1-Ti;
步骤4、目标端相邻移动距离比值的近似估计
在通过测向和自时差检测获得三组数据序列:方位角θi、方位角差Δθi和观测时差ΔTi的基础上,利用几何关系和自时差方程证明目标端相邻移动距离di之比近似等于观测处相邻观测时差ΔTi之比:
步骤5、目标前置角的近似解析计算
(1)利用目标处的相邻移动距离之比和前置角、观测方位角之间的函数关系解出目标的前置角β:
式中:式中: Δθi=θi+1-θi。
(2)进一步可由观测方位角差Δθi,获得目标在其余位置处的前置角:
β1=β2-Δθ1 (3A)
β3=β2+Δθ2 (3B)
步骤6、目标航向角的计算
(1)在目标前置角为0<β1<180°时,航向角的计算式为:
(2)在目标前置角为90<β1<180°时,航向角为:
步骤7、目标移动距离比值的直接解算
利用近似估计得到的前置角,直接求解目标移动距离的比值:
上式中在相邻径向距离之间的比值和在移动距离与径向距离之间的比值是:
步骤8、前置角的迭代计算
在直接求得目标相邻移动距离比值的基础上,再次利用前置角、观测方位角之间的函数关系即可解出准确性更好的目标前置角:
式中:
步骤8、目标运动参数的计算
利用迭代计算得到的前置角,先重新计算在相邻径向距离之间的比值和在移动距离与径向距离之间的比值,随后按下列各式解算目标的运动参数:
(1)目标的移动速度:
式中:vc为声速。
(2)目标的移动时差Δti
(3)目标与观测站之间的径向距离r2
本发明的贡献:
在目标端相邻移动距离不相等的一般情况下,利用简单的平面几何分析和自时差测量方程,以及迭代计算方法,完整和准确的给出了求解移动目标运动参数的解析计算方法,突破了现有固定单站无源定位方法在一般情形下仅能有效获得目标航向角的局限性。
附图说明
图1:几何模型
图2:航向角的理论值与测算值之间的相对误差比对
图3:目标移动速度的相对计算误差
图4:目标移动时差的相对计算误差
图5:径向距离的相对计算误差
具体实施方式
下面结合附图1-图5进一步说明本发明是如何实现的。
实施例
一种基于方位-自时差测量的固定单站无源定位方法。图1为几何模型;图2是航向角的理论值与测算值之间的相对误差比对;图3目标移动速度的相对计算误差;图4给出了目标移动时差的相对计算误差;图5为径向距离的相对计算误差。
现有的固定单站纯方位目标运动分析仅能有效求得目标的航向角,本发明方法表明,通过DOA和TOA测量,固定单站的纯方位无源定位是完全能被解析分析的,且通过一次迭代计算,即可消除在自时差测量方程中所存有的不稳定特性,并获得准确的计算结果。
1、自时差测量方程
固定单站与被测目标间的几何关系如附图1所示,在短时间内,目标可被假定为近似匀速直线运动,固定观测单站连续观测目标的方位角,同时,测量两次测向之间的时差值。
假定目标信号在位置A时的发射瞬间的时间值为T0,则观测站所接收到的此来波信号的时间值T1是:
式中:r1是目标与探测站之间的径向距离;vc是声音在水中的传播速度,且模拟计算时取vc=1550m/s。
分段考虑信号传播和目标移动所花费的时间,当目标移动到达位置B时,固定观测站所接收到的来自位置A处,且从T0时刻算起的累加时间值T2是:
式中:r2是目标在位置B处的径向距离;Δt1为目标从A移动到B的时间间隔。
两观测时间之差是:
按同样的方法有:
式中:Δt2为目标从B移动到C的时间间隔。
因自时差是对时间间隔的累加,故为满足物理观察的真实性,对程差项加绝对值符号是必须的,否则当两径向距离之差出现“负”值时,时间间隔的累加特性就将被破坏,计算就将是不正确的。
对观测时差移项整理后得:
vcΔt1+|r2-r1|=vcΔT1 (5)
vcΔt2+|r3-r2|=vcΔT2 (6)
2、在移动距离与观测时差之间的比值
根据附图1所示的几何关系,可以得到方位的相邻角度差Δθi:
式中:di是目标在Δti时间内的移动距离;βi是目标的前置角;角度差Δθi=θi+1-θi,可通过纯方位检测获得的,其中,θi是在观测站位置处所测量得到的目标方位角。
通过变形整理,且两式联解消去径向距离r2之后,可得到相邻移动距离的比值:
若前置角未知,则目标相邻移动距离的比值是不能被确定的,但由附图1所示的几何关系还可得到:
当Δθi较小时,近似有:tgΔθi≈sinΔθi,等式两边相约后可得到:
|r2-r1|≈d1cosβ2 (13)
|r3-r2|≈d2cosβ2 (14)
将上述关系代入时差方程式(5)和(6),并将式中的移动时间间隔用移动距离与移动速度的比值Δti=di/v置换,得:
式中:v是目标的移动速度。
由上述的两式之比即可得到在目标相邻移动距离之比与观测站相邻时差之比之间的一个近似关系式:
事实上,在匀速移动的情况下,因:di=vΔti,故有:
即近似有:
由于观测时间差ΔTi是可通过测量获得,故移动距离之比可被近似确定。
3、目标的前置角和航向角
3.1计算公式
一旦将移动距离与观测时差间的比值关系式(17)代入相邻移动距离的比值关系式(9),则即可解出目标的前置角:
式中:
由内外角关系:α=θi+βi,可解出航向角:
3.2相对计算误差
附图2给出了当前置角在第一象限内变化时,对于不同的起始测量方位角,航向角的理论值α与计算值αa间的相对误差比对曲线,其相对误差计算式为:
图中标注的参数θ1是观测站的起始测向角,由相对计算误差曲线可知,在目标移动距离增大时,当前置角趋于九十度时将出现发散现象。
3.3公式的象限适用范围
模拟计算表明航向角计算式(21)仅适用于在0<β1<180°范围内使用,但事实上,当β1>180°时,可认为目标是沿着附图1所示轨迹的反方向运动的,因此,仅需对算术符号做相应的改变,即可使所导出的公式适用于整个平面范围。
在前置角90<β1<180°时的计算公式是.
此时,航向角的计算式为:
模拟计算还表明,改变相邻移动距离的比值对计算误差所造成的影响很小,这事实上也说明,在小角度时,由正弦函数与正切函数之间的近似相等所产生的误差是极其微小的。
4、一次迭代解
4.1移动距离比值的直接解算
数学计算表明,如利用各个运动参量的纯理论值,则从自时差方程组即可得到极其准确的结果,但由相邻观测时差ΔTi之比近似估算所给出的相邻移动距离di的比值ξd事实上是在忽略程差的近似简化条件下获得的,且模拟演算表明,尽管在此种近似下所获得的航向角是足够准确的,但如将按近似估算获得的移动距离比值代入自时差方程去求解其它未知运动参量,则因微小的数值变化即可使方程的计算准确性变劣的病态特性,而出现得不到准确解的现象,
为此,利用迭代算法,基于三角函数关系,利用近似估算所求得的前置角计算在移动距离和径向距离之间的比值,以及在径向距离之间的比值,从而直接求解得到准确性更好的相邻移动距离的比直。
首先,利用式(10)和(11)解出仅和近似估算值β2相关的移动距离与径向距离的比值计算式:
然后,由余弦定理可得到仅和测算值β2相关的径向距离间的比值:
又由目标的移动轨迹和径向距离所围成的几何三角形可分别得到:
由此直接得到一个基于方位角和近似估算前置角的目标移动距离的比值:
此时:
4.2前置角的迭代解
将移动距离与观测时差间的比值关系式(31)再次代入相邻移动距离的比值关系式(9),即可解出准确性更好的目标前置角:
式中:
5.目标的运动参数
5.1相邻径向距离之间的比值
由附图1所示的几何关系可得到目标的航路勾径:
Dr=ricos(90°+θi-α)=risin(α-θi) (33)
=ri+1sin(α-θi+1)
由此可得到径向距离之间的比值
和可由迭代测算值计算得到的,且有:
5.2速度的解析计算
在自时差方程中,先将目标的移动时差用移动距离与速度的比值取代,则由两个自时差方程之比得:
再将径向距离r2提取出来,经整理后有:
将距离的关系式代入,即可解出目标的移动速度:
上式中移动距离和径向距离的比值采用式(25)和(26),而相邻径向距离的比值采用(34),且前置角用迭代解(32)计算。
附图3给出了不等移动距离时,目标移动速度的相对计算误差。
5.3目标的移动时间差
利用径向距离间的比值关系,由自时差方程可得到如下的二元一次方程:
在消去径向距离r2之后,可解得目标的移动时间,其相对计算误差如附图4所示。
5.4目标的距离
事实上,在解得目标的速度和移动时间差之后,直接利用正弦定理即可近似估算目标的径向距离,即有:
如由自时差方程,则从式(37)可解得径向距离为:
附图5给出了径向距离r2的相对计算误差。
Claims (5)
1.一种固定单站无源定位方法,其特征在于通过连续检测移动目标的方向、以及两次测向之间的观测时差,即可完整和正确的获得移动目标的运动参数。
2.根据权利要求1所述的无源定位方法,其特征是,在假定目标近似为匀速直线运动的条件下,测向单元至少连续三次检测移动目标的信号方向θi,并在测量及记录目标方位的同时,利用时间记录设备检测和记录时间的绝对值Ti,由此获得方位的相邻角度差Δθi=θi+1-θi和两次相邻测向之间的观测时差ΔTi=Ti+1-Ti。
3.基于权利要求2所述的测量结果,其特征是:
(1)先利用几何关系和自时差方程证明目标端相邻移动距离di之比近似等于观测处相邻观测时差ΔTi之比:
(2)随后利用目标处的相邻移动距离之比和前置角、观测方位角之间的函数关系解出目标端的前置角:
式中: Δθi=θi+1-θi。
(3)进一步由观测方位角差Δθi,可获得目标在其余位置处的前置角:
β1=β2-Δθ1 (3A)
β3=β2+Δθ2 (3B)
(4)再由内外角关系:α=θi+βi,解出目标的航向角α,在目标前置角0<β1<180°时,航向角的计算式为:
在目标前置角90<β1<180°时,航向角为:
4.如权利要求1所述的无源定位方法,其特征在于:
(1)利用近似估计得到的前置角,按下式直接求解目标移动距离的比值:
上式中在相邻径向距离之间的比值和在移动距离与径向距离之间的比值是:
(2)在直接求得目标相邻移动距离比值的基础上,再次利用前置角、观测方位角之间的函数关系即可解出准确性更好的目标前置角:
式中:
5.基于权利要求4利用迭代计算所得到的前置角,其特征是,先重新计算在相邻径向距离之间的比值和在移动距离与径向距离之间的比值,随后按下列各式解算目标的运动参数:
(1)目标的移动速度
式中:vc为声速。
(2)目标的移动时差
(3)目标与观测站之间的径向距离
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310369622.7A CN104422921A (zh) | 2013-08-22 | 2013-08-22 | 一种基于方位和自时差测量的固定单站无源定位*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310369622.7A CN104422921A (zh) | 2013-08-22 | 2013-08-22 | 一种基于方位和自时差测量的固定单站无源定位*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104422921A true CN104422921A (zh) | 2015-03-18 |
Family
ID=52972480
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310369622.7A Pending CN104422921A (zh) | 2013-08-22 | 2013-08-22 | 一种基于方位和自时差测量的固定单站无源定位*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104422921A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105223568A (zh) * | 2015-10-17 | 2016-01-06 | 徐功慧 | 一种检定目标稳速稳向的纯方位算法 |
CN105388470A (zh) * | 2015-10-27 | 2016-03-09 | 中国科学院声学研究所 | 一种估计目标运动参数的方法 |
CN105424044A (zh) * | 2015-11-05 | 2016-03-23 | 中国船舶重工集团公司第七二四研究所 | 一种双站交会无源定位站基组合择优方法 |
CN107015199A (zh) * | 2017-05-09 | 2017-08-04 | 南京航空航天大学 | 一种考虑无人机姿态角的双无人机测向时差定位方法 |
CN112763979A (zh) * | 2020-12-27 | 2021-05-07 | 西北工业大学 | 基于双移动声信标测距辅助的水下航行器协同定位方法 |
CN113484855A (zh) * | 2021-07-21 | 2021-10-08 | 电子科技大学 | 一种外辐射源的单站定位方法 |
-
2013
- 2013-08-22 CN CN201310369622.7A patent/CN104422921A/zh active Pending
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105223568A (zh) * | 2015-10-17 | 2016-01-06 | 徐功慧 | 一种检定目标稳速稳向的纯方位算法 |
CN105388470A (zh) * | 2015-10-27 | 2016-03-09 | 中国科学院声学研究所 | 一种估计目标运动参数的方法 |
CN105424044A (zh) * | 2015-11-05 | 2016-03-23 | 中国船舶重工集团公司第七二四研究所 | 一种双站交会无源定位站基组合择优方法 |
CN105424044B (zh) * | 2015-11-05 | 2018-06-26 | 中国船舶重工集团公司第七二四研究所 | 一种双站交会无源定位站基组合择优方法 |
CN107015199A (zh) * | 2017-05-09 | 2017-08-04 | 南京航空航天大学 | 一种考虑无人机姿态角的双无人机测向时差定位方法 |
CN112763979A (zh) * | 2020-12-27 | 2021-05-07 | 西北工业大学 | 基于双移动声信标测距辅助的水下航行器协同定位方法 |
CN113484855A (zh) * | 2021-07-21 | 2021-10-08 | 电子科技大学 | 一种外辐射源的单站定位方法 |
CN113484855B (zh) * | 2021-07-21 | 2023-02-28 | 电子科技大学 | 一种外辐射源的单站定位方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108362281B (zh) | 一种长基线水下潜艇匹配导航方法及*** | |
CN104422921A (zh) | 一种基于方位和自时差测量的固定单站无源定位*** | |
CN104457754B (zh) | 一种基于sins/lbl紧组合的auv水下导航定位方法 | |
CN110006433A (zh) | 海底油气管检测机器人的组合导航定位***及方法 | |
CN102128625B (zh) | 重力辅助惯性导航***中重力图匹配的初始匹配方法 | |
CN102262226B (zh) | 基于差分技术的水下定位方法 | |
Chen et al. | Improving GNSS-acoustic positioning by optimizing the ship’s track lines and observation combinations | |
CN103278163A (zh) | 一种基于非线性模型的sins/dvl组合导航方法 | |
CN105388457A (zh) | 一种基于等效声速梯度的长基线水声定位方法 | |
CN102997922A (zh) | 一种利用光学导航信息的脉冲到达时间差确定方法 | |
CN109738902B (zh) | 一种基于同步信标模式的水下高速目标高精度自主声学导航方法 | |
CN110260044B (zh) | 一种海底管道定位方法 | |
CN102279002A (zh) | 星敏感器测量坐标系与载体坐标系转换矩阵的标定方法 | |
CN103968838A (zh) | 一种基于极坐标系的auv曲线运动状态下的协同定位方法 | |
CN105571636A (zh) | 一种用于定位目标的方法及测量设备 | |
CN104049269A (zh) | 一种基于激光测距和mems/gps组合导航***的目标导航测绘方法 | |
CN105353351A (zh) | 一种基于多信标到达时间差改进型定位方法 | |
CN110132281A (zh) | 一种基于询问应答模式的水下高速目标高精度自主声学导航方法 | |
CN103529451B (zh) | 一种水面母船校准海底应答器坐标位置的方法 | |
CN109855649A (zh) | 一种水下滑翔机平台运动轨迹被动确定方法 | |
CN109764870A (zh) | 基于变换估计量建模方案的载体初始航向估算方法 | |
CN113156413A (zh) | 一种基于双程声路径的海底基准校准方法 | |
CN111220146B (zh) | 一种基于高斯过程回归学习的水下地形匹配定位方法 | |
CN110865338B (zh) | 一种基于水下机动平台的未知周期声信标高精度定位方法 | |
Liu et al. | Underwater acoustic positioning with a single beacon and a varied baseline for a multi‐jointed AUV in the deep ocean |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20150318 |
|
WD01 | Invention patent application deemed withdrawn after publication |