CN106020212A - 一种uuv海底地形跟踪过程中的航行切换系统及切换方法 - Google Patents

一种uuv海底地形跟踪过程中的航行切换系统及切换方法 Download PDF

Info

Publication number
CN106020212A
CN106020212A CN201610312367.6A CN201610312367A CN106020212A CN 106020212 A CN106020212 A CN 106020212A CN 201610312367 A CN201610312367 A CN 201610312367A CN 106020212 A CN106020212 A CN 106020212A
Authority
CN
China
Prior art keywords
uuv
trim
navigation
height
depth
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
Application number
CN201610312367.6A
Other languages
English (en)
Other versions
CN106020212B (zh
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.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
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 Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201610312367.6A priority Critical patent/CN106020212B/zh
Publication of CN106020212A publication Critical patent/CN106020212A/zh
Application granted granted Critical
Publication of CN106020212B publication Critical patent/CN106020212B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/04Control of altitude or depth
    • G05D1/06Rate of change of altitude or depth
    • G05D1/0692Rate of change of altitude or depth specially adapted for under-water vehicles

Abstract

本发明提供的是一种UUV海底地形跟踪过程中的航行切换系统及切换方法。切换控制模块接收前视探测声纳测量的距前下方海底的距离、测高声纳测量的距正下方海底的高度、姿态传感器测量的纵倾,根据当前的航行状态并利用以上信息判断是否需要进行航行切换,如果需要,将发出相应的切换信号。定高/定深过渡纵倾指令生成模块和定深/定高过渡纵倾指令生成模块产生纵倾指令并传送到纵倾控制器;纵倾控制器根据纵倾指令和实际纵倾、深度控制器根据深度指令和实际深度、高度控制器根据高度指令和实际高度均产生升降舵控制量。本发明可实现UUV海底地形跟踪过程中,遇到海底悬崖时自动切换为定深航行;当UUV跨越海底悬崖后,自动切换回定高航行。

Description

一种UUV海底地形跟踪过程中的航行切换系统及切换方法
技术领域
本发明涉及的是一种UUV(水下无人航行器,Unmanned Underwater Vehicle)的航行控制系统,本发明也涉及的是一种UUV的航行控制方法。具体地说是一种UUV在海底地形跟踪过程中遇到海底悬崖时的航行切换系统及切换方法。
背景技术
海底地形跟踪航行是UUV执行海底地貌勘测、海底目标搜索、海底管线巡检等任务时所必须使用的航行方式,其本质为UUV距离海底定高航行,定高高度通常在距海底30-50米之间以保证有较好的作业效果。然而由于海底地形的复杂性,UUV在海底地形跟踪过程中可能会遇到几百米甚至上千米深的海底悬崖。这种情况下,如果继续进行海底地形跟踪航行,UUV会以大的纵倾跟踪悬崖而深潜,极易发生倾覆事故或直接坠入悬崖。因此为了保证航行的安全,UUV在遇到海底悬崖时必须放弃地形跟踪航行,切换为定深航行,当跨越海底悬崖之后,再切换为定高航行继续跟踪海底地形。因而海底地形跟踪过程中,就要求UUV能够自主判断前方地形是否是海底悬崖。如果是海底悬崖,则需要UUV进行定高/定深航行状态的切换,以保证能够安全的通过悬崖。
关于UUV航迹规划与控制的技术方案已经有很多,但是这些方案并不能实现UUV在海底地形跟踪过程中遇到海底悬崖时为保证航行安全而切换为定深航行,跨越海底悬崖后自动切换回定高航行并继续执行地形跟踪。申请号为201510790254.2的专利文件中公开了一种“基于感知驱动的自航式海底地形地貌测绘系统及测绘方法”,主要解决移动观测设备执行测绘任务时,其探测轨迹覆盖的探测区域不完整问题。能够全面地测量目标区域、精确快速地描绘出水下地形地貌的精细特征,实现了目标区域海底地形的自航式全面测量。虽然该技术方案能实现海底地形的自航式全面测量,但并没有解决UUV在海底地形跟踪过程中遇到海底悬崖时如何切换为定深航行,跨越海底悬崖后自动切换回定高航行的问题。
发明内容
本发明的目的在于提供一种能够自主判断海底悬崖,且能够安全、自适应的进行定高和定深航行切换的UUV海底地形跟踪过程中的航行切换系统。本发明的目的还在于提供一种UUV海底地形跟踪过程中的航行切换方法。
本发明的UUV海底地形跟踪过程中的航行切换系统包括测高声纳、深度计、姿态传感器、前视探测声纳、切换控制模块、定高/定深过渡纵倾指令生成模块、定深/定高过渡纵倾指令生成模块、纵倾控制器、深度控制器、高度控制器和升降舵;
所述测高声纳测量UUV距正下方海底的高度h,并传送到切换控制模块和高度控制器;
所述深度计测量UUV距海平面的深度d,并传送到深度控制器;
所述姿态传感器测量UUV的纵倾p,并传送到切换控制模块、定高/定深过渡纵倾指令生成模块和纵倾控制器;
所述前视探测声纳探测UUV距前下方海底的距离r,并传送到切换控制模块;
所述切换控制模块根据接收到的高度h、纵倾p和距离r,结合UUV当前的航行状态,判断是否需要进行航行切换,如果需要,将切换信号分别传送到定高/定深过渡纵倾指令生成模块、定深/定高过渡纵倾指令生成模块、深度控制器和高度控制器;如果不需要,则不输出任何信号;
定高/定深过渡纵倾指令生成模块和定深/定高过渡纵倾指令生成模块分别将在定高/定深过渡航行、定深/定高过渡航行过程中产生UUV的纵倾指令pcmd传送到纵倾控制器;
纵倾控制器根据纵倾指令和UUV的实际纵倾产生控制量并传送到升降舵用于对UUV纵倾的控制;
深度控制器根据深度指令和UUV的实际深度产生控制量并传送到升降舵用于对UUV深度的控制;
高度控制器根据高度指令和UUV的实际高度产生控制量并传送到升降舵用于对UUV高度的控制。
本发明的UUV海底地形跟踪过程中的航行切换系统还可以包括:
1、测高声纳安装在UUV的腹部,波束方向为UUV的正下方。
2、深度计、姿态传感器安装在UUV中部的横舯面处。
3、前视探测声纳安装在UUV的艏部,波束方向与水平面的夹角为60度。
本发明的UUV海底地形跟踪过程中的航行切换方法为:
步骤一:UUV保持对海底地形跟踪的定高航行;
步骤二:UUV判断前方地形是否为悬崖,如果是悬崖,UUV从定高航行切换为定高/定深过渡航行并转步骤三,否则转步骤一;
步骤三:UUV进行纵倾控制,将纵倾逐步调整到0度;
步骤四:UUV判断定高/定深过渡航行是否结束,如果结束,UUV从定高/定深过渡航行切换为定深航行并转步骤五,否则转步骤三,判断定高/定深过渡航行结束的方法为:UUV的纵倾的绝对值小于等于0.5度,即|p|≤0.5;
步骤五:UUV以定深航行开始时刻的实际深度为指令深度,进行深度控制;
步骤六:UUV判断定深航行是否结束,如果结束,UUV从定深航行切换为定深/定高过渡航行并转步骤七,否则转步骤五,判断定深航行结束的方法为:前视探测声纳测量到UUV距前下方海底的距离小于等于120米,即r≤120;
步骤七:UUV进行纵倾控制,将纵倾逐步调整到指定的纵倾;
步骤八:UUV判断定深/定高过渡航行是否结束,如果结束,转步骤九,否则转步骤七;
步骤九:判断任务是否完成,若完成,任务结束,否则转步骤一。
本发明的UUV海底地形跟踪过程中的航行切换方法还可以包括:
1、UUV判断前方地形是否为悬崖的方法为满足式:
sin(p)f(r,rmin,rmax)≥0.55
式中,sin(p)表示UUV纵倾评估项,f(r,rmin,rmax)表示UUV距前下方海底的距离评估项;f(r,rmin,rmax)的表达形式为:
f ( r , r min , r max ) = 0 , r ≤ r min 2 ( r - r min r max - r min ) 2 , r min ≤ r ≤ r min + r max 2 1 - 2 ( r - r max r max - r min ) 2 , r min + r max 2 ≤ r ≤ r max 1 , r ≥ r max
其中,rmin为UUV距前下方海底的距离低限值,取100~120,当r≤rmin时f(r,rmin,rmax)=0;rmax为UUV距前下方海底的距离高限值,取160~180,当r≥rmax时f(r,rmin,rmax)=1。
2、UUV将纵倾逐步调整到0度的过程中,纵倾指令按下式产生:
p c m d = p 0 e - a t - e a t e - a t + e a t + p 0
式中,pcmd表示纵倾指令;p0表示定高/定深过渡航行切换开始时刻的UUV纵倾值;a为调整参数,用来调整纵倾指令的变化率,取0.1~0.5。
3、UUV将纵倾逐步调整到指定的纵倾的过程中,纵倾指令按下式产生:
p c m d = λ e b t - e - b t e - b t + e b t
式中,λ表示期望调整到的纵倾度值,取5~20度;b为调整参数,用来调整纵倾指令的变化率,取0.1~0.5。
4、判断定深/定高过渡航行结束的方法为满足下式:
Σ t = k - 9 k h ( t ) 10 ≤ 2
式中,t表示采用时间,k表示当前时刻;即:测高声纳测量到的UUV距正下方的海底高度连续10个采样时刻的均值小于2米时认为定深/定高过渡航行结束。
本发明提供的是一种UUV在海底地形跟踪过程中遇到海底悬崖时为保证航行安全而切换为定深航行,跨越海底悬崖后自动切换回定高航行以继续执行地形跟踪的UUV海底地形跟踪过程中的航行切换系统及切换方法。
本发明的有益效果:
可以实现UUV安全的海底地形跟踪航行,特别是在遇到海底悬崖时能够通过切换航行状态跨越悬崖。
在海底地形跟踪的定高航行和跨越悬崖的定深航行之间增加了定高/定深过渡航行、定深/定高过渡航行,通过两个过渡航行调整UUV的纵倾从而实现定高和定深航行的平稳切换。
航行状态切换的判据所需的信息量小、计算简单、实时性好。
附图说明
图1 UUV海底地形跟踪过程中的航行切换示意图;
图2 UUV传感器安装配置侧视示意图;
图3 UUV海底地形跟踪过程中的航行切换系统结构图;
图4判断是否为悬崖时UUV距前下方海底的距离评估示意图;
图5 UUV定高/定深过渡纵倾指令生成示意图;
图6 UUV定深/定高过渡纵倾指令生成示意图;
图7 UUV海底地形跟踪过程中的航行切换流程图。
具体实施方式
下面举例对本发明进行详细说明。
结合图1,UUV海底地形跟踪过程中的航行切换描述如下:
如图1所示,UUV与海平面的距离为其实际深度d,由深度计测得;UUV与正下方海底的距离为实际高度h,由测高声纳测得;UUV与前下方海底的距离为r,由前视声纳测得。UUV在海底地形跟踪过程中,目的是始终保持与海底以固定的高度航行,这样UUV将随海底地形的起伏而起伏,从而实现对海底地形的跟踪。一旦遇到海底悬崖,为了保证自身的安全,UUV将定高航行转换为某一深度的定深航行以跨越悬崖。跨越悬崖之后,UUV将定深航行切换回定高航行以继续进行海底地形跟踪。
整个过程中,UUV共有4种航行状态:(1)定高航行,UUV控制高度,使其与海底保持固定高度航行以实现对海底地形的跟踪;(2)定深航行,UUV控制深度使其保持固定的深度航行以跨越悬崖;(3)定高/定深过渡航行,UUV控制纵倾,使其在探测到悬崖时减小纵倾到0度,平稳地实现定高航行到定深航行的过渡;(4)定深/定高过渡航行,UUV控制纵倾,使其在即将越过悬崖时增大纵倾到一定度数,平稳地实现定深航行到定高航行的过渡。从图中可以看出,整个过程共包括4种切换:(1)定高航行→定高/定深过渡航行切换;(2)定高/定深过渡航行→定深航行切换;(3)定深航行→定深/定高过渡航行切换;(4)定深/定高过渡航行→定高航行切换。
结合图2,UUV海底地形跟踪过程中的航行切换系统所需要的传感器配置包括:
在UUV的腹部安装有测高声纳1,波束方向为UUV的正下方,用来测量UUV距正下方海底的高度,高度探测和输出范围为[0,150]米。
在UUV中部的横舯面处安装有深度计2为和姿态传感器3。深度计用来测量UUV距海平面的深度信息,深度测量和输出范围为[0,500]米。姿态传感器用来测量UUV的纵倾,纵倾测量和输出范围均为[-90,90]度,埋艏为正,仰艏为负。
在UUV的艏部安装有前视探测声纳4,用来测量UUV距前下方海底的距离,距离探测和输出范围为[0,200]米,波束方向与水平面的夹角为60度。
结合图3,UUV海底地形跟踪过程中的航行切换系统包括测高声纳、深度计、姿态传感器、前视探测声纳、切换控制模块、定高/定深过渡纵倾指令生成模块、定深/定高过渡纵倾指令生成模块、纵倾控制器、深度控制器、高度控制器、升降舵。
测高声纳用于测量UUV距正下方海底的高度h(单位:米),并将高度信息传送到切换控制模块和高度控制器;
深度计用于测量UUV距海平面的深度d(单位:米),并将深度信息传送到深度控制器;
姿态传感器用于测量UUV的纵倾p(单位:度),并将纵倾信息传送到切换控制模块、定高/定深过渡纵倾指令生成模块、纵倾控制器;
前视探测声纳用于探测UUV距前下方海底的距离r(单位:米),并将距离信息传送到切换控制模块;
切换控制模块根据接收到的高度h、纵倾p、距离r,结合UUV当前的航行状态,判断是否需要进行航行切换。如果需要,将相应的切换信号分别传送到定高/定深过渡纵倾指令生成模块、定深/定高过渡纵倾指令生成模块、深度控制器和高度控制器;如果不需要,则不输出任何信号;
定高/定深过渡纵倾指令生成模块和定深/定高过渡纵倾指令生成模块分别用于在定高/定深过渡航行、定深/定高过渡航行过程中产生UUV的纵倾指令pcmd,并将纵倾指令传送到纵倾控制器;
纵倾控制器根据纵倾指令和UUV的实际纵倾产生控制量并传送到升降舵以实现对UUV纵倾的控制;
深度控制器根据深度指令和UUV的实际深度产生控制量并传送到升降舵以实现对UUV深度的控制;
高度控制器根据高度指令和UUV的实际高度产生控制量并传送到升降舵以实现对UUV高度的控制;
升降舵作为UUV控制纵倾、深度和高度的执行机构。
切换控制模块接收前视探测声纳测量的UUV距前下方海底的距离r、测高声纳测量的UUV距正下方海底的高度h,姿态传感器测量的UUV的纵倾p,然后根据当前的航行状态,并综合利用以上三个信息,判断是否需要进行航行切换。如果需要,将相应的切换信号分别传送到定高/定深过渡纵倾指令生成模块、定深/定高过渡纵倾指令生成模块、深度控制器和高度控制器。下面详细介绍4种切换的判据条件。
定高航行→定高/定深过渡航行的切换判据如式(1)所示
sin(p)f(r,rmin,rmax)≥0.55 (1)式中,sin(p)表示UUV纵倾评估项,f(r,rmin,rmax)表示UUV距前下方海底的距离评估项;上式表示根据UUV的纵倾和距前下方海底的距离进行综合评估,当评估值高于设定的阈值时,说明UUV当前的纵倾较大且前视探测声纳测量到的前下方距离也较大,认为遇到悬崖,那么进行定高航行→定高/定深过渡航行的切换,选取的阈值0.55所对应的UUV纵倾约为45度、UUV距前下方海底距离约为160米。f(r,rmin,rmax)的表达形式如式(2)所示:
f ( r , r min , r max ) = 0 , r ≤ r min 2 ( r - r min r max - r min ) 2 , r min ≤ r ≤ r min + r max 2 1 - 2 ( r - r max r max - r min ) 2 , r min + r max 2 ≤ r ≤ r max 1 , r ≥ r max - - - ( 2 )
式中,rmin称为低限值,一般取100~120,当r≤rmin时有f(r,rmin,rmax)=0;rmax称为高限值,一般取160~180,当r≥xram时有f(r,rmin,rmax)=1。图4给出了rmin=120,rmax=160时的f(r,rmin,rmax)评估曲线。
定高/定深过渡航行→定深航行的切换判据如式(3)所示:
|p|≤0.5 (3)
上式表示当UUV的纵倾的绝对值小于0.5度时,认为UUV已将纵倾基本调整为0度,定高/定深过渡航行结束,可以切换为定深航行。
定深航行→定深/定高过渡航行的切换判据如式(4)所示:
r≤120 (4)
上式表达当前视探测声纳测量到UUV局前下方海底的距离小于等于120米时,认为海底悬崖已经跨越,定深航行结束,可以切换为定深/定高过渡航行。
定深/定高过渡航行→定高航行的切换判据如式(5)所示:
Σ t = k - 9 k h ( t ) 10 ≤ 2 - - - ( 5 )
式中,t表示时间,k表示当前时刻,上式表达当测高声纳测量到的UUV距正下方的海底高度连续10个采样时刻的均值小于2米时,认为海底地形已经比较平坦,定深/定高过渡航行结束,可以切换为定高航行。
定高/定深过渡纵倾指令生成模块接收切换控制模块的定高/定深过渡航行的切换信号、姿态传感器测量的UUV纵倾信息,当接收到切换信号后产生纵倾指令输出到纵倾控制器,以控制UUV的纵倾使其平稳地减小到0度。纵倾指令按下式(6)产生
p c m d = p 0 e - a t - e a t e - a t + e a t + p 0 - - - ( 6 )
式中,pcmd表示纵倾指令;p0表示定高/定深过渡航行切换开始时刻的UUV纵倾值;a为调整参数,用来调整纵倾指令的变化率,一般取0.1~0.5;图5给出了切换开始时刻的UUV纵倾p0为35度,a取值为0.25时的纵倾指令曲线。从图5中可以看出,大约10s左右纵倾指令从35度变换到0度。
定深/定高过渡纵倾指令生成模块接收切换控制模块的定深/定高过渡航行切换信号后产生纵倾指令输出到纵倾控制器,以控制UUV的纵倾使其平稳地增加到指定值。纵倾指令按下式(7)产生
p c m d = λ e b t - e - b t e - b t + e b t - - - ( 7 )
式中,λ表示期望增加到的纵倾值,一般可取5~20度;b为调整参数,用来调整纵倾指令的变化率,一般取0.1~0.5;图6给出了期望纵倾值λ为10度,b取值为0.1时的纵倾指令曲线。从图5中可以看出,大约25s左右纵倾指令从0度变换到10度。
纵倾控制器接收定高/定深过渡纵倾指令生成模块或定深/定高过渡纵倾指令生成模块的纵倾指令、姿态传感器测量的UUV纵倾信息,基于PID控制器产生控制量并输出到UUV的升降舵,以实现对UUV的纵倾控制。
深度控制器接收切换控制模块的定深航行切换信号、深度计测量的UUV深度信息,以切换定深航行开始时刻的UUV深度为指令深度,基于PID控制器产生控制量并输出到UUV的升降舵,以实现对UUV的深度控制。
高度控制器接收切换控制模块的定高航行切换信号、测高声纳测量的UUV高度信息,当接收到定高航行切换信号后,以设定的高度hcmd为定高指令,基于PID控制器产生控制量并输出到UUV的升降舵,以实现对UUV的高度控制。
升降舵作为UUV控制纵倾、深度和高度的执行机构。
结合图7,UUV海底地形跟踪过程中的航行切换方法为:
1、初始化设定定高指令hcmd和参数λ、a、b;
2、UUV通过高度控制执行定高航行以对海底地形进行跟踪;
3、根据式(1)判断前方地形是否为悬崖,如果是转步骤4,否则转步骤2;
4、UUV从定高航行切换为定高/定深过渡航行;
5、根据式(6)产生纵倾指令并进行纵倾控制;
6、根据式(3)判断定高/定深过渡航行是否结束,如果结束转步骤7,否则转步骤5;
7、UUV从定高/定深过渡航行切换为定深航行;
8、UUV以定深航行开始时刻的深度为指令深度,进行深度控制;
9、根据式(4)判断定深航行是否结束,如果结束转步骤10,否则转步骤8;
10、UUV从定深航行切换为定深/定高过渡航行;
11、根据式(7)产生纵倾指令并进行纵倾控制;
12、根据式(5)判断深/定高过渡航行是否结束,如果结束转步骤13,否则转步骤11;
13、判断任务是否完成,若完成,任务结束,否则转步骤2。

Claims (9)

1.一种UUV海底地形跟踪过程中的航行切换系统,其特征是:包括测高声纳、深度计、姿态传感器、前视探测声纳、切换控制模块、定高/定深过渡纵倾指令生成模块、定深/定高过渡纵倾指令生成模块、纵倾控制器、深度控制器、高度控制器和升降舵;
所述测高声纳测量UUV距正下方海底的高度h,并传送到切换控制模块和高度控制器;
所述深度计测量UUV距海平面的深度d,并传送到深度控制器;
所述姿态传感器测量UUV的纵倾p,并传送到切换控制模块、定高/定深过渡纵倾指令生成模块和纵倾控制器;
所述前视探测声纳探测UUV距前下方海底的距离r,并传送到切换控制模块;
所述切换控制模块根据接收到的高度h、纵倾p和距离r,结合UUV当前的航行状态,判断是否需要进行航行切换,如果需要,将切换信号分别传送到定高/定深过渡纵倾指令生成模块、定深/定高过渡纵倾指令生成模块、深度控制器和高度控制器;如果不需要,则不输出任何信号;
定高/定深过渡纵倾指令生成模块和定深/定高过渡纵倾指令生成模块分别将在定高/定深过渡航行、定深/定高过渡航行过程中产生UUV的纵倾指令pcmd传送到纵倾控制器;
纵倾控制器根据纵倾指令和UUV的实际纵倾产生控制量并传送到升降舵用于对UUV纵倾的控制;
深度控制器根据深度指令和UUV的实际深度产生控制量并传送到升降舵用于对UUV深度的控制;
高度控制器根据高度指令和UUV的实际高度产生控制量并传送到升降舵用于对UUV高度的控制。
2.根据权利要求1所述的UUV海底地形跟踪过程中的航行切换系统,其特征是:测高声纳安装在UUV的腹部,波束方向为UUV的正下方。
3.根据权利要求2所述的UUV海底地形跟踪过程中的航行切换系统,其特征是:深度计、姿态传感器安装在UUV中部的横舯面处。
4.根据权利要求3所述的UUV海底地形跟踪过程中的航行切换系统,其特征是:前视探测声纳安装在UUV的艏部,波束方向与水平面的夹角为60度。
5.基于权利要求1所述的UUV海底地形跟踪过程中的航行切换系统的切换方法,其特征是:
步骤一:UUV保持对海底地形跟踪的定高航行;
步骤二:UUV判断前方地形是否为悬崖,如果是悬崖,UUV从定高航行切换为定高/定深过渡航行并转步骤三,否则转步骤一;
步骤三:UUV进行纵倾控制,将纵倾逐步调整到0度;
步骤四:UUV判断定高/定深过渡航行是否结束,如果结束,UUV从定高/定深过渡航行切换为定深航行并转步骤五,否则转步骤三,判断定高/定深过渡航行结束的方法为:UUV的纵倾的绝对值小于等于0.5度,即|p|≤0.5;
步骤五:UUV以定深航行开始时刻的实际深度为指令深度,进行深度控制;
步骤六:UUV判断定深航行是否结束,如果结束,UUV从定深航行切换为定深/定高过渡航行并转步骤七,否则转步骤五,判断定深航行结束的方法为:前视探测声纳测量到UUV距前下方海底的距离小于等于120米,即r≤120;
步骤七:UUV进行纵倾控制,将纵倾逐步调整到指定的纵倾;
步骤八:UUV判断定深/定高过渡航行是否结束,如果结束,转步骤九,否则转步骤七;
步骤九:判断任务是否完成,若完成,任务结束,否则转步骤一。
6.根据权利要求5所述的UUV海底地形跟踪过程中的航行切换方法,其特征是:UUV判断前方地形是否为悬崖的方法为满足式:
sin(p)f(r,rmin,rmax)≥0.55
式中,sin(p)表示UUV纵倾评估项,f(r,rmin,rmax)表示UUV距前下方海底的距离评估项;f(r,rmin,rmax)的表达形式为:
f ( r , r min , r max ) = 0 , r ≤ r min 2 ( r - r min r max - r min ) 2 , r min ≤ r ≤ r min + r max 2 1 - 2 ( r - r max r max - r min ) 2 , r min + r max 2 ≤ r ≤ r max 1 , r ≥ r max
其中,rmin为UUV距前下方海底的距离低限值,取100~120,当r≤rmin时f(r,rmin,rmax)=0;rmax为UUV距前下方海底的距离高限值,取160~180,当r≥rmax时f(r,rmin,rmax)=1。
7.根据权利要求6所述的UUV海底地形跟踪过程中的航行切换方法,其特征是:UUV将纵倾逐步调整到0度的过程中,纵倾指令按下式产生:
p c m d = p 0 e - a t - e a t e - a t + e a t + p 0
式中,pcmd表示纵倾指令;p0表示定高/定深过渡航行切换开始时刻的UUV纵倾值;a为调整参数,用来调整纵倾指令的变化率,取0.1~0.5。
8.根据权利要求7所述的UUV海底地形跟踪过程中的航行切换方法,其特征是:UUV将纵倾逐步调整到指定的纵倾的过程中,纵倾指令按下式产生:
p c m d = λ e b t - e - b t e - b t + e b t
式中,λ表示期望调整到的纵倾值,取5~20度;b为调整参数,用来调整纵倾指令的变化率,取0.1~0.5。
9.根据权利要求8所述的UUV海底地形跟踪过程中的航行切换方法,其特征是:判断定深/定高过渡航行结束的方法为满足下式:
Σ t = k - 9 k h ( t ) 10 ≤ 2
式中,t表示采用时间,k表示当前时刻。
CN201610312367.6A 2016-05-12 2016-05-12 一种uuv海底地形跟踪过程中的航行切换系统及切换方法 Active CN106020212B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610312367.6A CN106020212B (zh) 2016-05-12 2016-05-12 一种uuv海底地形跟踪过程中的航行切换系统及切换方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610312367.6A CN106020212B (zh) 2016-05-12 2016-05-12 一种uuv海底地形跟踪过程中的航行切换系统及切换方法

Publications (2)

Publication Number Publication Date
CN106020212A true CN106020212A (zh) 2016-10-12
CN106020212B CN106020212B (zh) 2018-12-25

Family

ID=57099684

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610312367.6A Active CN106020212B (zh) 2016-05-12 2016-05-12 一种uuv海底地形跟踪过程中的航行切换系统及切换方法

Country Status (1)

Country Link
CN (1) CN106020212B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106527453A (zh) * 2016-12-06 2017-03-22 北京臻迪机器人有限公司 一种水下无人船定深航行控制系统及方法
CN110456786A (zh) * 2019-07-10 2019-11-15 哈尔滨工程大学 基于地形特征提取的uuv海底地形跟踪系统及跟踪方法
CN112082558A (zh) * 2020-09-14 2020-12-15 哈尔滨工程大学 基于多项式拟合的uuv海底地形跟踪路径滚动生成方法
CN112082557A (zh) * 2020-09-14 2020-12-15 哈尔滨工程大学 基于贝塞尔拟合的uuv海底地形跟踪路径滚动生成方法
CN114148495A (zh) * 2021-12-02 2022-03-08 中国船舶科学研究中心 双功能无人潜航器模式切换方法及装置
CN115071926A (zh) * 2022-05-16 2022-09-20 西北工业大学 一种基于Petri网的自主水下航行器锚泊卧底任务控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101003299A (zh) * 2006-12-22 2007-07-25 陈兆红 一种船舶的抗风浪装置
CN101339036A (zh) * 2008-08-20 2009-01-07 北京航空航天大学 地形辅助导航方法和设备
CN102385316A (zh) * 2011-09-16 2012-03-21 哈尔滨工程大学 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法
CN103900573A (zh) * 2014-03-27 2014-07-02 哈尔滨工程大学 一种基于s57标准电子海图的水下运载器多约束航路规划方法
US8868268B2 (en) * 2013-03-12 2014-10-21 The United States Of America, As Represented By The Secretary Of The Navy System and method for navigation for unmanned undersea vehicles
CN104316932A (zh) * 2014-11-05 2015-01-28 哈尔滨工程大学 一种uuv抵近海底作业的定高航行系统及航行方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101003299A (zh) * 2006-12-22 2007-07-25 陈兆红 一种船舶的抗风浪装置
CN101339036A (zh) * 2008-08-20 2009-01-07 北京航空航天大学 地形辅助导航方法和设备
CN102385316A (zh) * 2011-09-16 2012-03-21 哈尔滨工程大学 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法
US8868268B2 (en) * 2013-03-12 2014-10-21 The United States Of America, As Represented By The Secretary Of The Navy System and method for navigation for unmanned undersea vehicles
CN103900573A (zh) * 2014-03-27 2014-07-02 哈尔滨工程大学 一种基于s57标准电子海图的水下运载器多约束航路规划方法
CN104316932A (zh) * 2014-11-05 2015-01-28 哈尔滨工程大学 一种uuv抵近海底作业的定高航行系统及航行方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
R SUTTON 等: "Depth Control of an Unmanned Underwater Vehicle Using Neural Nelworks", 《IEEE》 *
严浙平 等: "基于高度计信息处理的欠驱动无人水下航行器地形跟踪控制", 《计算机应用》 *
徐大伟 等: "海浪干扰环境下UUV近水面深度控制", 《智能系统学报》 *
李岳明 等: "水下机器人高度信息融合与欠驱动地形跟踪控制", 《控制理论与应用》 *
陈强 等: "美国军用UUV现状及发展趋势分析", 《舰船科学技术》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106527453A (zh) * 2016-12-06 2017-03-22 北京臻迪机器人有限公司 一种水下无人船定深航行控制系统及方法
CN110456786A (zh) * 2019-07-10 2019-11-15 哈尔滨工程大学 基于地形特征提取的uuv海底地形跟踪系统及跟踪方法
CN110456786B (zh) * 2019-07-10 2023-04-07 哈尔滨工程大学 基于地形特征提取的uuv海底地形跟踪系统及跟踪方法
CN112082558A (zh) * 2020-09-14 2020-12-15 哈尔滨工程大学 基于多项式拟合的uuv海底地形跟踪路径滚动生成方法
CN112082557A (zh) * 2020-09-14 2020-12-15 哈尔滨工程大学 基于贝塞尔拟合的uuv海底地形跟踪路径滚动生成方法
CN114148495A (zh) * 2021-12-02 2022-03-08 中国船舶科学研究中心 双功能无人潜航器模式切换方法及装置
CN114148495B (zh) * 2021-12-02 2023-03-14 中国船舶科学研究中心 双功能无人潜航器模式切换方法及装置
CN115071926A (zh) * 2022-05-16 2022-09-20 西北工业大学 一种基于Petri网的自主水下航行器锚泊卧底任务控制方法
CN115071926B (zh) * 2022-05-16 2023-12-19 西北工业大学 一种基于Petri网的自主水下航行器锚泊卧底任务控制方法

Also Published As

Publication number Publication date
CN106020212B (zh) 2018-12-25

Similar Documents

Publication Publication Date Title
CN106020212A (zh) 一种uuv海底地形跟踪过程中的航行切换系统及切换方法
US10538299B2 (en) Predictive sea state mapping for ship motion control
Zhang et al. Subsea pipeline leak inspection by autonomous underwater vehicle
CN104316932B (zh) 一种uuv抵近海底作业的定高航行系统及航行方法
CN103201693B (zh) 根据相关传感器数据估计水下航行器的位置和方向
AU2015243046B2 (en) Self-propelled buoy for monitoring underwater objects
CN109238291B (zh) 一种水面无人船导引缆回收自主水下航行器的规划方法
US9816812B2 (en) Systems and methods for automated vessel navigation using sea state prediction
CN202038437U (zh) 具有新型避障装置的小型水面机器人
Bandyophadyay et al. A simple reactive obstacle avoidance algorithm and its application in singapore harbor
JP2007210402A (ja) 自律型無人潜水機およびその水中航行方法
CN107976188B (zh) 一种基于测距声通的auv回坞导航方法
CN110849370A (zh) 一种基于水面无人艇的动态航线规划方法
MX2012014452A (es) Procedimiento de despliegue, procedimiento y dispositivo de prospeccion sismica en medio acuatico.
JP2016159662A (ja) 水中パイプライン検査用の自律型水中航走体
CN115019412A (zh) 一种基于多传感器的水下auv海缆巡检系统及方法
CN208278303U (zh) 一种小型号侧扫声呐潜航搭载装置
JP2018070125A5 (zh)
JP2018070125A (ja) 水中音響通信システム
CN109460058A (zh) 一种尾部推进低速水下航行器水下对接横移控制方法
CN110456786B (zh) 基于地形特征提取的uuv海底地形跟踪系统及跟踪方法
CN110806760A (zh) 一种无人水下航行器的目标跟踪控制方法
US20220397694A1 (en) Integrated detection method of electromagnetic searching, locating and tracking for subsea cables
CN112666936B (zh) 一种半潜式无人船智能避障系统及方法
KR20150047159A (ko) Rov의 거동을 고려한 동적 위치 제어 시스템 및 그의 위치 제어 방법

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant