CN114608567A - 一种小俯仰角条件下的usbl定位方法 - Google Patents
一种小俯仰角条件下的usbl定位方法 Download PDFInfo
- Publication number
- CN114608567A CN114608567A CN202210077848.9A CN202210077848A CN114608567A CN 114608567 A CN114608567 A CN 114608567A CN 202210077848 A CN202210077848 A CN 202210077848A CN 114608567 A CN114608567 A CN 114608567A
- Authority
- CN
- China
- Prior art keywords
- value
- depth
- transponder
- coordinate system
- sound head
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 15
- 230000004044 response Effects 0.000 claims abstract description 45
- 238000005259 measurement Methods 0.000 claims abstract description 30
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 8
- 238000012937 correction Methods 0.000 claims description 18
- 239000013598 vector Substances 0.000 claims description 13
- 238000004364 calculation method Methods 0.000 claims description 11
- 238000004088 simulation Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000005540 biological transmission Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 claims description 3
- 230000009191 jumping Effects 0.000 claims description 3
- 238000009304 pastoral farming Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
- G01S5/22—Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements
-
- 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
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Abstract
本发明公开了一种小俯仰角条件下的USBL定位方法。该方法包括在应答信号俯仰角小于设定阈值时,利用测量得到的声头坐标系下的应答信号方位角与组合惯导测量得到的声头姿态角,计算出地理坐标系下的应答信号方位角的正弦值和余弦值;计算声头与应答器的水平距离;根据地理坐标系下的应答信号方位角的正弦值和余弦值、声头应答器水平距离、声头的深度值、应答器的水深值以及GNSS定位模块测得的声头地理坐标计算应答器的地理坐标。本发明综合利用USBL系统直接测量到的应答信号方位角、传播时长和应答器深度值进行应答器地理坐标计算,解决了水平布置换能器阵列应答信号俯仰角测量误差较大问题,提高了定位精度。
Description
技术领域
本发明涉及水声USBL定位技术领域,具体涉及一种小俯仰角条件下的USBL定位方法。
背景技术
超短基线(Ultra Short Base Line,USBL)水声定位系统,是通过测量定位目标发射的水声信号的角度、延时计算目标位置坐标的水下定位系统。相对于长基线、短基线水声定位系统,具有设备体积小、安装部署容易等优势,在水下作业和深海开发等领域具有广泛的应用。
USBL水声定位系统包含声头、应答器以及测量声头自身位置与姿态的辅助设备GNSS定位模块与组合惯导。应答器安装于定位目标上,并适时发射包含其ID及深度测量值的水声编码信号;声头可测量得出应答信号方位角、俯仰角以及传播时长,解码出应答器的实时深度;通过这些测量值及辅助设备测量到的声头地理坐标与实时姿态,计算出应答器的实时地理坐标。
对于水平布置换能器阵列的声头,在应答信号俯仰角较小时,俯仰角测量误差较大,导致该情况下计算的应答器地理坐标不够准确;即使利用解码的应答器深度值参与计算应答器地理坐标,又因应答信号的仰俯角为声头xoy平面的测量结果而非水平面,不能建立球面坐标与直角坐标相互转换的等效方程;尤其在声线弯曲条件下,准确计算应答器地理坐标的难度更大。
发明内容
本发明的目的是针对现有技术存在的不足,提供一种小俯仰角条件下的USBL定位方法。
为实现上述目的,本发明提供了一种小俯仰角条件下的USBL定位方法,包括:
步骤1、在应答信号俯仰角小于设定阈值时,利用测量得到的声头坐标系下的应答信号方位角与组合惯导测量得到的声头姿态角,计算出地理坐标系下的应答信号方位角的正弦值和余弦值;
步骤2、计算声头与应答器的水平距离;
步骤3、根据地理坐标系下的应答信号方位角的正弦值和余弦值、声头应答器水平距离、声头的深度值、应答器的水深值以及GNSS定位模块测得的声头地理坐标计算应答器的地理坐标。
进一步的,所述步骤1具体包括:
其中,θu为直接测量得到的声头坐标系下应答信号的方位角,[]T为转置矩阵;
其中,θ为地理坐标系下应答信号的方位角。
进一步的,所述步骤2包括不进行声线修正计算声头应答器水平距离,具体如下:
步骤211、基于应答信号传播时长tΔ与信号在水中的速度C计算声头应答器的距离r,
r=c·tΔ
步骤212、基于声头的深度值与应答器的深度值计算二者的深度差hΔ,
hΔ=hr-ha
其中,hr为应答器的深度值,ha为声头的深度值;
步骤213、计算声头与应答器的水平距离为,
其中,rh为声头与应答器的水平距离。
进一步的,所述步骤2包括进行声线修正计算声头应答器水平距离,具体如下:
步骤223、比较应答器深度值hr与仿真信号到达深度ht差的绝对值,并将所述绝对值与设定的精度阈值hthresh进行对比,若所述绝对值小于设定精度阈值hthresh,则判定当前的试探性俯仰角等于地理坐标系下应答信号的俯仰角声头与应答器的水平距离rh等于当前推算出的仿真信号传播的水平距离rht,计算结束;
步骤224、若所述绝对值不小于深度精度阈值hthresh,则记录应答器深度值hr与仿真信号到达深度ht的大小关系;
步骤225、判定此次仿真信号探测是否为首次,是则跳转至步骤228,否则进行步骤226;
步骤226、判定应答器深度测量值hr与仿真信号到达深度ht的大小关系是否与上次相反,若相同,则跳转至步骤228;若相反,则进行步骤227;
步骤227、将试探性俯仰角变化步长减小;步骤228、比较本次应答器深度测量值hr与仿真信号到达深度ht的大小关系,若ht<hr,则将初始试探性俯仰角增加一个步长若ht>hr,则将初始试探性俯仰角减小一个步长并跳转至步骤222重复上述步骤。
进一步的,所述步骤3中计算出的应答器的地理坐标为:
xr=x0+rh·cosθ
yr=y0+rh·sinθ
Zr=Z0+ha-hr
其中,x0,y0,z0为GNSS定位模块测得的声头地理坐标。
有益效果:本发明综合利用USBL系统直接测量到的应答信号方位角、传播时长和应答器深度值进行应答器地理坐标计算,解决了水平布置换能器阵列应答信号俯仰角测量误差较大问题;通过应答信号方位角单位矢量的构造与坐标转换计算地理坐标系信号的方位角,相对于假定声头水平,提高了定位精度;通过声线修正技术,进一步提高了定位精度。
附图说明
图1是本发明实施例的小俯仰角条件下的USBL定位方法的流程图;
图2是计算出地理坐标系下的应答信号方位角正弦值和余弦值的流程图;
图3是不进行声线修正计算声头应答器水平距离的流程图;
图4是不进行声线修正计算声头应答器水平距离的原理图;
图5是进行声线修正计算声头应答器水平距离的流程图;
图6是进行声线修正计算声头应答器水平距离的原理图。
具体实施方式
下面结合附图和具体实施例,进一步阐明本发明,本实施例在以本发明技术方案为前提下进行实施,应理解这些实施例仅用于说明本发明而不用于限制本发明的范围。
如图1所示,本发明实施例提供了一种小俯仰角条件下的USBL定位方法,包括:
步骤1、在应答信号俯仰角小于设定阈值时,利用测量得到的声头坐标系下的应答信号方位角与组合惯导测量得到的声头姿态角,计算出地理坐标系下的应答信号方位角的正弦值和余弦值。上述设定阈值的大小可根据需要进行确定,如可设置为15°。
参见图2,步骤1具体包括:
其中,θu为直接测量得到的声头坐标系下应答信号的方位角,[]T为转置矩阵。
其中,θ为地理坐标系下应答信号的方位角。
步骤2、计算声头与应答器的水平距离。需要说明的是,计算声头应答器水平距离时,有两种计算方式,一种是不进行声线修正计算,另一种是进行声线修正计算,不进行声线修正计算的速度较快,但精度要比进行声线修正计算略低,进行声线修正计算的速度略慢,但精度更高。在使用时,用户可根据自己的需求来选择是否进行声线修正。
具体的,参见图3和图4,步骤2中不进行声线修正计算声头应答器水平距离包括:
步骤211、基于应答信号传播时长tΔ与信号在水中的速度C计算声头应答器的距离r,
r=c·tΔ
需要说明的是,信号在水中的传播速度C假设为一个常数,应答信号传播时长tΔ为应答信号从应答器传播至声头的时长,可直接通过测量获得。
步骤212、基于声头的深度值与应答器的深度值计算二者的深度差hΔ,
hΔ=hr-ha
其中,hr为应答器的深度值,ha为声头的深度值。声头的深度值ha由设置在声头上的压力传感器测得,应答器的深度值hr由设置在应答器上的压力传感器测得,然后通过应答信号发送至声头,声头解码信号获得该测量结果。
步骤213、计算声头与应答器的水平距离为,
其中,rh为声头与应答器的水平距离。
参见图5和图6,步骤2中进行声线修正计算声头应答器水平距离包括:
步骤223、比较应答器深度值hr与仿真信号到达深度ht差的绝对值,并将所述绝对值与设定的精度阈值hthresh进行对比,若所述绝对值小于设定精度阈值hthresh,则判定当前的试探性俯仰角等于地理坐标系下应答信号的俯仰角声头与应答器的水平距离rh等于当前推算出的仿真信号传播的水平距离rht,计算结束。深度精度阈值hthresh可以根据需要进行设定。
步骤224、若所述绝对值不小于深度精度阈值hthresh,则记录应答器深度值hr与仿真信号到达深度ht的大小关系。
步骤225、判定此次仿真信号探测是否为首次,是则跳转至步骤228,否则进行步骤226。
步骤226、判定应答器深度测量值hr与仿真信号到达深度ht的大小关系是否与上次相反,若相同,则跳转至步骤228;若相反,则进行步骤227。
步骤3、根据地理坐标系下的应答信号方位角的正弦值和余弦值、声头应答器水平距离、声头的深度值、应答器的水深值以及GNSS定位模块测得的声头地理坐标计算应答器的地理坐标。具体的,步骤3中计算出的应答器的地理坐标为:
xr=x0+rh·cosθ
yr=y0+rh·sinθ
zr=z0+ha-hr
其中,x0,y0,z0为GNSS定位模块测得的声头的坐标。在不进行声线修正计算声头应答器水平距离时,rh取值为在进行声线修正计算声头应答器水平距离时,rh取值为步骤223中推算出的应答信号传播的水平距离rht。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,其它未具体描述的部分,属于现有技术或公知常识。在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (6)
1.一种小俯仰角条件下的USBL定位方法,其特征在于,包括:
步骤1、在应答信号俯仰角小于设定阈值时,利用测量得到的声头坐标系下的应答信号方位角与组合惯导测量得到的声头姿态角,计算出地理坐标系下的应答信号方位角的正弦值和余弦值;
步骤2、计算声头与应答器的水平距离;
步骤3、根据地理坐标系下的应答信号方位角的正弦值和余弦值、声头应答器水平距离、声头的深度值、应答器的水深值以及GNSS定位模块测得的声头地理坐标计算应答器的地理坐标。
2.根据权利要求1所述的小俯仰角条件下的USBL定位方法,其特征在于,所述步骤1具体包括:
其中,θu为直接测量得到的声头坐标系下应答信号的方位角,[]T为转置矩阵;
其中,θ为地理坐标系下应答信号的方位角。
4.根据权利要求2所述的小俯仰角条件下的USBL定位方法,其特征在于,所述步骤2包括声线修正计算声头与应答器的水平距离,具体如下:
步骤223、比较应答器深度值hr与仿真信号到达深度ht差的绝对值,并将所述绝对值与设定的精度阈值hthresh进行对比,若所述绝对值小于设定精度阈值hthresh,则判定当前的试探性俯仰角等于地理坐标系下应答信号的俯仰角声头与应答器的水平距离rh等于当前推算出的仿真信号传播的水平距离rht,计算结束;
步骤224、若所述绝对值不小于深度精度阈值hthresh,则记录应答器深度值hr与仿真信号到达深度ht的大小关系;
步骤225、判定此次仿真信号探测是否为首次,是则跳转至步骤228,否则进行步骤226;
步骤226、判定应答器深度测量值hr与仿真信号到达深度ht的大小关系是否与上次相反,若相同,则跳转至步骤228;若相反,则进行步骤227;
5.根据权利要求3或4所述的小俯仰角条件下的USBL定位方法,其特征在于,所述步骤3中计算出的应答器的地理坐标为:
xr=x0+rh·cosθ
yr=y0+rh·sinθ
zr=z0+ha-hr
其中,x0,y0,z0为GNSS定位模块测得的声头的坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210077848.9A CN114608567B (zh) | 2022-01-24 | 2022-01-24 | 一种小俯仰角条件下的usbl定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210077848.9A CN114608567B (zh) | 2022-01-24 | 2022-01-24 | 一种小俯仰角条件下的usbl定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114608567A true CN114608567A (zh) | 2022-06-10 |
CN114608567B CN114608567B (zh) | 2024-01-12 |
Family
ID=81857521
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210077848.9A Active CN114608567B (zh) | 2022-01-24 | 2022-01-24 | 一种小俯仰角条件下的usbl定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114608567B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116699581A (zh) * | 2023-08-08 | 2023-09-05 | 国家深海基地管理中心 | 基于深海潜水器的海底地形测量方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1837848A (zh) * | 2006-04-27 | 2006-09-27 | 国家海洋局第一海洋研究所 | 用于超短基线声学定位系统的校准方法 |
CN105301556A (zh) * | 2015-11-30 | 2016-02-03 | 江苏中海达海洋信息技术有限公司 | 超短基线安装误差校准装置及其方法 |
RU2649073C1 (ru) * | 2016-12-19 | 2018-03-29 | Акционерное Общество "Концерн "Океанприбор" | Способ определения координат подводного объекта гидроакустической системой подводной навигации с юстировочным маяком |
CN108562872A (zh) * | 2018-03-23 | 2018-09-21 | 淮海工学院 | 一种超短基线水下声学定位校准时异常值探测的方法 |
CN110275139A (zh) * | 2019-05-31 | 2019-09-24 | 东南大学 | 一种基于旋转式基元复用的超短基线定位系统及方法 |
-
2022
- 2022-01-24 CN CN202210077848.9A patent/CN114608567B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1837848A (zh) * | 2006-04-27 | 2006-09-27 | 国家海洋局第一海洋研究所 | 用于超短基线声学定位系统的校准方法 |
CN105301556A (zh) * | 2015-11-30 | 2016-02-03 | 江苏中海达海洋信息技术有限公司 | 超短基线安装误差校准装置及其方法 |
RU2649073C1 (ru) * | 2016-12-19 | 2018-03-29 | Акционерное Общество "Концерн "Океанприбор" | Способ определения координат подводного объекта гидроакустической системой подводной навигации с юстировочным маяком |
CN108562872A (zh) * | 2018-03-23 | 2018-09-21 | 淮海工学院 | 一种超短基线水下声学定位校准时异常值探测的方法 |
CN110275139A (zh) * | 2019-05-31 | 2019-09-24 | 东南大学 | 一种基于旋转式基元复用的超短基线定位系统及方法 |
Non-Patent Citations (2)
Title |
---|
冀大雄等: "一种测量深海应答器坐标的方法", 系统仿真学报, no. 2, pages 226 - 229 * |
孙文舟等: "浅海海底控制点水平坐标的简化计算方法", 海洋测绘, no. 04, pages 34 - 36 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116699581A (zh) * | 2023-08-08 | 2023-09-05 | 国家深海基地管理中心 | 基于深海潜水器的海底地形测量方法及装置 |
CN116699581B (zh) * | 2023-08-08 | 2023-11-03 | 国家深海基地管理中心 | 基于深海潜水器的海底地形测量方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN114608567B (zh) | 2024-01-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11733381B2 (en) | Sound velocity profile inversion method based on inverted multi-beam echo sounder | |
CN105388457B (zh) | 一种基于等效声速梯度的长基线水声定位方法 | |
US20110077889A1 (en) | System and method of magnetic compass calibration | |
CN111350214B (zh) | 多波束水下钢管桩桩位测量方法 | |
CN107664758B (zh) | 基于长基线或超短基线组网的深海导航定位系统及方法 | |
CN102749622A (zh) | 基于多波束测深的声速剖面及海底地形的联合反演方法 | |
CN113093159B (zh) | 多波束测深误差改进模型设计方法 | |
CN104613906B (zh) | 基于声线跟踪的库区深水水深测量方法 | |
CN110133627B (zh) | 水声定位导航系统阵元位置校准测量点间距优化方法 | |
CN109029460A (zh) | 深海运载器对水面监控平台测距的导航方法、系统及装置 | |
CN111751856B (zh) | 一种基于ppp技术的海底大地基准点精确定位方法 | |
CN112540371A (zh) | 一种近底多波束坐标转换处理方法 | |
CN111812694A (zh) | 一种长基线船载定位装置及其定位方法 | |
CN105022032A (zh) | 长基线导航定位系统绝对测阵测距修正方法 | |
CN114608567B (zh) | 一种小俯仰角条件下的usbl定位方法 | |
CN111220146B (zh) | 一种基于高斯过程回归学习的水下地形匹配定位方法 | |
CN109059746A (zh) | 一种基于精密pos的海底地形测量方法 | |
CN117146830B (zh) | 一种自适应多信标航位推算和长基线的紧组合导航方法 | |
Liu et al. | A new underwater positioning model based on average sound speed | |
CN110187302A (zh) | 一种基于单信标的水下蛙人自导航方法 | |
CN117008177B (zh) | 基于一体化平台的海底控制点三维坐标标定方法 | |
CN108225321B (zh) | 一种基于移动节点辅助下的室内定位方法 | |
Zhu et al. | Metering method and measurement uncertainty evaluation of underwater positioning system in six degrees of freedom space | |
CN113218372B (zh) | 一种海底基准点位置标校系统及方法 | |
CN112834986A (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 |