CN1837848A - 用于超短基线声学定位系统的校准方法 - Google Patents
用于超短基线声学定位系统的校准方法 Download PDFInfo
- Publication number
- CN1837848A CN1837848A CNA2006100438882A CN200610043888A CN1837848A CN 1837848 A CN1837848 A CN 1837848A CN A2006100438882 A CNA2006100438882 A CN A2006100438882A CN 200610043888 A CN200610043888 A CN 200610043888A CN 1837848 A CN1837848 A CN 1837848A
- Authority
- CN
- China
- Prior art keywords
- rightarrow
- sound head
- transponder
- coordinate system
- sin
- 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
Images
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种用于超短基线声学定位系统的校准方法。所述定位系统包括:主处理机,收发单元,控制单元,固定安装在测量船体水面以下的超短基线声头,水下目标应答器,外接安装在测量船体水面以上的GPS系统和惯性测量IMU装置。所述的校准方法包括:a.存储步骤,b.输入计算步骤,c.调用计算步骤,d.输出步骤;利用GPS数据、船体姿态数据和声头至应答器的几何距离,计算应答器的位置、声头至GPS天线之间的位置偏差;对所调用的计算机程序进行计算声头的定向误差,以在主处理机中生成适合校准的系统性误差的新计算机程序,实现了对水下拖曳体目标的高精度定位。
Description
技术领域
本发明涉及海洋调查测量船探测设备的改进,具体讲是一种用于超短基线声学定位系统(Ultra Short Base Line Acoustic Positioning System)的校准方法,其属于海洋资源探测技术领域。
背景技术
在现有技术的海洋调查中,经常使用超短基线水声定位系统,对水下拖曳体或其它目标进行定位。该系统包括:固定在测量船船体水面以下的超短基线声头、主处理机、收发单元、控制单元、外接安装在船体水面以上的GPS天线定位系统和惯性测量装置--IMU(Inertial Measurement Unit)等。由于超短基线声头与GPS天线之间存在位置偏差,该声头的声基阵定向系统(XYZ)与IMU定向系统(X′Y′Z′)之间不可能完全重合,存在系统性定向偏差,如果不加以改正,测量的相位角存在系统误差。因此,在使用超短基线水声定位系统工作之前,必须校准这些系统性误差,否则,会出现很大的系统性位置偏差。
发明内容
本发明的目的是提供一种用于超短基线声学定位系统的校准方法。该方法要具有科学性、可靠性,能够快速准确而有效地校准系统的安装误差。
本发明的目的是由以下技术方案实现的,研制了一种用于超短基线声学定位系统的校准方法,所述定位系统包括:主处理机,收发单元,控制单元,固定安装在测量船体水面以下的超短基线声头,水下目标应答器,外接安装在测量船体水面以上的GPS系统和惯性测量IMU装置。所述的校准方法包括:
a.存储步骤,用于在所述收发单元中存储观测到的GPS、IMU和超短基线声头三类测量数据,用于专用计算机程序,其中,每个计算机程序被定义予一与被观测到的GPS,IMU和超短基线三类测量数据对应的唯一特定类别参数;
b.输入计算步骤,用于输入上述GPS测量的地理位置数据,IMU测量的船体姿态数据和超短基线声头至应答器的几何距离,利用这三类参数计算出:应答器的位置
该声头至GPS天线之间的位置偏差
和尺度比参数Δu;
c.调用计算步骤,用于基于所输入的将b.中得到的应答器的位置
超短基线声头的位置偏差值
作为已知值和利用超短基线声头所测量的应答器在该声头坐标系下的三维位置(x、y、z),构建误差方程:
并计算该声头的定向误差;
d.输出步骤,基于所输入的相关定义参数,对所调用的计算机程序进行计算,以在主处理机中生成适合校准的系统性误差的新计算机程序。
所述的存储的三类测量数据,各数据的定义如下:
1)GPS提供的地理位置
NG-北方向的坐标值,
EG-东方向的坐标值,
HG-高程值;
2)IMU的船体姿态数据:
A-船艏向(Heading)的方位角,
κ-纵摇角(Pith),
-横摇角(Roll);
3)在声头坐标系下应答器的位置
x-纵轴向的坐标值,
y-横轴向的坐标值,
z-下垂向的坐标值;
4)应答器的地理位置
NR-北方向的坐标值,
ER-东方向的坐标值,
HR-高程值;
5)在船心坐标系内,声头相对于GPS天线相位中心的位置偏差
ΔF-船艏方向偏差,
ΔS-右舷方向偏差,
ΔH-垂向偏差;
6)声头坐标系的三个坐标轴相对于船心坐标系的定向误差
α-声头坐标系纵轴与船艏方向的夹角,
β-声头坐标系横轴与右舷方向的夹角,
γ-声头坐标系的垂向与船心坐标系的垂向之间的夹角;
7)尺度比参数Δu:该参数乘以工作区域的平均声速,即为声速改正值。所述的计算应答器的位置
和该声头至GPS天线之间的位置偏差
是将应答器在该声头坐标系中的坐标
转化为该声头至应答器之间的几何距离,即:
其中,RU为地理坐标系至船心坐标系的旋转矩阵,它是三个姿态角的函数,其具体表达式为:
`=acsin(sin/cosκ),
2)根据该声头和应答器之间测量得到的距离与几何距离的关系,建立观测模型:
v=ρ-S·(1+Δu) (4);
其中,S为(1)式计算的距离,ρ为声头至应答器的几何距离,即
由于存在测量误差,测量距离S不可能等于几何距离ρ,这里用v来表示测量误差;
3)确定系数矩阵并解算法方程:
将(2)、(3)和(5)代入到(4)后,经过线性化,得到误差方程为:
将N个误差方程写成矩阵-向量的形式,得到:
Q=(ATPA)-1 (N为观测值组数) (7)。
1)在船心坐标系下应答器的理论位置:
2)在船心坐标系下应答器的量测位置:
其中,旋转矩阵RS是定向误差(α β γ)的函数,其定义如下:
3)建立观测模型:
由于系统自身测量误差的存在,两者之间存在细微差异,由此得到观测模型为:
由于声头坐标系与船心坐标系的定向误差是未知的,这三个未知数包含在旋转矩阵RS中;将(8)、(9)和(10)式代入到(11)式,并经线性化后,得到如下误差方程:
设共有N组观测量,可以得到N组形如(12)的误差方程,写成矩阵-向量形式,得到:
Q=(BTPB)-1 (N为观测值组数) (13)。
本发明的技术效果在于:由于在所述的校准方法的b.输入计算步骤,用于输入上述GPS测量的地理位置数据,IMU测量的船体姿态数据和超短基线声头至应答器的几何距离,利用这三类参数和相关算法,就可以准确地计算出超短基线声头由于安装引起的水平和高程方向的位置偏移以及声头在船艏向、右舷向和垂向的定向偏差,即应答器的位置
该声头至GPS天线之间的位置偏差
并能计算出该区域平均声速的修正值,即尺度比参数Δu。由于在所述的校准方法的c.调用计算步骤,用于基于所输入的将b.中得到的应答器的位置
超短基线声头的位置偏差值
作为已知值和利用超短基线声头所测量的应答器在该声头坐标系下的三维位置(x、y、z),构建误差方程:
并可以精确地计算出该声头的定向误差。
附图说明
图1为超短基线水声定位系统的设备流程方框图。
图2为超短基线水声定位系统的校准方法主流程方案原理图。
具体实施方式
根据本发明的校准方法,列举在某海区试验的具体实施例如下:
1)将各项偏差设置为0,将应答器固定在海底,船只围绕应答器航行,采用本发明的校准方法所述的a.步骤,采集存储GPS、IMU、超短基线测量的数据共计326组。
2)数据采集完毕,按本校准方法所述的b.-c.的步骤计算得到校准数据,结果见表1。
3)为了证明校准方法的科学性,按本校准方法所述的d.步骤输出未经过校准计算得到的应答器地理位置数据,如表2;按本校准方法所述的d.步骤输出经过校准计算得到的应答器位置数据,如表3。
4)将表1、表2的数据与应答器的实际地理位置数据进行比较,如表4。
结论:经过比较显然经过校准计算得到的应答器位置更接近应答器的实际位置,而未经过校准计算得到的应答器位置与应答器的实际位置偏差较大,这说明了本校准方法校准得准确性。
表1
表2
表3
表4
本领域的普通技术人员都会理解,在本发明的保护范围内,对于上述实施例进行修改,添加和替换都是可能的,其都没有超出本发明的保护范围。
Claims (4)
1、一种用于超短基线声学定位系统的校准方法,所述定位系统包括:主处理机,收发单元,控制单元,固定安装在测量船体水面以下的超短基线声头,水下目标应答器,外接安装在测量船体水面以上的GPS系统和惯性测量IMU装置,其特征在于:所述的校准方法包括:
a.存储步骤,用于在所述收发单元中存储观测到的GPS、IMU和超短基线声头三类测量数据,用于专用计算机程序,其中,每个计算机程序被定义予一与被观测到的GPS,IMU和超短基线三类测量数据对应的唯一特定类别参数;
c.调用计算步骤,用于基于所输入的将b.中得到的应答器的位置
超短基线声头的位置偏差值
作为已知值和利用超短基线声头所测量的应答器在该声头坐标系下的三维位置(x、y、z),构建误差方程:
并计算该声头的定向误差;
d.输出步骤,基于所输入的相关定义参数,对所调用的计算机程序进行计算,以在主处理机中生成适合校准的系统性误差的新计算机程序。
2、根据权利要求1所述用于超短基线声学定位系统的校准方法,其特征在于:
所述的存储的三类测量数据,各数据的定义如下:
(1)GPS提供的地理位置
NG-北方向的坐标值,
EG-东方向的坐标值,
HG-高程值;
(2)IMU的船体姿态数据:
A-船艏向(Heading)的方位角,
κ-纵摇角(Pith),
-横摇角(Roll);
(3)在声头坐标系下应答器的位置
x-纵轴向的坐标值,
y-横轴向的坐标值,
z-下垂向的坐标值;
(4)应答器的地理位置
NR-北方向的坐标值,
ER-东方向的坐标值,
HR-高程值;
(5)在船心坐标系内,声头相对于GPS天线相位中心的位置偏差
ΔF-船艏方向偏差,
ΔS-右舷方向偏差,
ΔH-垂向偏差;
(6)声头坐标系的三个坐标轴相对于船心坐标系的定向误差
α-声头坐标系纵轴与船艏方向的夹角,
β-声头坐标系横轴与右舷方向的夹角,
γ-声头坐标系的垂向与船心坐标系的垂向之间的夹角;
(7)尺度比参数Δu:该参数乘以工作区域的平均声速,即为声速改正值。
3、根据权利要求1所述用于超短基线声学定位系统的校准方法,其特征在于:
所述的计算应答器的位置
和该声头至GPS天线之间的位置偏差
是将应答器在该声头坐标系中的坐标
转化为该声头至应答器之间的几何距离,即:
其中,RU为地理坐标系至船心坐标系的旋转矩阵,它是三个姿态角的函数,其具体表达式为:
`=acsin(sin/cosκ),
2)根据该声头和应答器之间测量得到的距离与几何距离的关系,建立观测模型:
v=ρ-S·(1+Δu) (4);
其中,S为(1)式计算的距离,ρ为声头至应答器的几何距离,即
由于存在测量误差,测量距离S不可能等于几何距离ρ,这里用v来表示测量误差;
3)确定系数矩阵并解算法方程:
将(2)、(3)和(5)代入到(4)后,经过线性化,得到误差方程为:
其中,
为未知数向量(7×1),包括7个未知数,即声头的位置偏差(3个未知数)、应答器的位置(3个未知数)和尺度比参数(1个未知数);
为已知的系数向量(1×7),l为常数项;
将N个误差方程写成矩阵-向量的形式,得到:
Q=(ATPA)-1 (N为观测值组数) (7)。
1)在船心坐标系下应答器的理论位置:
2)在船心坐标系下应答器的量测位置:
其中,旋转矩阵RS是定向误差(αβγ)的函数,其定义如下:
3)建立观测模型:
由于系统自身测量误差的存在,两者之间存在细微差异,由此得到观测模型为:
由于声头坐标系与船心坐标系的定向误差是未知的,这三个未知数包含在旋转矩阵RS中;将(8)、(9)和(10)式代入到(11)式,并经线性化后,得到如下误差方程:
设共有N组观测量,可以得到N组形如(12)的误差方程,写成矩阵-向量形式,得到:
Q=(BTPB)-1 (N为观测值组数) (13)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2006100438882A CN100535683C (zh) | 2006-04-27 | 2006-04-27 | 用于超短基线声学定位系统的校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNB2006100438882A CN100535683C (zh) | 2006-04-27 | 2006-04-27 | 用于超短基线声学定位系统的校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1837848A true CN1837848A (zh) | 2006-09-27 |
CN100535683C CN100535683C (zh) | 2009-09-02 |
Family
ID=37015301
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB2006100438882A Expired - Fee Related CN100535683C (zh) | 2006-04-27 | 2006-04-27 | 用于超短基线声学定位系统的校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100535683C (zh) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101806883A (zh) * | 2010-04-09 | 2010-08-18 | 哈尔滨工程大学 | 适用于大范围海底应答器阵的快速高精度坐标校准方法 |
CN101833081A (zh) * | 2010-04-23 | 2010-09-15 | 哈尔滨工程大学 | 深海海底应答器绝对位置的精确标校方法 |
CN101441266B (zh) * | 2008-12-30 | 2011-08-03 | 哈尔滨工程大学 | 水下多应答器组合导航方法 |
CN101441267B (zh) * | 2008-12-30 | 2011-08-03 | 哈尔滨工程大学 | 海底应答器绝对位置三测点高精度标校方法 |
CN101566691B (zh) * | 2009-05-11 | 2012-07-18 | 华南理工大学 | 一种水下目标跟踪定位方法及系统 |
CN103925904A (zh) * | 2014-04-15 | 2014-07-16 | 哈尔滨工程大学 | 一种基于对称测线的超短基线安装角度偏差无偏估计方法 |
CN105137438A (zh) * | 2015-10-16 | 2015-12-09 | 苏州桑泰海洋仪器研发有限责任公司 | 合成孔径声呐与水下定位系统同步控制方法及装置 |
CN105157701A (zh) * | 2015-09-01 | 2015-12-16 | 北京理工大学 | 一种水下位置基准布设的方法 |
CN105301556A (zh) * | 2015-11-30 | 2016-02-03 | 江苏中海达海洋信息技术有限公司 | 超短基线安装误差校准装置及其方法 |
CN105510902A (zh) * | 2015-12-23 | 2016-04-20 | 中国船舶重工集团公司第七一〇研究所 | 一种高频立体空间探测自导声基阵 |
CN105652262A (zh) * | 2014-11-17 | 2016-06-08 | 中海油信息科技有限公司 | 一种超短基线水声定位系统的静态校准方法 |
CN108562872A (zh) * | 2018-03-23 | 2018-09-21 | 淮海工学院 | 一种超短基线水下声学定位校准时异常值探测的方法 |
CN109613520A (zh) * | 2018-12-14 | 2019-04-12 | 东南大学 | 一种基于滤波的超短基线安装误差在线标定方法 |
CN110471096A (zh) * | 2019-09-11 | 2019-11-19 | 哈尔滨工程大学 | 一种分布式海底飞行节点群体定位方法 |
CN111025302A (zh) * | 2019-12-20 | 2020-04-17 | 中国船舶重工集团公司七五0试验场 | 一种智能化船载水声定位装置、系统及定位方法 |
CN111812694B (zh) * | 2020-06-28 | 2021-05-18 | 中国科学院地质与地球物理研究所 | 一种长基线船载定位装置及其定位方法 |
CN114608567A (zh) * | 2022-01-24 | 2022-06-10 | 江苏中海达海洋信息技术有限公司 | 一种小俯仰角条件下的usbl定位方法 |
-
2006
- 2006-04-27 CN CNB2006100438882A patent/CN100535683C/zh not_active Expired - Fee Related
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101441266B (zh) * | 2008-12-30 | 2011-08-03 | 哈尔滨工程大学 | 水下多应答器组合导航方法 |
CN101441267B (zh) * | 2008-12-30 | 2011-08-03 | 哈尔滨工程大学 | 海底应答器绝对位置三测点高精度标校方法 |
CN101566691B (zh) * | 2009-05-11 | 2012-07-18 | 华南理工大学 | 一种水下目标跟踪定位方法及系统 |
CN101806883A (zh) * | 2010-04-09 | 2010-08-18 | 哈尔滨工程大学 | 适用于大范围海底应答器阵的快速高精度坐标校准方法 |
CN101833081A (zh) * | 2010-04-23 | 2010-09-15 | 哈尔滨工程大学 | 深海海底应答器绝对位置的精确标校方法 |
CN103925904A (zh) * | 2014-04-15 | 2014-07-16 | 哈尔滨工程大学 | 一种基于对称测线的超短基线安装角度偏差无偏估计方法 |
CN103925904B (zh) * | 2014-04-15 | 2017-01-04 | 哈尔滨工程大学 | 一种基于对称测线的超短基线安装角度偏差无偏估计方法 |
CN105652262A (zh) * | 2014-11-17 | 2016-06-08 | 中海油信息科技有限公司 | 一种超短基线水声定位系统的静态校准方法 |
CN105652262B (zh) * | 2014-11-17 | 2017-11-14 | 中海油信息科技有限公司 | 一种超短基线水声定位系统的静态校准方法 |
CN105157701A (zh) * | 2015-09-01 | 2015-12-16 | 北京理工大学 | 一种水下位置基准布设的方法 |
CN105137438B (zh) * | 2015-10-16 | 2017-07-07 | 苏州桑泰海洋仪器研发有限责任公司 | 合成孔径声呐与水下定位系统同步控制方法及装置 |
CN105137438A (zh) * | 2015-10-16 | 2015-12-09 | 苏州桑泰海洋仪器研发有限责任公司 | 合成孔径声呐与水下定位系统同步控制方法及装置 |
CN105301556A (zh) * | 2015-11-30 | 2016-02-03 | 江苏中海达海洋信息技术有限公司 | 超短基线安装误差校准装置及其方法 |
CN105510902A (zh) * | 2015-12-23 | 2016-04-20 | 中国船舶重工集团公司第七一〇研究所 | 一种高频立体空间探测自导声基阵 |
CN108562872A (zh) * | 2018-03-23 | 2018-09-21 | 淮海工学院 | 一种超短基线水下声学定位校准时异常值探测的方法 |
CN108562872B (zh) * | 2018-03-23 | 2020-06-16 | 淮海工学院 | 一种超短基线水下声学定位校准时异常值探测的方法 |
CN109613520B (zh) * | 2018-12-14 | 2022-10-14 | 东南大学 | 一种基于滤波的超短基线安装误差在线标定方法 |
CN109613520A (zh) * | 2018-12-14 | 2019-04-12 | 东南大学 | 一种基于滤波的超短基线安装误差在线标定方法 |
CN110471096A (zh) * | 2019-09-11 | 2019-11-19 | 哈尔滨工程大学 | 一种分布式海底飞行节点群体定位方法 |
CN111025302A (zh) * | 2019-12-20 | 2020-04-17 | 中国船舶重工集团公司七五0试验场 | 一种智能化船载水声定位装置、系统及定位方法 |
CN111025302B (zh) * | 2019-12-20 | 2024-01-23 | 中国船舶重工集团公司七五0试验场 | 一种智能化船载水声定位装置、系统及定位方法 |
CN111812694B (zh) * | 2020-06-28 | 2021-05-18 | 中国科学院地质与地球物理研究所 | 一种长基线船载定位装置及其定位方法 |
CN114608567A (zh) * | 2022-01-24 | 2022-06-10 | 江苏中海达海洋信息技术有限公司 | 一种小俯仰角条件下的usbl定位方法 |
CN114608567B (zh) * | 2022-01-24 | 2024-01-12 | 江苏中海达海洋信息技术有限公司 | 一种小俯仰角条件下的usbl定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN100535683C (zh) | 2009-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1837848A (zh) | 用于超短基线声学定位系统的校准方法 | |
CN105388457B (zh) | 一种基于等效声速梯度的长基线水声定位方法 | |
CN1945212A (zh) | 一种sins/gps组合导航系统的自适应加权反馈校正滤波方法 | |
CN101078627A (zh) | 一种基于陀螺全站仪-激光标靶的盾构机自动导向系统的在线标定方法 | |
CN109613520B (zh) | 一种基于滤波的超短基线安装误差在线标定方法 | |
CN111350214B (zh) | 多波束水下钢管桩桩位测量方法 | |
US9335172B2 (en) | Apparatus for measuring location of underwater vehicle and method thereof | |
CN105509765B (zh) | 一种惯性/dvl/usbl安装误差标定方法 | |
CN101587187A (zh) | 一种测深声纳系统偏差校正方法 | |
CN108802737A (zh) | 一种用于浅水域水下定位的超短基线系统及校准方法 | |
CN108020815A (zh) | 一种定位水下机器人的方法、设备及存储设备 | |
CN112540371A (zh) | 一种近底多波束坐标转换处理方法 | |
CN104614554B (zh) | 船基风速风向传感器基准误差自修正方法 | |
CN108413983A (zh) | 一种sins/usbl一体化定位系统安装误差标定的机械方法 | |
CN107063201A (zh) | 自带校准系统的一体化精密测深安装装置及其系统 | |
CN109059746A (zh) | 一种基于精密pos的海底地形测量方法 | |
CN105444779B (zh) | 一种船载水上水下一体化测量系统野外实时校准方法 | |
CN110109167B (zh) | 一种基于高程约束的海上精密定位方法 | |
Tomczak et al. | Subsea wellhead spud-in marking and as-built position estimation method based on ultra-short baseline acoustic positioning | |
CN114397644B (zh) | 一种基于四元数法的超短基线安装误差校准方法 | |
Zheng et al. | Study on the calibration method of USBL system based on ray tracing | |
CN116699581B (zh) | 基于深海潜水器的海底地形测量方法及装置 | |
Yu | In-situ calibration of transceiver alignment for a high-precision USBL system | |
NO315766B1 (no) | En metode for feltkalibrering av systemparametere i et multistråleekkolodd-system | |
Wang et al. | Measurement error analysis of multibeam echosounder system mounted on the deep-sea autonomous underwater vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20090902 Termination date: 20100427 |