CN113406645B - 一种平均声速水下声呐定位方法 - Google Patents
一种平均声速水下声呐定位方法 Download PDFInfo
- Publication number
- CN113406645B CN113406645B CN202110503040.8A CN202110503040A CN113406645B CN 113406645 B CN113406645 B CN 113406645B CN 202110503040 A CN202110503040 A CN 202110503040A CN 113406645 B CN113406645 B CN 113406645B
- Authority
- CN
- China
- Prior art keywords
- sound velocity
- positioning
- sound
- average
- underwater
- 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
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/06—Systems determining the position data of a target
- G01S15/42—Simultaneous measurement of distance and other co-ordinates
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01H—MEASUREMENT OF MECHANICAL VIBRATIONS OR ULTRASONIC, SONIC OR INFRASONIC WAVES
- G01H5/00—Measuring propagation velocity of ultrasonic, sonic or infrasonic waves, e.g. of pressure waves
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Computer Networks & Wireless Communication (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种平均声速水下声呐定位方法,属于水声定位技术领域,解决了采用单一声速从而导致的定位精度低的问题,包括在已知海面船的三维位置和水下未知点概略坐标的基础上,通过坐标反算得到声线入射角θi;采用声线跟踪算法计算该入射角θi下水下未知点的精确坐标(X,Y,Z);改变平均声速值V,采用平均声速最小二乘法进行定位,直到最佳平均声速使得定位结果(X′,Y′,Z′)与声线跟踪定位结果(X,Y,Z)满足误差要求;变换入射角θi,重复上述步骤,得到入射角与平均声速之间的函数关系,建立基于声线入射角的平均声速定位模型;在平均声速定位模型下进行定位,得到水下未知点的精确位置(X,Y,Z),完成对水下目标的快速精确定位。
Description
技术领域
本发明属于水声定位技术领域,具体涉及一种平均声速水下声呐定位方法。
背景技术
平均声速定位模式是将区域的单一声速平均值直接用于测距定位,模型最为简单、高效,但忽略了声速误差的影响。声线跟踪算法采用层追加的方法计算声线传播路径,在精确测量声速的基础上,降低声线弯曲误差的影响,获得高精度水下目标点的三维坐标。虽然声线跟踪算法较平均声速定位算法精度有所提高,但也存在定位模型复杂、计算效率低等问题。声线入射角相关误差是影响定位了一项重要误差源,包含测距***噪声误差以及声速误差、控制点误差等。当观测图形不佳时,声线入射角变化范围较大,平均声速模型误差影响显著,导致定位结果的不准确。建立声线入射角与平均声速的关系,从而建立平均声速定位模型,可有效代替单一平均声速引起的声速误差问题。
发明内容
本发明针对现有技术中定位模型复杂、计算效率低等问题,提出了一种平均声速水下声呐定位方法,通过建立声线入射角和平均声速的关系,建立平均声速定位模型。
本发明具体采用如下技术方案:
一种平均声速水下声呐定位方法,包括:
S1.获取海面测船的三维空间位置和水下未知目标应答器的概略坐标;
通过所述概略坐标反算声线入射角;
S2.通过声速剖面仪测得水下未知点所在海域的声速剖面;
使用声线跟踪定位算法计算所述声线入射角下的水下未知点的精确坐标;
S3.采用平均声速最小二乘定位算法进行定位,寻找最佳平均声速;
所述最佳平均声速,满足平均声速最小二乘定位结果与声线跟踪定位结果的误差要求;
S4.变化所述声线入射角,重复步骤S1至S3,得到声线入射角与平均声速之间的函数关系,建立基于声线入射角的平均声速定位模型;
S5.在平均声速定位模型下进行定位,得到水下未知点的精确位置,完成对水下目标的快速精确定位。
优选地,所述步骤S1包括如下子步骤:
S1.1.通过POS定位定向***获取海面测船的精确三维位置信息(Xb,Yb,Zb);
S1.2.通过坐标转换,获得测船底部换能器的三维位置(Xi,Yi,Zi);
S1.3.在已知水下未知目标应答器概略坐标(X0,Y0,Z0)的基础上,通过坐标反算获得此刻的声线入射角θi,公式如下:
优选地,所述步骤S2包括如下子步骤:
S2.1.通过声速剖面仪获取水下未知点的水域温度、盐度、压力水文数据,反演水下未知点所在海域的声速剖面,所述声速剖面指声速关于水深的关系;
S2.2.在获得声速剖面的基础上,将该海域分为N层,采用等梯度声线跟踪算法计算第i层的声信号传播的时间ti,公式如下:
S2.4.获取已知实际测量声信号传播时间T,通过最小二乘法得到坐标改正值dx,公式如下:
dx=(ATPA)-1ATPb,
其中,A表示雅可比矩阵,P表示观测权阵,b表示测距残差;
S2.5.迭代步骤S2.4,通过dx坐标改正,得到声线入射角θi下,水下目标未知点的精确位置(X,Y,Z)。
优选地,所述步骤S3包括如下子步骤:
优选地,所述步骤S4包括如下子步骤:
S4.2.通过改变海面测船的位置,改变声线入射角θi;
S4.3.重复S1、S2和S3步骤,建立声线入射角与平均声速之间的函数关系,公式如下:
其中,a、b、c表示待定参数;
S4.4.根据平均声速定位原理,在声线入射角与平均声速之间的函数关系基础上,建立平均声速定位模型,公式如下:
优选地,步骤S5包括如下子步骤:
S5.1.根据S4提出的平均声速定位模型,进行线性化,公式如下:
其中,ei表示方向余弦,ri表示线性化残余项,ε表示其它误差,ei=(x0-xi)/di(x0);
S5.2.进行最小二乘定位解算,公式如下:
dx=(ATPA)-1ATPb;
S5.3.得到水下未知点的精确位置(X,Y,Z)″,公式如下:
(X,Y,Z)″=(X0,Y0,Z0)+dx;
由以上步骤可完成对水下目标的快速精确定位。
与现有技术相比,本发明具有如下有益效果:
使用平均声速水下声呐定位算法代替传统的平均声速定位算法,传统平均声速定位算法默认声速是某一固定值,认为声线是延直线传播的,而实际上受海水中温度、盐度和压力等因素的影响,声线的传播发生了弯曲。受声线弯曲误差的影响,导致测距误差增大,水深越深,影响越大,难以实现高精度的定位。
采用平均声速定位模型,充分考虑了声速剖面的影响,具有和声线跟踪算法相当的定位精度,当声线入射角的变化范围较大时,定位精度提升越明显;此外,当对海上某一区域进行重复多次测量的时,可有效提高定位效率,相比声线跟踪算法,可大幅度降低计算成本。
附图说明
图1为采用平均声速水声定位模型进行定位的技术流程图。
具体实施方式
下面结合具体实施例对本发明作进一步说明:
一种平均声速水下声呐定位方法,技术流程图如图1所示,包括以下步骤:
S1.在获取海面测船三维空间位置和水下未知目标应答器的概略坐标的基础上,通过坐标反算声线入射角;
S2.通过声速剖面仪CTD测得水下未知点所在海域的声速剖面后,通过声线跟踪算法计算该入射角下水下未知点的精确坐标;
S3.采用平均声速最小二乘法进行定位,找到一个最佳的平均声速使得平均声速最小二乘定位结果与声线跟踪定位结果满足误差要求;
S4.变化声线入射角,重复上述步骤,得到入射角与平均声速之间的函数关系,建立基于声线入射角的平均声速定位模型;
S5.在平均声速定位模型下进行定位,得到水下未知点的精确位置,完成对水下目标的快速精确定位。
步骤S1包括如下子步骤:
S1.1.POS定位定向***安装在测船载体上,GNSS接收机和IMU分别接收GNSS观测数据、IMU观测数据以及精密改正信息,根据接收的GNSS观测数据、GNSS精密改正信息和IMU观测数据,进行高精度GNSS/INS组合导航定位,得到测船高精度精确的三维位置信息(Xb,Yb,Zb);
S1.2.在获得测船的高精度三维位置信息后,通过坐标转换,可获得安装在测船底部的换能器的三维位置(Xi,Yi,Zi);
S1.3.水下应答器的平面位置概略坐标可以通过布防时测得,深度可以通过压力计测得,在已知水下未知目标应答器概略坐标(X0,Y0,Z0)的基础上,可以通过坐标反算,获得此刻声线传播的入射角θi,公式如下:
步骤S2包括如下子步骤:
S2.1.在定位前,测船可以将搭载的声速剖面仪CTD放置水下,通过声速剖面仪CTD可以获取水下目标点水域温度、盐度、压力水文数据,可以反演出目标点所在区域的声速剖面,声速剖面是指声速关于水深的关系,它可以反应指定区域,一段时间内声速随水深的变化情况;
S2.2.在获得声速剖面的基础上,可以将目标点所在水域分为N层,采用等梯度声线跟踪算法计算第i层的声信号传播的时间ti,等梯度声线跟踪算法是目前进行水下定位较为准确的一种算法,它修正了由于声速变化引起的声线弯曲误差的影响,公式如下:
S2.4.换能器能够测量声信号从发射到反馈接收的传播时间,在已知实际测量声信号传播时间T的前提下,可以计算测距差,公式如下:
然后,通过最小二乘法得到坐标改正值dx,公式如下:
dx=(ATPA)-1ATPb,
其中,A表示雅可比矩阵,P表示观测权阵,b表示测距残差;
S2.5.通过迭代步骤S2.4,通过dx坐标改正,可得在该声线入射角θi下,可得水下目标未知点的精确位置(X,Y,Z)。
步骤S3包括如下子步骤:
步骤S4包括如下子步骤:
S4.2.通过改变海面测船的位置,可改变声线的传播入射角θi;
S4.3.重复S1、S2和S3步骤,可建立入射角与平均声速之间的函数关系,公式如下:
其中,a、b、c表示待定参数,该模式是根据入射角与平均声速之间的函数关系,通过MATLAB拟合得到;
S4.4.根据平均声速定位原理,在入射角与平均声速之间的函数关系基础上,建立平均声速定位模型,公式如下:
步骤S5包括如下子步骤:
S5.1.根据S4提出的平均声速定位模型,可以进行线性化,公式如下:
其中,ei表示方向余弦,ri表示线性化残余项,一般可忽略,ε表示其它误差,
ei=(x0-xi)/di(x0);
S5.2.进行最小二乘定位解算,得到坐标改正值,公式如下:
dx=(ATPA)-1ATPb,
S5.3.通过坐标改正值的改正以及迭代计算,可以得到水下未知点的精确位置(X,Y,Z)″,公式如下:
(X,Y,Z)″=(X0,Y0,Z0)+dx,
由以上步骤可完成对水下目标的快速精确定位。
Claims (5)
1.一种平均声速水下声呐定位方法,其特征在于,包括:
S1.获取海面测船的三维空间位置和水下未知目标应答器的概略坐标;
通过所述概略坐标反算声线入射角;
S2.通过声速剖面仪测得水下未知点所在海域的声速剖面;
使用声线跟踪定位算法计算所述声线入射角下的水下未知点的精确坐标;
S3.采用平均声速最小二乘定位算法进行定位,寻找最佳平均声速;
所述最佳平均声速,满足平均声速最小二乘定位结果与声线跟踪定位结果的误差要求;
S4.变化所述声线入射角,重复步骤S1至S3,得到声线入射角与平均声速之间的函数关系,建立基于声线入射角的平均声速定位模型;
S4.2.通过改变海面测船的位置,改变声线入射角θi;
S4.3.重复S1、S2和S3步骤,建立声线入射角与平均声速之间的函数关系,公式如下:
其中,a、b、c表示待定参数;
S4.4.根据平均声速定位原理,在声线入射角与平均声速之间的函数关系基础上,建立平均声速定位模型,公式如下:
S5.在平均声速定位模型下进行定位,得到水下未知点的精确位置,完成对水下目标的快速精确定位。
3.根据权利要求1所述的一种平均声速水下声呐定位方法,其特征在于,所述步骤S2包括如下子步骤:
S2.1.通过声速剖面仪获取水下未知点的水域温度、盐度、压力水文数据,反演水下未知点所在海域的声速剖面,所述声速剖面指声速关于水深的关系;
S2.2.在获得声速剖面的基础上,将该海域分为N层,采用等梯度声线跟踪算法计算第i层的声信号传播的时间ti,公式如下:
S2.4.获取已知实际测量声信号传播时间T,通过最小二乘法得到坐标改正值dx,公式如下:
dx=(ATPA)-1ATPb,
其中,A表示雅可比矩阵,P表示观测权阵,b表示测距残差;
S2.5.迭代步骤S2.4,通过dx坐标改正,得到声线入射角θi下,水下目标未知点的精确位置(X,Y,Z)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110503040.8A CN113406645B (zh) | 2021-05-10 | 2021-05-10 | 一种平均声速水下声呐定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110503040.8A CN113406645B (zh) | 2021-05-10 | 2021-05-10 | 一种平均声速水下声呐定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113406645A CN113406645A (zh) | 2021-09-17 |
CN113406645B true CN113406645B (zh) | 2022-08-05 |
Family
ID=77678369
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110503040.8A Active CN113406645B (zh) | 2021-05-10 | 2021-05-10 | 一种平均声速水下声呐定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113406645B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116774197B (zh) * | 2023-08-24 | 2023-11-03 | 交通运输部天津水运工程科学研究所 | 基于声呐扫测深度变化的固定目标物的声速剖面求取方法 |
CN117252035B (zh) * | 2023-11-14 | 2024-02-13 | 天津大学 | 水面航行器入射角的确定方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0566273A (ja) * | 1991-09-09 | 1993-03-19 | Nec Corp | リアルタイム収束帯位置推定装置 |
JP2006292435A (ja) * | 2005-04-06 | 2006-10-26 | Nec Corp | マルチスタティック計測方法及び方式 |
CN106886024A (zh) * | 2017-03-31 | 2017-06-23 | 上海海洋大学 | 深海多波束声线精确跟踪方法 |
CN106950568A (zh) * | 2017-02-23 | 2017-07-14 | 山东科技大学 | 一种自适应多节点等效声速剖面的构建方法 |
WO2020228547A1 (zh) * | 2019-05-16 | 2020-11-19 | 浙江大学 | 基于倒置式多波束回声仪的声速剖面反演方法 |
WO2020252945A1 (zh) * | 2019-06-17 | 2020-12-24 | 东南大学 | 基于泰勒展开的初始掠射角求解方法、声线弯曲修正方法和设备 |
CN112540348A (zh) * | 2020-11-23 | 2021-03-23 | 山东科技大学 | 一种基于空间尺度上的声线修正算法在长基线水声定位***上的应用 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7606113B2 (en) * | 2007-05-10 | 2009-10-20 | Lockheed Martin Corporation | Modeling sound propagation for underwater test areas |
CN105487046A (zh) * | 2015-11-19 | 2016-04-13 | 中国石油大学(华东) | 大入射角声线跟踪定位方法 |
CN105388457B (zh) * | 2015-12-03 | 2017-10-27 | 山东科技大学 | 一种基于等效声速梯度的长基线水声定位方法 |
EP3390987A4 (en) * | 2017-03-02 | 2019-10-09 | AML Oceanographic Ltd. | SOUND SPEED SENSOR FOR USE IN WATER AND METHOD FOR DETERMINING SPEED OF SOUNDS IN WATER |
CN107132520B (zh) * | 2017-05-03 | 2020-08-14 | 江苏中海达海洋信息技术有限公司 | 一种基于水声超短基线定位***的声线修正方法及*** |
DE102018201605A1 (de) * | 2018-02-02 | 2019-08-08 | Continental Teves Ag & Co. Ohg | Verfahren und Vorrichtung zum Lokalisieren und Verfolgen akustischer aktiver Quellen |
CN111812694B (zh) * | 2020-06-28 | 2021-05-18 | 中国科学院地质与地球物理研究所 | 一种长基线船载定位装置及其定位方法 |
CN111896962B (zh) * | 2020-07-25 | 2022-10-04 | 中国石油大学(华东) | 一种海底应答器定位方法、***、存储介质及应用 |
-
2021
- 2021-05-10 CN CN202110503040.8A patent/CN113406645B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0566273A (ja) * | 1991-09-09 | 1993-03-19 | Nec Corp | リアルタイム収束帯位置推定装置 |
JP2006292435A (ja) * | 2005-04-06 | 2006-10-26 | Nec Corp | マルチスタティック計測方法及び方式 |
CN106950568A (zh) * | 2017-02-23 | 2017-07-14 | 山东科技大学 | 一种自适应多节点等效声速剖面的构建方法 |
CN106886024A (zh) * | 2017-03-31 | 2017-06-23 | 上海海洋大学 | 深海多波束声线精确跟踪方法 |
WO2020228547A1 (zh) * | 2019-05-16 | 2020-11-19 | 浙江大学 | 基于倒置式多波束回声仪的声速剖面反演方法 |
WO2020252945A1 (zh) * | 2019-06-17 | 2020-12-24 | 东南大学 | 基于泰勒展开的初始掠射角求解方法、声线弯曲修正方法和设备 |
CN112540348A (zh) * | 2020-11-23 | 2021-03-23 | 山东科技大学 | 一种基于空间尺度上的声线修正算法在长基线水声定位***上的应用 |
Non-Patent Citations (7)
Title |
---|
A Combined Ray Tracing Method for Improving the Precision of the USBL Positioning System in Smart Ocean;Jian Li et al.;《Sensors》;20181022;全文 * |
Reducing elevation angle errors of long-range deep-sea acoustic localization by ray tracing and depth measurements;D.Oertel et al.;《2016 IEEE International Conference on Advanced Intelligent Mechatronics》;20160715;全文 * |
Research on Acoustic Velocity Correction Algorithm in Underwater Acoustic Positioning;Bingsheng Zhang et al.;《China Satellite Navigation Conference》;20181231;全文 * |
声速剖面未知条件下的平均声速计算方法;赵翀 等;《舰船电子工程》;20181120;第38卷(第11期);第159-163页 * |
水下声纳定位浮标阵列解析优化;齐珂 等;《武汉大学学报信息科学报》;20190930;第44卷(第9期);全文 * |
顾及声线入射角的水下定位随机模型;赵爽等;《测绘学报》;20180915;第47卷(第09期);全文 * |
顾及波束入射角的常梯度声线跟踪水下定位算法;辛明真 等;《测绘学报》;20201231;第49卷(第12期);第1535-1541页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113406645A (zh) | 2021-09-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107132520B (zh) | 一种基于水声超短基线定位***的声线修正方法及*** | |
CN102262226B (zh) | 基于差分技术的水下定位方法 | |
CN113406645B (zh) | 一种平均声速水下声呐定位方法 | |
CN102749622B (zh) | 基于多波束测深的声速剖面及海底地形的联合反演方法 | |
CN108614258B (zh) | 一种基于单水声信标距离量测的水下定位方法 | |
CN110081864B (zh) | 一种顾及水深值的水深测量综合延迟改正方法 | |
CN111896962B (zh) | 一种海底应答器定位方法、***、存储介质及应用 | |
CN110132281B (zh) | 一种基于询问应答模式的水下高速目标高精度自主声学导航方法 | |
CN109696234B (zh) | 一种发射点与接收点之间水平距离的确定方法及*** | |
CN107390177B (zh) | 一种基于纯测向的被动水下声学定位方法 | |
CN110319811B (zh) | 一种自适应波浪效应的水下单波束高精度探测***及方法 | |
CN110297250B (zh) | 基于泰勒展开的初始掠射角求解方法、声线弯曲修正方法和设备 | |
CN112540348A (zh) | 一种基于空间尺度上的声线修正算法在长基线水声定位***上的应用 | |
CN109738902B (zh) | 一种基于同步信标模式的水下高速目标高精度自主声学导航方法 | |
CN114397643B (zh) | 一种基于超短基线水声定位***的声线修正方法 | |
CN113156413B (zh) | 一种基于双程声路径的海底基准校准方法 | |
CN105004413A (zh) | 用于水下目标定位的声传播路径综合速度测定方法与装置 | |
Xin et al. | A TOA/AOA underwater acoustic positioning system based on the equivalent sound speed | |
JP4922450B2 (ja) | 音波を放出するターゲットの方位測定方法 | |
CN111220146B (zh) | 一种基于高斯过程回归学习的水下地形匹配定位方法 | |
CN112147578B (zh) | 一种高精度深水发射阵及多元垂直接收阵阵元定位***与方法 | |
CN111708009B (zh) | 一种水下声学异步测距方法 | |
CN117146830A (zh) | 一种自适应多信标航位推算和长基线的紧组合导航方法 | |
CN113821766B (zh) | 一种海洋声学导航***误差改正方法 | |
CN206321338U (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 |