CN115930951A - 一种基于多传感器组合的短期水下auv隐蔽导航方法 - Google Patents

一种基于多传感器组合的短期水下auv隐蔽导航方法 Download PDF

Info

Publication number
CN115930951A
CN115930951A CN202211707790.8A CN202211707790A CN115930951A CN 115930951 A CN115930951 A CN 115930951A CN 202211707790 A CN202211707790 A CN 202211707790A CN 115930951 A CN115930951 A CN 115930951A
Authority
CN
China
Prior art keywords
auv
underwater
information
navigation
acoustic
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
Application number
CN202211707790.8A
Other languages
English (en)
Inventor
卢秀山
李国玉
刘以旭
王胜利
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Qingdao Xiushan Mobile Surveying Co ltd
Original Assignee
Qingdao Xiushan Mobile Surveying Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Qingdao Xiushan Mobile Surveying Co ltd filed Critical Qingdao Xiushan Mobile Surveying Co ltd
Publication of CN115930951A publication Critical patent/CN115930951A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/165Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/203Specially adapted for sailing ships
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18Position-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/22Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements

Abstract

本发明公开了一种基于多传感器组合的短期水下AUV隐蔽导航方法,属于船用设备技术领域,用于AUV的隐蔽导航定位,包括采用精确的自适应声线跟踪算法得到精确的声学定位的基础上,在浅水AUV隐蔽导航时,将声学定位结果、惯性导航结果和深度计通过自适应神经网络算法得到准确的高频位置、速度和姿态信息并进行导航;在深水区AUV隐蔽导航时,则是依赖声学定位结果、惯性导航结果、深度计和多普勒测速仪传感器进行数据融合。而声学定位设备是安装在海面按一定构型布设的无人船编队上。本发明在无卫星导航系统辅助下,通过多传感器的组合实现对水下AUV的短期隐蔽导航。

Description

