CN111928850B - 适用于极地冰架下环境的自主水下机器人的组合导航方法 - Google Patents
适用于极地冰架下环境的自主水下机器人的组合导航方法 Download PDFInfo
- Publication number
- CN111928850B CN111928850B CN202010198740.6A CN202010198740A CN111928850B CN 111928850 B CN111928850 B CN 111928850B CN 202010198740 A CN202010198740 A CN 202010198740A CN 111928850 B CN111928850 B CN 111928850B
- Authority
- CN
- China
- Prior art keywords
- autonomous underwater
- underwater robot
- beacon
- time
- representing
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 239000013598 vector Substances 0.000 claims description 25
- 239000011159 matrix material Substances 0.000 claims description 18
- 238000005259 measurement Methods 0.000 claims description 18
- 238000004364 calculation method Methods 0.000 claims description 12
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 4
- 238000011835 investigation Methods 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
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/20—Instruments for performing navigational calculations
- G01C21/203—Specially adapted for sailing ships
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及水下组合导航技术领域,尤其涉及一种自主水下机器人极地冰架下环境的自主水下机器人的组合导航方法组合导航方法,针对极地水下长航程的自主水下机器人长时间航行的累积导航误差消除问题,实现自主水下机器人自主携带声学导航信标,自主水下机器人自主布放声学导航信标,自主标定声学信标布放三维空间位置,最后根据信标标定结果进行单信标组合导航,解决冰下长时间远程自主水下机器人导航位置的累积偏移问题。本发明的重点是解决冰下布放信标的位置标定问题,在信标标定成功后,再根据信标标定位置和单信标测距对冰下自主水下机器人进行导航。
Description
技术领域
本发明涉及水下组合导航技术领域,尤其涉及一种自主水下机器人(简称AUV)极地冰架下环境的自主水下机器人的组合导航方法组合导航方法。
背景技术
在海洋工程、海洋科学调查过程中,自主水下机器人发挥越来越重要的作用,而在极地环境下使用自主水下机器人替代人类完成极地冰下-海洋***观测是当前支撑极地科考的重要工程装备研究的热点。针对极地冰架-海洋***的观测平台可以分为天基、冰基、自主水下机器人等多种类平台。天基观测平台包括卫星遥感和飞机挂载观测设备等,其优点是实现高效大面积观测,局限性是无法获取冰架内部的精细结构;冰基观测平台主要包含雷达、热水钻等,其优点是能够观测冰架,但局限性是空间覆盖率较低、观测灵活性不足。相对以上两类平台,自主水下机器人平台是高效冰下移动平台,既能到达冰架内部观测,又能够灵活大范围移动观测,所以自主水下机器人越来越成为极地冰下海洋观测的重要海洋装备。自主水下机器人需要在冰架下长时间测绘冰架形态、冰架下海底地貌、观测冰架下的海洋水体,其中导航***的作用是精确导引自主水下机器人到达观测目标位置,实现观测数据与观测空间的高精度位置匹配,保证冰架下海洋观测数据的质量,所以冰架下的导航问题是自主水下机器人在冰架下应用所面临的关键技术问题。极地冰架下导航的难点是深水罗经在极区的游移角误差随纬度的增高而放大,即深水罗经的航向精度随纬度升高而下降,航向精度的下降又进一步降低了自主导航航位推算的位置精度,所以在极地冰架环境下实现长时间、远距离范围内的高精度导航定位是水下导航***的重要技术挑战。传统水下组合导航***的外部辅助定位主要采用声学定位方式,根据声基线的距离不同,可将水下声学定位***分为长基线、短基线和超短基线。长基线的基线长度一般为100米到6000米,采用母船布放3个以上长基线定位信标,然后母船以围绕长基线声学定位信标水面航行航行的方式,利用母船自身搭载的大型超短基线和差分GPS对长基线定位信标位置进行导航标定,最后自主水下机器人在长基线阵内航行,不断融合长基线测距信息改进组合导航***位置精度。短基线的基线长度一般为1到50米,一般将短基线信标搭载在母船上,自主水下机器人在母船附近航行,不断融合短基线测距信息改进组合导航***位置精度。超短基线的基线长度小于1米,一般超短基线基阵搭载在母船上,自主水下机器人在母船超短基阵覆盖范围内航行,数据融合超短基线方位/距离测量改进组合导航***位置精度。在极地冰架下环境下,尤其南极冰架的厚度达到上千米,母船无法到达冰架上方使用短基线、超短基线对冰架下的自主水下机器人进行声学辅助定位,更无法在冰架上方布设长基线定位信标,更无法对布放信标进行位置标定,所以需要自主水下机器人自主携带信标从冰架下洞口到达冰架下方的海洋,自主布放信标到海底,自主对信标的位置进行标定,自主水下机器人通过测量与信标的距离对自身的导航误差进行修正,其中如何利用自主水下机器人对信标位置进行标定是极地冰下组合导航的关键步骤,标定的精度直接影响到自主水下机器人的外部量测精度,进而决定冰下作业自主水下机器人的导航精度。近年来,研究人员在不依托母船工况下对布放信标进行位置标定方面取得了一定的进展,但是其平台依然是具有实时接收GPS信号的无人船、具有上浮到水面接收GPS信标的自主水下机器人,而极地冰下环境的自主水下机器人不具备接收GPS定位的客观条件,再考虑到极地冰架下自主水下机器人自主导航精度下降明显,所以需要新的适用于极地冰架环境的自主水下机器人单信标组合导航方法,利用信标与自主水下机器人的纯距离间接观测,将自主水下机器人内部导航传感器计算的移动矢量径引入观测方程,再通过机动要素分析规划观测的机动路径,提高信标标定的精度和可观测度。
发明内容
本发明涉及水下组合导航技术领域,尤其涉及一种自主水下机器人(简称AUV)极地冰架下环境的自主水下机器人的组合导航方法组合导航方法,针对极地水下长航程的自主水下机器人长时间航行的累积导航误差消除问题,实现自主水下机器人自主携带声学导航信标,自主水下机器人自主布放声学导航信标,自主标定声学信标布放三维空间位置,最后根据信标标定结果进行单信标组合导航,解决冰下长时间远程自主水下机器人导航位置的累积偏移问题。极地冰下自主水下机器人单信标组合导航的关键技术问题是解决自主水下机器人精确标定信标问题的难题,信标位置标定也是单信标组合导航的基础,所以本发明的重点是解决冰下布放信标的位置标定问题,在信标标定成功后,再根据信标标定位置和单信标测距对冰下自主水下机器人进行导航。本发明包括:自主水下机器人在冰架下内布放后,自主水下机器人利用自身航位推算位置、自主水下机器人与信标的测距信息,通过自主水下机器人机动航行的方法改善信标标定方程的可观测性,引入相邻时序测距信息递推提高标定计算效率,获得高精度的信标位置估计。最后,将标定结果代入单信标组合导航滤波器,实现对冰架下环境下航行的自主水下机器人的高精度导航。本方法能够有效地处理冰架下环境下自主水下机器人的导航问题,采用机动航行优化观测性策略和移动矢量径策略,提高了***的可观测性,节约了导航计算的时间成本,具有较强的工程应用价值;本方法移植方便,扩展性强,也适用于极地冰下滑翔机、极地有缆遥控水下机器人等的组合导航应用领域。
本发明为实现上述目的所采用的技术方案是:
适用于极地冰架下环境的自主水下机器人的组合导航方法,包括以下步骤:
1)自主水下机器人按照规划轨迹的约束条件对信标进行机动测距;
2)计算信标的初始位置和方差估计;
3)计算自主水下机器人在当前时刻的量测雅各比矩阵;
4)根据雅各比矩阵计算信标在当前时刻的位置估计和方差估计;
5)根据当前时刻信标的位置估计和方差估计,判断是否满足结束条件,若满足,记录当前时刻信标位置;否则,返回步骤3);
6)水下机器人根据记录的信标位置作为参考点进行导航。
所述规划轨迹的约束条件为:
其中,ρi,i+1表示点Xi到点Xi+1的位置矢量,ρi+1,i+2表示点Xi+1到点Xi+2的位置矢量,ρc是线性化判定常数,fabs为取绝对值。
步骤2)包括:
求解信标的初始位置估计具体为:
其中第1次收到测距信号的时刻为t1,自主水下机器人在时刻t1的位置为X1=(x1,y1,z1)T,同理定义第2、3、4、5次数测距时刻的自主水下机器人位置为X2、X3、X4、X5,它们均由自主水下机器人搭载的多普勒计程仪、深水罗经、深度计直接测量获得,R1、R2、R3、R4、R5分别表示自主水下机器人在时刻t1、t2、t3、t4、t5与信标的测距,它们由测距仪直接测量获得,H0和Y是中间变量,;
P0表示信标的初始位置估计的方差估计,计算方法为:
其中,XL表示自主水下机器人布放信标时自身的三维位置,E(.)表示数学期望的计算符号。
所述量测雅各比矩阵为:
Hk=[ρi-4,i-3 ρi-3,i-2 ρi-2,i-1 ρi-1,i]T
其中,Hk为自主水下机器人在时刻tk的量测雅各比矩阵,ρi-4,i-3表示点Xi-4到点Xi-3的移动矢量径;ρi-3,i-2表示点Xi-3到点Xi-2的移动矢量径;ρi-2,i-1表示点Xi-2到点Xi-1的移动矢量径;ρi-1,i表示点Xi-1到点Xi的位移动矢量径。
ρi-4,i-3、ρi-2,i-1、ρi-3,i-2、ρi-1,i的计算方法为:
其中,u(t)表示自主水下机器人在时刻t的航行速度,由自主水下机器人搭载的多普勒计程仪直接测量;ψ(t)和θ(t)分别表示自主水下机器人在时刻t的航向角、纵倾角,由自主水下机器人搭载的深水罗经直接测量;zi、zi-1、zi-2、zi-3、zi-4分别表示自主水下机器人在时刻ti、时刻ti-1、时刻ti-2、时刻ti-3、时刻ti-4的深度,由自主水下机器人搭载的深度传感器直接测量。
步骤4)包括:
计算信标在时刻tk的方差估计Pk和位置估计计算方法为:
其中,Pk表示信标在时刻tk的方差估计,表示信标在时刻tk的位置估计;Pk-1表示信标在时刻tk-1的方差估计,/>表示信标在时刻tk-1的位置估计;Kk表示信标在时刻tk的估计增益,Yk表示由不同时刻信标测距组成的列向量,Rk表示在信标标定过程中,自主水下机器人因本体航行运动而引入的tk时刻量测噪声,/>是中间变量,Pk-1表示前一时刻tk-1的方差估计,u(tk)表示自主水下机器人在tk时刻的航行速度,由自主水下机器人搭载的多普勒计程仪直接测量,ψ(tk)和θ(tk)分别表示自主水下机器人在时刻tk的航向角、纵倾角,由自主水下机器人搭载的深水罗经直接测量,/>是深水罗经和多普勒计程仪的矩阵,dialog(.)表示对角线矩阵算子,σu是多普勒计程仪的测速精度,σψ是深水罗经的航向精度,/>表示自主水下机器人搭载的测距仪的测量方差,Ri、Ri-1、Ri-2、Ri-3、Ri-4分别表示信标与自主水下机器人的测距,它们由自主水下机器人搭载的测距仪提供,I表示单位矩阵,它是常数,k表示时刻tk的时间索引。
当k=0时即当前时刻是初始时刻,Pk和分别等于初始时刻的位置估计/>和方差估计P0。
所述结束条件为:
其中||·||2表示2范数算子,表示从时刻tk-20到时刻tk的相邻位置估计2范数的期望,αc是信标标定精度阈值,k表示时刻tk的时间索引,for是表示期望计算范围的关键字。
步骤6)包括:
根据tk时刻测距仪提供的自主水下机器人与信标的距离、信标标定位置结合自主水下机器人本身航位推算位置,对自主水下机器人进行导航。
本发明具有以下有益效果及优点:
1.相对于传统组合导航方法,本方法使用自主水下机器人冰下自主标定信标,克服传统组合导航方法只能依托船基标定而使用环境受限的缺点;
2.针对传统信标标定方法的计算空间和时间成本高的问题,本方法将机动航行策略和移动矢量径模型相结合,提高了自主水下机器人组合导航方法在冰架下内应用的实时性和可靠性。
3.应用范围广,本发明不但可以应用于冰架下环境下的自主水下机器人组合导航,还可以用于极地冰下滑翔机、极地有缆遥控水下机器人的组合导航。
附图说明
图1是本发明的组成示意图;
图2是本发明的流程图。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
整个***组成包括自主水下机器人、多普勒计程仪、深水罗经、深度计、测距仪、信标。其中自主水下机器人是搭载多普勒计程仪、深水罗经、深度计、测距仪的本体,也是运载信标的运载具。多普勒计程仪的作用是测量自主水下机器人的航行速度;深水罗经的作用是测量自主水下机器人的姿态角;深水计的作用是测量自主水下机器人的深度;测距仪的作用是测量自主水下机器人到信标的距离;信标初始由自主水下机器人携带,到达预定区域后,它从自主水下机器人上分离,被布放在冰架下的海底,它的作用是向自主水下机器人提供声学定位应答信号,***组成如图1所示。
整个***按照如下流程工作:
为了下文描述方便,这里对部分符号变量给出定义:定义当自主水下机器人分别在时刻ti、时刻ti-1、时刻ti-2、时刻ti-3接收到自身与信标的测距时,各时刻对应的测距分别用Ri、Ri-1、Ri-2、Ri-3表示,其中i表示测距的时间序号;定义Xi表示自主水下机器人在时刻ti的三维空间位置,Xi=(xi,yi,zi)T,其中xi,,yi,,zi分别表示北向位置,东向位置,深度;定义ρi-1,i表示点Xi-1到点Xi的位置矢量。
如图2所示为本发明的流程图。
第一步,按规划轨迹对信标进行机动测距
自主水下机器人自主布放信标后,自主水下机器人机动航行并对信标进行测距。对机动航行轨迹要求如下,自主水下机器人将信标布放到预定位置后,以信标为中心进行机动航行同时对信标测距,要求机动航行轨迹满足机动可观测条件,机动可观测的判别依据是满足如下判别公式:
其中定义ρi,i+1表示点Xi到点Xi+1的位置矢量;ρi+1,i+2表示点Xi+1到点Xi+2的位置矢量;ρi+2,i+3表示点Xi+2到点Xi+3的位置矢量,ρc是线性化判定常数,ρc是工程上可以取经验值0.9。该判别式的物理含义是当相邻位置矢量满足判别式时,那么相邻位置矢量线性无关。所以在实际工程应用过程中,建议机动航行采用多边形轨迹(边数不少于5条)、圆形、椭圆、***数字8字形等规划轨迹,轨迹规划点到信标初始布放位置的三维距离在100米到600米之间。
第二步,计算信标的初始位置和方差估计
定义表示信标三维位置的初始位置估计,它是待求解的未知量,它通过求解如下方程组获得:
其中定义第1次收到测距信号的时刻为t1,自主水下机器人在时刻t1的位置为X1=(x1,y1,z1)T,同理定义第2、3、4、5次数测距时刻的自主水下机器人位置为X2、X3、X4、X5,它们均由自主水下机器人搭载的多普勒计程仪、深水罗经、深度计直接测量获得,是已知输入量。R1、R2、R3、R4、R5分别表示自主水下机器人在时刻t1、t2、t3、t4、t5与信标的测距,它们由测距仪直接测量获得。
H0和Y是中间变量。
定义P0表示信标三维位置的初始位置估计的方差估计,它的计算方法如下:
其中XL表示自主水下机器人布放信标时自身的三维位置,E(.)表示数学期望的计算符号。
第三步,计算自主水下机器人在时刻tk的量测雅各比矩阵Hk,计算方法如下:
Hk=[ρi-4,i-3 ρi-3,i-2 ρi-2,i-1 ρi-1,i]T (4)
其中ρi-4,i-3表示点Xi-4到点Xi-3的移动矢量径;ρi-2,i-1表示点Xi-2到点Xi-1的移动矢量径;ρi-3,i-2表示点Xi-3到点Xi-2的移动矢量径;ρi-1,i表示点Xi-1到点Xi的位移动矢量径,它们是中间变量,中间变量ρi-4,i-3、ρi-2,i-1、ρi-3,i-2、ρi-1,i的计算方法如下:
其中u(t)表示自主水下机器人在时刻t的航行速度,由自主水下机器人搭载的多普勒计程仪直接测量,是已知输入量;ψ(t)和θ(t)分别表示自主水下机器人在时刻t的航向角、纵倾角,由自主水下机器人搭载的深水罗经直接测量,是已知输入量;zi、zi-1、zi-2、zi-3分别表示自主水下机器人在时刻ti、时刻ti-1、时刻ti-2、时刻ti-3的深度,由自主水下机器人搭载的深度传感器直接测量,是已知输入量。
第四步,计算信标在时刻tk的位置估计和方差估计
定义和Pk分别表示信标在时刻tk的位置估计和方差估计,它们的计算方法如下:
其中Pk表示信标在时刻tk的位置估计,表示信标在时刻tk的方差估计,它们是方程的待求解变量,整个方程通过代入法直接求解即可。特殊情况下,即当k=0时(表示当前时刻是初始时刻),那么Pk和/>分别等于初始时刻的位置估计/>和方差估计P0,不需要求解该方程组,直接取值即可。Kk表示信标在时刻tk的估计增益,它是中间变量;Yk表示由不同时刻信标测距组成的列向量,它是中间变量;Rk表示在信标标定过程中,自主水下机器人因本体航行运动而引入的tk时刻量测噪声,它是中间变量;/>是为描述Rk方便而引入的中间变量,它是由已知输入量构成的矩阵;Pk-1表示前一时刻tk-1的方差估计,对于tk时刻的方程组,它是已知量;u(tk)表示自主水下机器人在tk时刻的航行速度,由自主水下机器人搭载的多普勒计程仪直接测量,是已知输入量;ψ(tk)和θ(tk)分别表示自主水下机器人在时刻的航向角、纵倾角,由自主水下机器人搭载的深水罗经直接测量,是已知输入量;是深水罗经和多普勒计程仪相关矩阵,dialog(.)表示对角线矩阵算子,σu是多普勒计程仪的测速精度,σψ是深水罗经的航向精度,σu和σψ在设备出厂时由厂家直接提供,是已知参数;/>表示自主水下机器人搭载的测距仪的测量方差,该参数在设备出厂时由厂家直接提供,是已知参数。Ri、Ri-1、Ri-2、Ri-3表示信标与自主水下机器人的测距,它们由自主水下机器人搭载的测距仪提供,是已知输入量。I表示3*3的单位矩阵,它是常数。
第五步,重复步骤三到步骤四,直到tk时刻计算的信标位置估计满足如下判别式则停止信标标定过程。
其中||·||2表示2范数算子,表示从时刻tk-20到时刻tk的相邻位置估计2范数的期望;αc是信标标定精度阈值,用户可以自行设置,建议取值为10,k表示时刻tk的时间索引,for是表示期望计算范围的关键字。
第六步,根据tk时刻测距仪提供的自主水下机器人与信标的距离、信标标定位置结合自主水下机器人本身航位推算位置,按照标准卡尔曼滤波器构建单信标组合导航滤波器,实时计算自主水下机器人水下位置的最优估计。因为该步骤算法采用标准卡尔曼滤波器,所以该步骤不作为权利诉求。/>
Claims (9)
1.适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,包括以下步骤:
1)自主水下机器人按照规划轨迹的约束条件对信标进行机动测距;
2)计算信标的初始位置和方差估计;
3)计算自主水下机器人在当前时刻的量测雅各比矩阵;
4)根据雅各比矩阵计算信标在当前时刻的位置估计和方差估计;
5)根据当前时刻信标的位置估计和方差估计,判断是否满足结束条件,若满足,记录当前时刻信标位置;否则,返回步骤3);
6)水下机器人根据记录的信标位置作为参考点进行导航。
2.根据权利要求1所述的适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,所述规划轨迹的约束条件为:
其中,ρi,i+1表示点Xi到点Xi+1的位置矢量,ρi+1,i+2表示点Xi+1到点Xi+2的位置矢量,ρc是线性化判定常数,fabs为取绝对值。
3.根据权利要求1所述的适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,步骤2)包括:
求解信标的初始位置估计具体为:
其中第1次收到测距信号的时刻为t1,自主水下机器人在时刻t1的位置为X1=(x1,y1,z1)T,同理定义第2、3、4、5次数测距时刻的自主水下机器人位置为X2、X3、X4、X5,它们均由自主水下机器人搭载的多普勒计程仪、深水罗经、深度计直接测量获得,R1、R2、R3、R4、R5分别表示自主水下机器人在时刻t1、t2、t3、t4、t5与信标的测距,它们由测距仪直接测量获得,H0和Y是中间变量;
P0表示信标的初始位置估计的方差估计,计算方法为:
其中,XL表示自主水下机器人布放信标时自身的三维位置,E(.)表示数学期望的计算符号。
4.根据权利要求1所述的适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,所述量测雅各比矩阵为:
Hk=[ρi-4,i-3 ρi-3,i-2 ρi-2,i-1 ρi-1,i]T
其中,Hk为自主水下机器人在时刻tk的量测雅各比矩阵,ρi-4,i-3表示点Xi-4到点Xi-3的移动矢量径;ρi-3,i-2表示点Xi-3到点Xi-2的移动矢量径;ρi-2,i-1表示点Xi-2到点Xi-1的移动矢量径;ρi-1,i表示点Xi-1到点Xi的位移动矢量径。
5.根据权利要求4所述的适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,ρi-4,i-3、ρi-2,i-1、ρi-3,i-2、ρi-1,i的计算方法为:
其中,u(t)表示自主水下机器人在时刻t的航行速度,由自主水下机器人搭载的多普勒计程仪直接测量;ψ(t)和θ(t)分别表示自主水下机器人在时刻t的航向角、纵倾角,由自主水下机器人搭载的深水罗经直接测量;zi、zi-1、zi-2、zi-3、zi-4分别表示自主水下机器人在时刻ti、时刻ti-1、时刻ti-2、时刻ti-3、时刻ti-4的深度,由自主水下机器人搭载的深度传感器直接测量。
6.根据权利要求5所述的适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,步骤4)包括:
计算信标在时刻tk的方差估计Pk和位置估计计算方法为:
其中,Pk表示信标在时刻tk的方差估计,表示信标在时刻tk的位置估计;Pk-1表示信标在时刻tk-1的方差估计,/>表示信标在时刻tk-1的位置估计;Kk表示信标在时刻tk的估计增益,Yk表示由不同时刻信标测距组成的列向量,Rk表示在信标标定过程中,自主水下机器人因本体航行运动而引入的tk时刻量测噪声,/>是中间变量,Pk-1表示前一时刻tk-1的方差估计,u(tk)表示自主水下机器人在tk时刻的航行速度,由自主水下机器人搭载的多普勒计程仪直接测量,ψ(tk)和θ(tk)分别表示自主水下机器人在时刻tk的航向角、纵倾角,由自主水下机器人搭载的深水罗经直接测量,/>是深水罗经和多普勒计程仪的矩阵,dialog(.)表示对角线矩阵算子,σu是多普勒计程仪的测速精度,σψ是深水罗经的航向精度,/>表示自主水下机器人搭载的测距仪的测量方差,Ri、Ri-1、Ri-2、Ri-3、Ri-4分别表示信标与自主水下机器人的测距,它们由自主水下机器人搭载的测距仪提供,I表示单位矩阵,它是常数,k表示时刻tk的时间索引。
7.根据权利要求6所述的适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,当k=0时即当前时刻是初始时刻,Pk和分别等于初始时刻的位置估计/>和方差估计P0。
8.根据权利要求7所述的适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,所述结束条件为:
其中||·||2表示2范数算子,表示从时刻tk-20到时刻tk的相邻位置估计2范数的期望,αc是信标标定精度阈值,k表示时刻tk的时间索引,for是表示期望计算范围的关键字。
9.根据权利要求1所述的适用于极地冰架下环境的自主水下机器人的组合导航方法,其特征在于,步骤6)包括:
根据tk时刻测距仪提供的自主水下机器人与信标的距离、信标标定位置结合自主水下机器人本身航位推算位置,对自主水下机器人进行导航。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010198740.6A CN111928850B (zh) | 2020-03-20 | 2020-03-20 | 适用于极地冰架下环境的自主水下机器人的组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010198740.6A CN111928850B (zh) | 2020-03-20 | 2020-03-20 | 适用于极地冰架下环境的自主水下机器人的组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111928850A CN111928850A (zh) | 2020-11-13 |
CN111928850B true CN111928850B (zh) | 2023-12-29 |
Family
ID=73317508
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010198740.6A Active CN111928850B (zh) | 2020-03-20 | 2020-03-20 | 适用于极地冰架下环境的自主水下机器人的组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111928850B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112986902B (zh) * | 2021-02-23 | 2022-07-19 | 自然资源部第三海洋研究所 | 单检波器跨冰层对水中宽带声源分频段方位估计方法 |
CN113190025B (zh) * | 2021-05-07 | 2023-09-12 | 中国科学院沈阳自动化研究所 | 一种适用于变结构水下机器人的运动控制方法 |
CN114234964B (zh) * | 2021-11-05 | 2024-06-14 | 河北汉光重工有限责任公司 | 一体化自主式水下潜器在冰层下的定位方法及*** |
CN114088098B (zh) * | 2021-11-16 | 2024-06-28 | 哈尔滨工程大学 | 一种用于极区水下航行器数据库辅助导航路径规划方法 |
CN114200929B (zh) * | 2021-11-24 | 2023-10-20 | 中国科学院沈阳自动化研究所 | 多水下机器人最大探测覆盖率的快速梳型路径规划方法 |
CN114228959B (zh) * | 2021-12-29 | 2023-03-21 | 中国科学院沈阳自动化研究所 | 一种基于声学路标与光学路标组合辅助导航的水下机器人极地冰下回收方法 |
CN114644087B (zh) * | 2021-12-31 | 2023-03-28 | 自然资源部第二海洋研究所 | 一种适用于冰区的短基线承载结构 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2009039488A1 (en) * | 2007-09-21 | 2009-03-26 | Hydroid, Inc. | Autonomous underwater vehicle used to calibrate a long baseline navigation network |
CN106679662A (zh) * | 2015-11-06 | 2017-05-17 | 中国科学院沈阳自动化研究所 | 一种基于tma技术的水下机器人单信标组合导航方法 |
KR101789188B1 (ko) * | 2016-05-11 | 2017-10-24 | 한국해양과학기술원 | 수중 이동체의 위치 추적을 위한 수중 통합 항법 시스템 |
CN110207695A (zh) * | 2019-05-28 | 2019-09-06 | 哈尔滨工程大学 | 一种适用于深海auv的无速度辅助单信标定位方法 |
CN110646783A (zh) * | 2019-09-30 | 2020-01-03 | 哈尔滨工程大学 | 一种水下航行器的水下信标定位方法 |
CN110779518A (zh) * | 2019-11-18 | 2020-02-11 | 哈尔滨工程大学 | 一种具有全局收敛性的水下航行器单信标定位方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2001065274A1 (en) * | 2000-03-03 | 2001-09-07 | Mikael Bliksted Larsen | Methods and systems for navigating under water |
US20190204430A1 (en) * | 2017-12-31 | 2019-07-04 | Woods Hole Oceanographic Institution | Submerged Vehicle Localization System and Method |
-
2020
- 2020-03-20 CN CN202010198740.6A patent/CN111928850B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2009039488A1 (en) * | 2007-09-21 | 2009-03-26 | Hydroid, Inc. | Autonomous underwater vehicle used to calibrate a long baseline navigation network |
CN106679662A (zh) * | 2015-11-06 | 2017-05-17 | 中国科学院沈阳自动化研究所 | 一种基于tma技术的水下机器人单信标组合导航方法 |
KR101789188B1 (ko) * | 2016-05-11 | 2017-10-24 | 한국해양과학기술원 | 수중 이동체의 위치 추적을 위한 수중 통합 항법 시스템 |
CN110207695A (zh) * | 2019-05-28 | 2019-09-06 | 哈尔滨工程大学 | 一种适用于深海auv的无速度辅助单信标定位方法 |
CN110646783A (zh) * | 2019-09-30 | 2020-01-03 | 哈尔滨工程大学 | 一种水下航行器的水下信标定位方法 |
CN110779518A (zh) * | 2019-11-18 | 2020-02-11 | 哈尔滨工程大学 | 一种具有全局收敛性的水下航行器单信标定位方法 |
Non-Patent Citations (3)
Title |
---|
Navigation Calibration Algorithm Assisted by Single Beacon;Zhang Jucheng et al.;《2019 IEEE International Conference on Signal Processing, Communications and Computing (ICSPCC)》;1-5 * |
基于单信标测距的水下载体定位研究;曹俊;《中国博士学位论文全文数据库 (工程科技Ⅱ辑)》;C028-27 * |
基于随机信标的水下SLAM导航方法;刘明雍;董婷婷;张立川;;***工程与电子技术(第12期);168-172 * |
Also Published As
Publication number | Publication date |
---|---|
CN111928850A (zh) | 2020-11-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111928850B (zh) | 适用于极地冰架下环境的自主水下机器人的组合导航方法 | |
CN105823480B (zh) | 基于单信标的水下移动目标定位算法 | |
CN102829777B (zh) | 自主式水下机器人组合导航***及方法 | |
CN111595348B (zh) | 一种自主水下航行器组合导航***的主从式协同定位方法 | |
Vaganay et al. | Homing by acoustic ranging to a single beacon | |
CN111829512B (zh) | 一种基于多传感器数据融合的auv导航定位方法及*** | |
CN106679662B (zh) | 一种基于tma技术的水下机器人单信标组合导航方法 | |
CN103697910B (zh) | 自主水下航行器多普勒计程仪安装误差的校正方法 | |
CN107990891B (zh) | 基于长基线和信标在线标定的水下机器人组合导航方法 | |
CN104316045A (zh) | 一种基于sins/lbl的auv水下交互辅助定位***及定位方法 | |
Hegrenæs et al. | Underwater transponder positioning and navigation of autonomous underwater vehicles | |
PT1275012E (pt) | Métodos e sistemas de navegação subaquática | |
CN102052924A (zh) | 一种小型水下机器人组合导航定位方法 | |
CN107966145B (zh) | 一种基于稀疏长基线紧组合的auv水下导航方法 | |
CN101900558A (zh) | 集成声纳微导航的自主式水下机器人组合导航方法 | |
CN102636771A (zh) | 一种基于双移动信标的auv水下声学定位方法 | |
CN106017467A (zh) | 一种基于多水下应答器的惯性/水声组合导航方法 | |
CN102288170A (zh) | 一种水下航行器内电子罗盘的校正方法 | |
Matsuda et al. | Accurate and efficient seafloor observations with multiple autonomous underwater vehicles: Theory and experiments in a hydrothermal vent field | |
CN114509069B (zh) | 基于蓝牙aoa和imu融合的室内导航定位*** | |
CN104776847B (zh) | 一种适用于水下导航***单点估计陀螺漂移的方法 | |
Baccou et al. | Simulation results, post-processing experimentations and comparisons results for navigation, homing and multiple vehicles operations with a new positioning method using on transponder | |
CN112747748A (zh) | 一种基于逆向解算的领航auv导航数据后处理方法 | |
CN111735455A (zh) | 基于改进的高斯距离迭代算法对接回收组合导航方法 | |
CN111189446B (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 |