一种基于多传感器组合的短期水下AUV隐蔽导航方法
技术领域
本发明公开了一种基于多传感器组合的短期水下AUV隐蔽导航方法,属于导航技术领域。
背景技术
随着国家透明海洋战略的提出和发展,海洋资源开发成为了各海洋强国的重要发展目标,海洋中蕴藏了丰富的天然气、石油资源亟待开发。海底管道铺设、海洋科考、海洋救援等活动都需要知道自己所处的位置信息,水下航行器的发展无疑成为了海洋各项活动必不可少的工具。目前卫星导航系统是最为稳定、精度最高的定位方式被应用于军事、农业、汽车自动驾驶等各个领域。它是通过接受卫星发射的测距码或载波相位精确测量卫星到接收机的距离,通过后方距离教会实现定位。在陆地上或近海可以通过RTK相对定位实现厘米级—分米级的定位精度,在远海场景下一般通过精密单点定位或星站差分技术实现精准定位。但是在一些,因为卫星导航系统存在天然的脆弱性,即容易被跟踪和干扰,因此在隐蔽AUV导航等特殊场景下无法使用。AUV由于体积小、活动范围广、隐蔽性高的优点而在军事、民用等各个领域被广泛应用,例如水下侦察、海底地形探测、海事救援、水下光电缆铺设等。
在某些特殊应用场景下,AUV需要进行隐蔽性导航,特别是在一些军事活动中不能借助外部容易侦察和干扰的信号,此时卫星导航系统就无法提供给载体平台位置信息。惯性导航系统是采用航位推算的方式实现导航定位,不需要外部信息的输入性,因具有极强的隐蔽性而用在潜艇、导弹等军事设施中,它的原理是用牛顿积分对加速度计和陀螺仪输出的信息进行积分得到位置、速度和姿态信息。该系统不需要依赖外界信息,也不会向外界辐射能量,具有很好的隐蔽性,但存在误差累积的问题,因此需要配合多种传感器一起进行使用。长基线水声定位系统的定位精度高,配合惯性导航系统及其它辅助系统可以实现短期对AUV的导航。
发明内容
本发明公开了一种基于多传感器组合的短期水下AUV隐蔽导航方法,以解决现有技术中,AUV水下定位精度较低的问题。
一种基于多传感器组合的短期水下AUV隐蔽导航方法,包括:
S1.船底的水声换能器以一定的频率发射声学信号,位于AUV上的应答器接收到信号后反射应答信号到水声换能器;
S2.当存在三个及以上的海面观测值时,存在冗余观测,通过最小二乘估计得到最优位置信息;
S3.使用声线跟踪算法实现精确定位;
S4.使用声线跟踪算法获得声信号最小行程传播时间ti,ti=F(Xs,SVP,Xr),其中F为声线跟踪算法的本征声线搜索函数,Xs为(xs,ys,zs),xr为(xr,yr,zr),SVP为声速剖面;
ti与实际测得的传播时间Ti做差,得到时间差△ti,△ti=ti-Ti,ti乘以声速c得到声信号的传播距离lM,Ti乘以声速c得到实际测得的传播距离lN,lM-lN=l;
设换能器的位置为(xs,ys,zs),应答器的位置为(xr,yr,zr),在应答器概略位置
Figure BDA0004025352410000021
展开,得线性化误差观测方程公式:
Figure BDA0004025352410000022
式中,v表示误差,k、m、n为可计算得到的参数,k=Δx0,m=Δy0,n=Δz0
Figure BDA0004025352410000023
Figure BDA0004025352410000024
Figure BDA0004025352410000025
ρ0为概略位置的测距信息,ρi为第i个点的测距信息,
Figure BDA0004025352410000026
为ρi的误差;
当存在个N个海面观测值时,误差方程表示为:
V=AX+F
Figure BDA0004025352410000027
则最小二乘解表示为:
X=-(ATPA)-1ATPA
上述过程实现对声速变化引起的声线弯曲误差的改正;
S5.进行AUV的隐蔽导航,根据传感器的精度和适用环境的不同,AUV的导航分为两种情景:浅水导航和深水导航,导航传感器的选择根据深度计信息自由切换。
S1包括:通过测量声信号的传播时间乘以声信号传播速度得到距离:
ρs=csts=‖x-xs2ρ,式中ρs表示测距信息,cs表示声信号传播的声速,ts表示信号传播时间,s∈{1,2,...,N},N表示无人船的数量;‖x-xs2为水声换能器和应答器之间的欧氏距离;ερ为等效测距误差。
S3包括:由射线声学基本理论,第i层的声线轨迹曲率为:
Figure BDA0004025352410000028
式中,θ表示声信号入射角,s表示信号传播路径,z表示深度,α表示掠射角,c为声速;
对于等声速梯度层,声速梯度gi为常数,表示为:
Figure BDA0004025352410000029
ci为第i层水层的声速,zi为第i层水层的深度,θi为第i层水层的声信号入射角,αi为第i层水层的掠射角;
声线在层内的实际轨迹为一段圆弧,求出第i层水层的传播时间ti及水平传播距离yi
Figure BDA0004025352410000031
Figure BDA0004025352410000032
S4包括:声速的确定采用一种自适应方法,声速c的大小根据AUV所处的深度zi决定,将水层分为浅水层和深水层,分别采用不同的声速,则实际的距离L表示为:L=c(zi)·△ti,其中c(zi)表示声速c是关于zi的函数。
S5包括:
浅水导航情景:
AUV的位置信息为:P1=f1(X,S),式中,P1表示AUV的位置信息,f1(·)表示位置融合函数,X,S分别表示通过长基线定位得到的位置和惯导输出的信息经过两次积分得到的位置;
AUV的速度信息V1在浅水由惯导系统通过对加速度信息积分得到;
AUV的姿态信息为:
Figure BDA0004025352410000033
式中,A表示AUV的姿态信息,f2(·)表示姿态融合函数,φ,
Figure BDA0004025352410000034
分别表示通过4深度计得到的姿态和惯导输出的姿态信息;
AUV运动速度过大时,惯导姿态输出不稳定,借助多深度计辅助测量横滚角和俯仰角;
将4个深度计安装在AUV上,构成一个长为a,宽为b的长方形;通过姿态角的定位和长方形的位置关系可以求得姿态变化矩阵R,从而求出姿态信息φ;
深水导航情景:
AUV的位置信息为:P2=f3(X1,D),式中,P2表示AUV的位置信息f3(·)表示位置融合函数,X1,D分别表示通过长基线定位得到的位置和多普勒测速仪输出的信息经过一次积分得到的位置;
AUV的速度信息V2在深水区由多普勒测速仪提供。
f1(·)、f2(·)、f3(·)统称为融合函数f(·),融合函数f(·)采用自适应的反馈性神经网络算法,将单个传感器先放置到一个黑匣子中进行可靠性
Figure BDA0004025352410000035
评估,评估可靠性
Figure BDA0004025352410000036
后赋予适用于该传感器的权阵Wi,权阵的大小决定了该传感器提供数据的占比,通过数据的训练得到一个最优的神经网络Net,将融合后的结果与水声定位的结果进行做差Δ,根据偏差信息进行新的确权后重新进行滤波,直到得到满足限差∈的结果。
所述无人船为三艘时,在海面呈“等边三角形”布设。
所述无人船为四艘时,在海面呈“正方形”布设。
AUV上搭载惯性导航系统、深度计、多普勒测速仪、数据处理中心和水声换能器;
所述惯性导航系统搭载在无人船和水下AUV上,惯性导航系统进行安装校准后,多艘无人船进行时间同步,完成初始化,惯性导航系统实时高频输出无人船的位置、速度和位置信息;
所述水下AUV上根据任务需求搭载测量传感器、机械臂、动力模块、水声应答器和数据处理中心;
所述水声换能器安装在无人船的船底,多艘搭载水声换能器的无人船组成长基线定位系统,所述长基线定位系统与惯性导航系统组合,通过长基线水声定位算法对水下AUV进行导航定位;
数据处理中心将测得的数据进行数据处理,再对数据进行本地存储后。
四艘无人船上的惯性导航系统实时输出高频的三轴加速度和角速度增量,通过积分得到无人船的位置、速度和姿态信息,水下AUV位于正方形的中心点水下深处,无人船通过声学通讯实时接收AUV的几何中心,并自适应调整自己的位置,确保AUV处于几何中心;
惯性导航系统给出本身的位置、速度和姿态信息,通过对惯性导航系统和长基线定位系统的深组合,经过自适应神经网络算法得到水下AUV连续的位置信息并预测下一时刻的位置信息,实现对水下AUV的隐蔽导航;
船只的控制系统根据自身的惯性导航系统输出的位置、速度和姿态信息实时调整,控制实际轨迹与设定好的轨迹一致。
与现有技术相比,本发明的有益效果为,在无卫星导航系统辅助下,通过惯性导航系统实现对海面载体平台的定位,再通过长基线水声定位实现对水下AUV的短期隐蔽,在此过程中也考虑了海面构型以及声速误差对定位的影响,进行误差改正后有效提高了导航定位的准确性和可靠性;创新性地提出将水层分为深水层和浅水层,并根据深度计信息自由切换不同传感器作为滤波的输入信息,并提出一下黑盒自适应神经网络算法用于多传感器的数据融合,可以解决水下环境在非线性和非高斯噪声影响下的精确导航。
附图说明
图1是本发明所用测量设备的示意图。
附图标记包括:1-应答器,2-水声换能器,3-惯性导航系统,4-AUV,5-无人船,6-深度计,7-多普勒测速仪。
具体实施方式
下面结合具体实施方式对本发明作进一步详细说明:
一种基于多传感器组合的短期水下AUV4隐蔽导航方法,包括:
S1.船底的水声换能器2以一定的频率发射声学信号,位于AUV4上的应答器1接收到信号后反射应答信号到水声换能器2,通过测量声信号的传播时间乘以声信号传播速度得到距离:ρs=csts=‖x-xs2ρ,式中ρs表示测距信息,cs表示声信号传播的声速,ts表示信号传播时间,s∈{1,2,...,N},N表示无人船5的数量;‖x-xs2为水声换能器2和应答器1之间的欧氏距离;ερ为等效测距误差;
S2.当存在三个及以上的海面观测值时,存在冗余观测,通过最小二乘估计得到最优位置信息;
S3.使用声线跟踪算法实现精确定位,包括:
由射线声学基本理论,第i层的声线轨迹曲率为:
Figure BDA0004025352410000051
式中,θ表示声信号入射角,s表示信号传播路径,z表示深度,α表示掠射角,c为声速;
对于等声速梯度层,声速梯度gi为常数,表示为:
Figure BDA0004025352410000052
ci为第i层水层的声速,zi为第i层水层的深度,θi为第i层水层的声信号入射角,αi为第i层水层的掠射角;
声线在层内的实际轨迹为一段圆弧,求出第i层水层的传播时间ti及水平传播距离yi
Figure BDA0004025352410000053
Figure BDA0004025352410000054
S4.使用声线跟踪算法获得声信号最小行程传播时间ti,ti=F(Xs,SVP,Xr),其中F为声线跟踪算法的本征声线搜索函数,Xs为(xs,ys,zs),Xr为(xr,yr,zr),SVP为声速剖面;
ti与实际测得的传播时间Ti做差,得到时间差△ti,△ti=ti-Ti,ti乘以声速c得到声信号的传播距离lM,Ti乘以声速c得到实际测得的传播距离lN,lM-lN=l;
设换能器的位置为(xs,ys,zs),应答器的位置为(xr,yr,zr),在应答器概略位置
Figure BDA0004025352410000055
展开,得线性化误差观测方程公式:
Figure BDA0004025352410000056
式中,v表示误差,k、m、n为可计算得到的参数,k=Δx0,m=Δy0,n=Δz0
Figure BDA0004025352410000057
Figure BDA0004025352410000058
Figure BDA0004025352410000059
ρ0为概略位置的测距信息,ρi为第i个点的测距信息,
Figure BDA00040253524100000510
为ρi的误差;
当存在个N个海面观测值时,误差方程表示为:
V=AX+F
Figure BDA0004025352410000061
则最小二乘解表示为:
X=-(ATPA)-1ATPL
上述过程实现对声速变化引起的声线弯曲误差的改正;
声速的确定采用一种自适应方法,声速c的大小根据AUV4所处的深度zi决定,将水层分为浅水层和深水层,分别采用不同的声速,则实际的距离L表示为:L=c·zi·△ti,其中c(zi)表示声速c是关于zi的函数;
S5.进行AUV4的隐蔽导航;
根据传感器的精度和适用环境的不同,AUV4的导航分为两种情景:浅水导航和深水导航,导航传感器的选择可根据深度计6信息自由切换;
浅水导航情景:
AUV4的位置信息为:P1=f1(X,S),式中,P1表示AUV4的位置信息,f1(·)表示位置融合函数,X,S分别表示通过长基线定位得到的位置和惯导输出的信息经过两次积分得到的位置;
AUV4的速度信息V1在浅水由惯导系统提供;
AUV4的姿态信息为:
Figure BDA0004025352410000062
式中,A表示AUV4的姿态信息,f2(·)表示姿态融合函数,φ,
Figure BDA0004025352410000063
分别表示通过4深度计6得到的姿态和惯导输出的姿态信息;
AUV4运动速度过大时,惯导姿态输出不稳定,借助多深度计6辅助测量横滚角和俯仰角;
将4个深度计6安装在AUV4上,构成一个长为a,宽为b的长方形;通过姿态角的定位和长方形的位置关系可以求得姿态变化矩阵R,从而求出姿态信息φ;
深水导航情景:
AUV4的位置信息为:P2=f3(X1,D),式中,P2表示AUV4的位置信息f3(·)表示位置融合函数,X1,D分别表示通过长基线定位得到的位置和多普勒测速仪7输出的信息经过一次积分得到的位置;
AUV4的速度信息V2在深水区由多普勒测速仪7提供,其在深水区距离海底更近,声波反射强度更好,精度更高;
融合函数f(·)采用自适应的反馈性神经网络算法,将单个传感器先放置到一个黑匣子中进行可靠性
Figure BDA0004025352410000064
评估,评估可靠性
Figure BDA0004025352410000065
后赋予适用于该传感器的权阵Wi,权阵的大小决定了该传感器提供数据的占比,通过数据的训练可以得到一个最优的神经网络Net,将融合后的结果与水声定位的结果进行做差Δ,根据偏差信息进行新的确权后重新进行滤波,直到得到满足限差∈的结果。
所述无人船5为三艘时,在海面呈“等边三角形”布设。
所述无人船5为四艘时,在海面呈“正方形”布设。
AUV4上搭载惯性导航系统3、深度计6、多普勒测速仪7、数据处理中心和水声换能器2;
所述惯性导航系统3搭载在无人船5和水下AUV4上,惯性导航系统3进行安装校准后,多艘无人船5进行时间同步,完成初始化,惯性导航系统3实时高频输出无人船5的位置、速度和位置信息;
所述水下AUV4上根据任务需求搭载测量传感器、机械臂、动力模块、水声应答器1和数据处理中心;
所述水声换能器2安装在无人船5的船底,多艘搭载水声换能器2的无人船5组成长基线定位系统,所述长基线定位系统与惯性导航系统3组合,通过长基线水声定位算法对水下AUV4进行导航定位;
数据处理中心将测得的数据进行数据处理,再对数据进行本地存储后。
四艘无人船5上的惯性导航系统3实时输出高频的三轴加速度和角速度增量,通过积分得到无人船5的位置、速度和姿态信息,水下AUV4位于正方形的中心点水下深处,无人船5通过声学通讯实时接收AUV4的几何中心,并自适应调整自己的位置,确保AUV4处于几何中心。
惯性导航系统3给出本身的位置、速度和姿态信息,通过对惯性导航系统3和长基线定位系统的深组合,经过黑盒自适应神经网络算法得到水下AUV4连续的位置信息并预测下一时刻的位置信息,实现对水下AUV4的隐蔽导航。
所述控制系统根据自身的惯性导航系统3输出的位置、速度和姿态信息实时调整,控制实际轨迹与设定好的轨迹一致。
如图1,本发明将高精度惯导系统分别安装在四艘小型无人船5和水下AUV4上,但由于惯性导航系统3本身误差会随时间累积,即使采用高精度惯导,长时间导航后无人船5的位置信息仍变得不可靠,因此本发明适用于短期水下AUV4隐蔽导航。
无人船5及控制模块由三艘及以上的小型无人船5、控制模块和数据处理模块组成,采用三艘及以上的无人船5是因为要组成用于水下定位的长基线定位基阵。由于无人船5作为短期AUV4导航提供基准传递的海面载体,工作时间一般在几十分钟到几个小时,所以无人船5所需的动力由大电池提供。
惯性导航模块采用高精度导航级的MEMS惯导传感器,确保能提供高精度的输出。将惯导传感器分别安装在四艘无人船5和水下AUV4上,在开始工作前需要进行传感器的初始校准和“找北”,确保输出稳定的加速度计和陀螺仪增量。
动力模块也是用大电池提供动力用于短期航行。水声应答器1用于接受换能器发射的信号并进行应答。数据处理中心用于进行数据处理和数据本地存储,其中数据处理包括进行长基线定位解算、与惯性导航系统3的紧组合导航以及相应的误差改正。
数据处理中心根据水域先前测得的海面温盐深信息得到区域的声速剖面数据,用于改正声速误差带来的测距误差影响,可以有效提高水声定位的精度。将长基线定位的结果与惯性导航系统3的结果进行紧组合,采用卡尔曼滤波算法对水下AUV4进行导航。
本发明实现了在没有卫星导航系统辅助的情况下的水下AUV4的导航定位,无需借助外部信息的输入,具有隐蔽性,在一些特殊场景下可以提供短期的高精度导航。
当然,上述说明并非是对本发明的限制,本发明也并不仅限于上述举例,本技术领域的技术人员在本发明的实质范围内所做出的变化、改型、添加或替换,也应属于本发明的保护范围。

Claims (10)

1.一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,包括:
S1.船底的水声换能器以一定的频率发射声学信号,位于AUV上的应答器接收到信号后反射应答信号到水声换能器;
S2.当存在三个及以上的海面观测值时,存在冗余观测,通过最小二乘估计得到最优位置信息;
S3.使用声线跟踪算法实现精确定位;
S4.使用声线跟踪算法获得声信号最小行程传播时间ti,ti=F(Xs,SVP,Xr),其中F为声线跟踪算法的本征声线搜索函数,Xs为(xs,ys,zs),Xr为(xr,yr,zr),SVP为声速剖面;
ti与实际测得的传播时间Ti做差,得到时间差Δti,Δti=ti-Ti,ti乘以声速c得到声信号的传播距离lM,Ti乘以声速c得到实际测得的传播距离lN,lM-lN=l;
设换能器的位置为(xs,ys,zs),应答器的位置为(xr,yr,zr),在应答器概略位置
Figure FDA0004025352400000015
展开,得线性化误差观测方程公式:
Figure FDA0004025352400000011
式中,v表示误差,k、m、n为可计算得到的参数,k=Δx0,m=Δy0,n=Δz0
Figure FDA0004025352400000012
Figure FDA0004025352400000013
l=ρ0iρi,ρ0为概略位置的测距信息,ρi为第i个点的测距信息,ερi为ρi的误差;
当存在个N个海面观测值时,误差方程表示为:
V=AX+F
Figure FDA0004025352400000014
则最小二乘解表示为:
X=-(ATPA)-1ATPL
上述过程实现对声速变化引起的声线弯曲误差的改正;
S5.进行AUV的隐蔽导航,根据传感器的精度和适用环境的不同,AUV的导航分为两种情景:浅水导航和深水导航,导航传感器的选择根据深度计信息自由切换。
2.根据权利要求1所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,S1包括:通过测量声信号的传播时间乘以声信号传播速度得到距离:
ρs=csts=||x-xs||2ρ,式中ρs表示测距信息,cs表示声信号传播的声速,ts表示信号传播时间,s∈{1,2,...,N},N表示无人船的数量;||x-xs||2为水声换能器和应答器之间的欧氏距离;ερ为等效测距误差。
3.根据权利要求2所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,S3包括:由射线声学基本理论,第i层的声线轨迹曲率为:
Figure FDA0004025352400000021
式中,θ表示声信号入射角,s表示信号传播路径,z表示深度,α表示掠射角,c为声速;
对于等声速梯度层,声速梯度gi为常数,表示为:
Figure FDA0004025352400000022
ci为第i层水层的声速,zi为第i层水层的深度,θi为第i层水层的声信号入射角,αi为第i层水层的掠射角;
声线在层内的实际轨迹为一段圆弧,求出第i层水层的传播时间ti及水平传播距离yi
Figure FDA0004025352400000023
Figure FDA0004025352400000024
4.根据权利要求3所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,S4包括:声速的确定采用一种自适应方法,声速c的大小根据AUV所处的深度zi决定,将水层分为浅水层和深水层,分别采用不同的声速,则实际的距离L表示为:L=c(zi)·△ti,其中c(zi)表示声速c是关于zi的函数。
5.根据权利要求4所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,S5包括:
浅水导航情景:
AUV的位置信息为:P1=f1(X,S),式中,P1表示AUV的位置信息,f1(·)表示位置融合函数,X,S分别表示通过长基线定位得到的位置和惯导输出的信息经过两次积分得到的位置;
AUV的速度信息V1在浅水由惯导系统通过对加速度信息积分得到;
AUV的姿态信息为:
Figure FDA0004025352400000025
式中,A表示AUV的姿态信息,f2(·)表示姿态融合函数,φ,
Figure FDA0004025352400000026
分别表示通过4深度计得到的姿态和惯导输出的姿态信息;
AUV运动速度过大时,惯导姿态输出不稳定,借助多深度计辅助测量横滚角和俯仰角;
将4个深度计安装在AUV上,构成一个长为a,宽为b的长方形;通过姿态角的定位和长方形的位置关系可以求得姿态变化矩阵R,从而求出姿态信息φ;
深水导航情景:
AUV的位置信息为:P2=f3(X1,D),式中,P2表示AUV的位置信息f3(·)表示位置融合函数,X1,D分别表示通过长基线定位得到的位置和多普勒测速仪输出的信息经过一次积分得到的位置;
AUV的速度信息V2在深水区由多普勒测速仪提供。
6.根据权利要求5所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,f1(·)、f2(·)、f3(·)统称为融合函数f(·),融合函数f(·)采用自适应的反馈性神经网络算法,将单个传感器先放置到一个黑匣子中进行可靠性
Figure FDA0004025352400000031
评估,评估可靠性
Figure FDA0004025352400000032
后赋予适用于该传感器的权阵Wi,权阵的大小决定了该传感器提供数据的占比,通过数据的训练得到一个最优的神经网络Net,将融合后的结果与水声定位的结果进行做差Δ,根据偏差信息进行新的确权后重新进行滤波,直到得到满足限差∈的结果。
7.根据权利要求6所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,所述无人船为三艘时,在海面呈“等边三角形”布设。
8.根据权利要求6所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,所述无人船为四艘时,在海面呈“正方形”布设。
9.根据权利要求8所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,AUV上搭载惯性导航系统、深度计、多普勒测速仪、数据处理中心和水声换能器;
所述惯性导航系统搭载在无人船和水下AUV上,惯性导航系统进行安装校准后,多艘无人船进行时间同步,完成初始化,惯性导航系统实时高频输出无人船的位置、速度和位置信息;所述水下AUV上根据任务需求搭载测量传感器、机械臂、动力模块、水声应答器和数据处理中心;所述水声换能器安装在无人船的船底,多艘搭载水声换能器的无人船组成长基线定位系统,所述长基线定位系统与惯性导航系统组合,通过长基线水声定位算法对水下AUV进行导航定位;数据处理中心将测得的数据进行数据处理,再对数据进行本地存储后。
10.根据权利要求9所述的一种基于多传感器组合的短期水下AUV隐蔽导航方法,其特征在于,四艘无人船上的惯性导航系统实时输出高频的三轴加速度和角速度增量,通过积分得到无人船的位置、速度和姿态信息,水下AUV位于正方形的中心点水下深处,无人船通过声学通讯实时接收AUV的几何中心,并自适应调整自己的位置,确保AUV处于几何中心;
惯性导航系统给出本身的位置、速度和姿态信息,通过对惯性导航系统和长基线定位系统的深组合,经过自适应神经网络算法得到水下AUV连续的位置信息并预测下一时刻的位置信息,实现对水下AUV的隐蔽导航;
船只的控制系统根据自身的惯性导航系统输出的位置、速度和姿态信息实时调整,控制实际轨迹与设定好的轨迹一致。
CN202211707790.8A 2022-09-16 2022-12-29 一种基于多传感器组合的短期水下auv隐蔽导航方法 Pending CN115930951A (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN2022111252532 2022-09-16
CN202211125253.2A CN115200571A (zh) 2022-09-16 2022-09-16 一种基于多传感器组合的短期水下auv隐蔽导航方法

Publications (1)

Publication Number Publication Date
CN115930951A true CN115930951A (zh) 2023-04-07

Family

ID=83572353

Family Applications (2)

Application Number Title Priority Date Filing Date
CN202211125253.2A Pending CN115200571A (zh) 2022-09-16 2022-09-16 一种基于多传感器组合的短期水下auv隐蔽导航方法
CN202211707790.8A Pending CN115930951A (zh) 2022-09-16 2022-12-29 一种基于多传感器组合的短期水下auv隐蔽导航方法

Family Applications Before (1)

Application Number Title Priority Date Filing Date
CN202211125253.2A Pending CN115200571A (zh) 2022-09-16 2022-09-16 一种基于多传感器组合的短期水下auv隐蔽导航方法

Country Status (1)

Country Link
CN (2) CN115200571A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116628396A (zh) * 2023-07-25 2023-08-22 浙江大学海南研究院 一种基于平滑插值的水下装备声线弯曲修正方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116628396A (zh) * 2023-07-25 2023-08-22 浙江大学海南研究院 一种基于平滑插值的水下装备声线弯曲修正方法
CN116628396B (zh) * 2023-07-25 2024-02-02 浙江大学海南研究院 一种基于平滑插值的水下装备声线弯曲修正方法

Also Published As

Publication number Publication date
CN115200571A (zh) 2022-10-18

Similar Documents

Publication Publication Date Title
US9372255B2 (en) Determining a position of a submersible vehicle within a body of water
Bao et al. Integrated navigation for autonomous underwater vehicles in aquaculture: A review
Kinsey et al. A survey of underwater vehicle navigation: Recent advances and new challenges
Vaganay et al. Homing by acoustic ranging to a single beacon
US8004930B2 (en) Methods and systems for determining coordinates of an underwater seismic component in a reference frame
CN111829512B (zh) 一种基于多传感器数据融合的auv导航定位方法及系统
Chutia et al. A review of underwater robotics, navigation, sensing techniques and applications
CN101900558B (zh) 集成声纳微导航的自主式水下机器人组合导航方法
CN104316045A (zh) 一种基于sins/lbl的auv水下交互辅助定位系统及定位方法
KR100906362B1 (ko) 2개의 기준점에 대한 거리정보와 저정밀도 관성센서를 이용한 무인잠수정 선단의 의사 lbl 수중항법시스템
WO2008144139A1 (en) System and process for the precise positioning of subsea units
CN105486313A (zh) 一种基于usbl辅助低成本sins系统的定位方法
CN110806209A (zh) 一种水下机器人多设备组合导航系统及方法
CN112684207B (zh) 一种深潜载人潜水器adcp速度估计与修正算法
Kinsey et al. Towards in-situ calibration of gyro and doppler navigation sensors for precision underwater vehicle navigation
CN111735455A (zh) 基于改进的高斯距离迭代算法对接回收组合导航方法
CN115930951A (zh) 一种基于多传感器组合的短期水下auv隐蔽导航方法
Lee et al. An integrated navigation system for autonomous underwater vehicles with two range sonars, inertial sensors and Doppler velocity log
CN104061930A (zh) 基于捷联惯性制导和多普勒计程仪的导航方法
Armstrong et al. Field measurement of surface ship magnetic signature using multiple AUVs
JP5381773B2 (ja) 水中航走体の位置較正方法及び装置
Harris et al. Cooperative acoustic navigation of underwater vehicles without a DVL utilizing a dynamic process model: Theory and field evaluation
Morice et al. Geometric bounding techniques for underwater localisation using range-only sensors
Alamleh et al. Comparative analysis of underwater positioning and navigation systems
Napolitano et al. GAPS, combined USBL+ INS+ GPS tracking system for fast deployable & high accuracy multiple target positioning

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