CN109213179B - 一种全海深auv折线式下潜控制方法 - Google Patents
一种全海深auv折线式下潜控制方法 Download PDFInfo
- Publication number
- CN109213179B CN109213179B CN201810769809.9A CN201810769809A CN109213179B CN 109213179 B CN109213179 B CN 109213179B CN 201810769809 A CN201810769809 A CN 201810769809A CN 109213179 B CN109213179 B CN 109213179B
- Authority
- CN
- China
- Prior art keywords
- depth
- auv
- sea
- full
- depth auv
- 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 59
- 230000008569 process Effects 0.000 claims abstract description 35
- 238000004891 communication Methods 0.000 claims abstract description 20
- 230000009471 action Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 2
- 230000009189 diving Effects 0.000 abstract description 12
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 abstract description 2
- 230000007246 mechanism Effects 0.000 description 4
- 238000011161 development Methods 0.000 description 2
- 230000005012 migration Effects 0.000 description 2
- 238000013508 migration Methods 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/048—Control of altitude or depth specially adapted for water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明提供的是一种全海深AUV折线式下潜控制方法。首先在AUV下潜之前,确定在水下布置的水声定位和通信系统的覆盖范围,并确定AUV在到达指定工作深度处能与水声定位和通信系统正常建立连接的安全距离,由此安全距离确定在折线式下潜过程中所允许的沿纵向偏移的最远距离l。在AUV载体下潜过程中纵向运动距离s等于l时,控制AUV转艏180°,使其反向纵倾下潜。待AUV反向纵倾下潜过程中,在s等于l时,再控制AUV转艏180°,使其反向运动。直到AUV到达指定工作深度。本发明将AUV在下潜过程中的水平面运动范围限制在合理范围内,能保证限定AUV水平面运动范围的圆的圆心始终在一条垂线上,具有很好的抗流能力,提高了全海深AUV的安全性。
Description
技术领域
本发明涉及的是一种适用于全海深AUV的下潜方法。
背景技术
随着海洋开发的迅猛发展,人类探索海洋的深度也在不断增加,一些适用于深海探测的水下机器人应运而生。世界上目前最深的海域是位于马里亚纳海沟的“挑战者深渊”,吸引着很多海洋探测强国的目光,能够达到挑战者深渊底部的水下机器人则具备全海深作业能力。全海深自主水下航行器(AUV)下潜距离大,时间长,其一般采用无动力下潜方式达到指定工作深度。目前常用的无动力下潜方式有三种:螺旋下潜、无纵倾下潜和纵倾下潜。螺旋下潜和无纵倾下潜可以保证全海深AUV下潜过程中的偏移距离在合理范围内,避免到达指定工作深度时,距离预定工作地点太远。而纵倾下潜则无法保证其偏移距离在合理范围内,增大了全海深AUV下潜过程中超出水下定位和通信系统覆盖范围的风险,可能导致AUV的丢失。全海深AUV在垂向运动距离过大,一般为了减少其垂向阻力而将其设计成立扁体型。而对某立扁体型AUV进行操纵性仿真得知,立扁体AUV在回转运动时,具有较大的阻尼力矩,并且实现螺旋下潜的方式是在全海深AUV尾部一个能打一定倾角的垂直舵,此垂直舵无疑也增加了运动阻力。所以,螺旋下潜对立扁体型全海深AUV并不适用。
全海深AUV的定位与通信依靠水下的水声定位和通信系统,其覆盖范围有限,故必须保证全海深AUV下潜过程中偏移距离较小。全海深AUV下潜过程中的偏移主要来源于AUV载体的纵倾,纵倾会使全海深AUV产生纵向速度,从而产生纵向偏移。因为海流在垂向分布范围很小,故海流的干扰造成AUV载体的位置偏移较小。全海深AUV下潜过程中的纵倾来源两方面:(1)AUV载体水动力布局在纵向不对称;(2)AUV载体各部分结构材料和形状分布不均匀造成下潜过程中浮力变化不均匀,导致浮心与重心不在一条垂线上。此两种因素在全海深AUV设计时候均无法排除,故无法保证全海深AUV在下潜过程中保持无纵倾状态。为了保证全海深AUV载体安全作业,没有任何外界干扰下的AUV载体的纵倾角应该很小,全海深AUV载体在小倾角状态下无法保证纵向偏移方向与倾角方向有必然联系。所以,需要在保证有适当纵倾的情况下保证全海深AUV载体在下潜过程中纵向偏移距离在合理范围内。
发明内容
本发明的目的在于提供一种能够提高全海深AUV的安全性的全海深AUV折线式下潜控制方法。
本发明的目的是这样实现的:
步骤一:在海面完成全海深AUV所配置惯导的对准和标定,获得全海深AUV初始位置A(x0,y0,0);
步骤二:将压载挂在全海深AUV中纵剖面处,使全海深AUV保持一个纵倾角θ;
步骤三:释放所述全海深AUV,使其在全海深AUV所携带压载的作用下无动力以纵倾角θ下潜;
步骤四:实时记录全海深AUV配置的深度计输出的深度信息depth和惯导输出的全海深AUV实时位置信息,计算全海深AUV的实时纵向运动距离s;
步骤五:比较全海深AUV实时纵向运动距离s与全海深AUV下潜过程中允许最大纵向偏移距离l的大小,若满足s≥l,则控制全海深AUV转艏180°,使全海深AUV反向纵倾下潜,反之,继续使其保持原来运动方向;
步骤六:根据所述全海深AUV配置的深度计输出的深度信息depth,判断全海深AUV是否到达预定工作深度depth0,即满足depth≥depth0,若达到预定工作深度,则抛掉所述全海深AUV携带的下潜压载,并控制全海深AUV运动到指定工作地点,若未达到预定工作深度,则重复执行步骤三、四、五、六。
本发明还可以包括:
1.惯导输出的全海深AUV实时位置信息B(x,y,z),是全海深AUV配置的惯导利用其加速度和速度信息进行推算导航在初始位置A(x0,y0,0)的基础上获得。
2.全海深AUV的实时纵向运动距离s为惯导输出的位置信息B(x,y,z)和全海深AUV初始位置A(x0,y0,0)之间连线在水平面投影的距离,具体计算方法如下:
3.允许最大纵向偏移距离l是根据全海深AUV在到达指定工作深度处能与水声定位和通信系统正常建立连接的安全距离S0来确定的,具体关系如下:
l=aS0
上式中,a为安全系数,满足0<a≤1。
本发明提供了一种可行的适用于全海深AUV的折线式下潜方法。全海深AUV载体一般采用立扁体型,不适合螺旋下潜。同时,AUV载体在下潜过程中不可避免的存在纵倾(此种情况下纵倾角很小),纵倾的存在会造成全海深AUV的纵向偏移,若不对所述纵向偏移加以控制可能使所述全海深AUV超出水下水声定位和通信系统覆盖的范围,增加水下定位和通信的风险。全海深AUV载体在小倾角状态下无法保证纵向偏移方向与倾角方向的绝对关系,故小倾角情况下很难控制全海深AUV运动的方向。本发明所述的一种适用于全海深AUV的折线式下潜方法,通过合理安装压载的位置将下潜过程中的纵倾控制在适当范围内,进而可根据纵倾情况判断全海深AUV的运动方向,并能有效保证所述全海深AUV下潜过程中的纵向偏移在合理范围内,从而有效保障了水下定位和通信系统与AUV之间的正常工作,提高了全海深AUV的安全性。
本发明的特点主要体现在:
首先在所述全海深AUV下潜之前,确定在水下布置的水声定位和通信系统的覆盖范围,并确定所述全海深AUV在到达指定工作深度处能与所述水声定位和通信系统正常建立连接的安全距离S0,由此安全距离S0确定在折线式下潜过程中所允许的沿纵向偏移的最远距离l。其中l与S0的关系如下:
l=aS0
上式中,a为安全系数,满足0<a≤1,作为所述全海深AUV纵向偏移范围不超出所述水下定位和通信系统覆盖范围的保障,a的值越小则代表所述全海深AUV在下潜过程中所允许的纵向偏移距离越小,则具有的安全性越高。
确定所述全海深AUV下潜过程中允许的纵向偏移距离l后,则在AUV载体下潜过程中纵向运动距离s等于l时,控制所述全海深AUV转艏180°,使其反向纵倾下潜。待所述全海深AUV反向纵倾下潜过程中,在运动距离s等于l时,再控制所述全海深AUV转艏180°,使其反向运动。如此反复,直到所述全海深AUV到达指定工作深度depth0。
本发明具有以下优点:
1、过程简单,操作方便,需要参与的机构较少。本发明将全海深AUV下潜路径近似规划成折线形,只需要监控纵向运动距离并在适当的时候控制AUV转艏方向运动即可。整个操作过程简洁,思路清晰,易于实现。
2、安全高效。本发明从实际出发,考虑了全海深AUV载体下潜过程中不可避免的纵倾造成的不利影响,以水下布置的水声定位和通信系统覆盖范围为参考,设定允许的最大纵向偏移距离l,相当于限定了全海深AUV载体在水平面的运动范围。从而提高了全海深AUV顺利达到预定工作地点并完成与水声定位和通信系统建立连接的保障,提高了全海深AUV作业的安全性和高效性。
3、节约能源。本发明所述的折线式下潜方法,在整个下潜过程中绝大部分时间全海深AUV处于无动力下潜状态(即推进器不工作),只在全海深AUV需要转艏时推进器才工作。而此阶段时间有限,从而节约了AUV载体携带的能源。
4、具有很好的抗流能力。本发明所述的折线式下潜方法,全海深AUV在水平面的运动范围被限定在一个以l为半径的圆内,且在整个下潜过程中,限定AUV载体运动范围的圆的圆心始终在一条垂线上。
附图说明
图1是全海深AUV折线式下潜示意图。
图2是适用于全海深AUV的折线式下潜方法流程图。
具体实施方式
下面举例对本发明做更详细的描述。
本发明主要针对立扁体型全海深AUV在压载作用下下潜过程中存在的纵倾造成所述全海深AUV载体纵向偏移,提供一种可行的折线式下潜方法将纵向偏移距离控制在合理范围内,所述折线式下潜方法示意图如附图1所示,主要过程如下:
首先在所述全海深AUV下潜之前,确定在水下布置的水声定位和通信系统的覆盖范围,并确定所述全海深AUV在到达指定工作深度处能与所述水声定位和通信系统正常建立连接的安全距离S0,由此安全距离S0确定在折线式下潜过程中所允许的沿纵向偏移的最远距离l。其中l与S0的关系如下:
l=aS0
上式中,a为安全系数,满足0<a≤1,作为所述全海深AUV纵向偏移范围不超出所述水下定位和通信系统覆盖范围的保障,a的值越小则代表所述全海深AUV在下潜过程中所允许的纵向偏移距离越小,则具有的安全性越高。
确定所述全海深AUV下潜过程中允许的纵向偏移距离l后,则在AUV载体下潜过程中纵向(即附图1所示X正方向)运动距离s等于l时,控制所述全海深AUV转艏180°,使其反向(即附图1所示X负方向)纵倾下潜。待所述全海深AUV反向纵倾下潜过程中,在附图1所示X负方向运动距离s等于l时,再控制所述全海深AUV转艏180°,使其反向运动。如此反复,直到所述全海深AUV到达指定工作深度depth0。
本发明所述的全海深AUV搭载的传感器有深度计、罗经、惯导、高度计等,还搭载有自动驾驶计算机和抛载机构与推进器等执行机构。罗经能给出AUV载体实时的姿态信息,惯导输出轴向速度信息,结合罗经给出的姿态信息可以推算出全海深AUV实时的位置信息,进而实时计算出所述全海深AUV载体纵向运动距离s。自动驾驶计算机实时监控全海深AUV载体的位置信息和深度信息,并在到达所允许的最大纵向偏移距离l后,控制推进器使AUV载体转艏反向运动。如此反复,直到所述全海深AUV达到指定作业深度。此时,控制抛载机构释放下潜抛载,并控制所述全海深AUV运动到指定作业地点。
本发明所述的全海深AUV载体纵向运动距离s具有如下特征:
所述纵向运动距离s为惯导输出的位置信息B(x,y,z)(即全海深AUV所处的位置)和全海深AUV初始位置A(x0,y0,0)之间连线在水平面投影的距离,具体计算方法如下:
本发明所述的一种适用于全海深AUV的折线式下潜方法具体操作流程如附图2所示,包含如下步骤:
步骤一:在海面做好所述全海深AUV的调试工作,并完成AUV所配置惯导的对准和标定,获得AUV初始位置A(x0,y0,0)。
步骤二:将压载挂在中纵剖面处合适位置,使其适当保持一个合适的纵倾角θ。
步骤三:释放所述全海深AUV,使其在全海深AUV所携带压载的作用下以纵倾角θ下潜(此过程不开推进器)。
步骤四:实时记录所述全海深AUV配置的深度计输出的深度信息depth和所述惯导输出的AUV实时位置信息,计算其实时纵向运动距离s。
步骤五:比较步骤二所述的全海深AUV实时纵向运动距离,s与所述全海深AUV下潜过程中允许最大纵向偏移距离l的大小,若满足s≥l,则控制所述全海深AUV转艏180°,使其反向纵倾下潜。反之,继续使其保持原来运动方向。
步骤六:根据所述全海深AUV配置的深度计输出的深度信息depth,判断AUV载体是否到达预定工作深度depth0(即满足depth≥depth0),若达到预定工作深度,则抛掉所述全海深AUV携带的下潜抛载,并控制AUV运动到指定工作地点。若未达到预定工作深度,则重复所述步骤三、四、五、六。
本发明所述的一种适用于全海深AUV的折线式下潜方法充分考虑了AUV下潜过程中的实际问题,包括纵倾造成的纵向偏移,以及全海深AUV偏移距离过大超出水下布置的水声定位和通信系统覆盖范围的危险情况。从实际出发,将全海深AUV在下潜过程中的水平面运动范围限制在合理范围内,且能保证限定AUV载体水平面运动范围的圆的圆心始终在一条垂线上,具有很好的抗流能力。从而将复杂的问题变得简单,提高了全海深AUV的安全性。
Claims (5)
1.一种全海深AUV折线式下潜控制方法,其特征是:
步骤一:在海面完成全海深AUV所配置惯导的对准和标定,获得全海深AUV初始位置A(x0,y0,0);
步骤二:将压载挂在全海深AUV中纵剖面处,使全海深AUV保持一个纵倾角θ;
步骤三:释放所述全海深AUV,使其在全海深AUV所携带压载的作用下无动力以纵倾角θ下潜;
步骤四:实时记录全海深AUV配置的深度计输出的深度信息depth和惯导输出的全海深AUV实时位置信息,计算全海深AUV的实时纵向运动距离s;
步骤五:比较全海深AUV实时纵向运动距离s与全海深AUV下潜过程中允许最大纵向偏移距离l的大小,若满足s≥l,则控制全海深AUV转艏180°,使全海深AUV反向纵倾下潜,反之,继续使其保持原来运动方向;
步骤六:根据所述全海深AUV配置的深度计输出的深度信息depth,判断全海深AUV是否到达预定工作深度depth0,即满足depth≥depth0,若达到预定工作深度,则抛掉所述全海深AUV携带的下潜压载,并控制全海深AUV运动到指定工作地点,若未达到预定工作深度,则重复执行步骤三、四、五、六。
2.根据权利要求1所述的全海深AUV折线式下潜控制方法,其特征是:惯导输出的全海深AUV实时位置信息B(x,y,z),是全海深AUV配置的惯导利用其加速度和速度信息进行推算导航在初始位置A(x0,y0,0)的基础上获得。
4.根据权利要求1或2所述的全海深AUV折线式下潜控制方法,其特征是:允许最大纵向偏移距离l是根据全海深AUV在到达指定工作深度处能与水声定位和通信系统正常建立连接的安全距离S0来确定的,具体关系如下:
l=aS0
上式中,a为安全系数,满足0<a≤1。
5.根据权利要求3所述的全海深AUV折线式下潜控制方法,其特征是:允许最大纵向偏移距离l是根据全海深AUV在到达指定工作深度处能与水声定位和通信系统正常建立连接的安全距离S0来确定的,具体关系如下:
l=aS0
上式中,a为安全系数,满足0<a≤1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810769809.9A CN109213179B (zh) | 2018-07-13 | 2018-07-13 | 一种全海深auv折线式下潜控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810769809.9A CN109213179B (zh) | 2018-07-13 | 2018-07-13 | 一种全海深auv折线式下潜控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109213179A CN109213179A (zh) | 2019-01-15 |
CN109213179B true CN109213179B (zh) | 2021-04-23 |
Family
ID=64990097
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810769809.9A Active CN109213179B (zh) | 2018-07-13 | 2018-07-13 | 一种全海深auv折线式下潜控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109213179B (zh) |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009527763A (ja) * | 2006-02-23 | 2009-07-30 | オーシヤン・サーバー・テクノロジー・インコーポレーテツド | 水中移動体の位置決定のシステムと方法 |
CN102722177B (zh) * | 2012-06-27 | 2014-06-25 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN103744430B (zh) * | 2013-02-07 | 2016-08-24 | 山东英特力光通信开发有限公司 | 一种小型无人直升机飞行控制方法 |
CN104569917A (zh) * | 2014-12-26 | 2015-04-29 | 中国船舶重工集团公司第七一五研究所 | 一种auv平台自适应定位与导航系统及方法 |
NO339336B1 (en) * | 2015-01-29 | 2016-11-28 | Octio As | System and method for operating a Subsea sensor field |
CN105629979B (zh) * | 2015-12-22 | 2019-01-08 | 中国船舶重工集团公司第七一五研究所 | 一种auv平台的远程状态跟踪与控制方法和系统 |
CN105807298B (zh) * | 2016-04-27 | 2018-08-17 | 上海海洋大学 | 全海深海洋装备的定位与通信装置及方法 |
CN105739536B (zh) * | 2016-05-09 | 2017-12-19 | 广州极飞科技有限公司 | 一种无人机监控方法和系统 |
CN108089588A (zh) * | 2016-11-22 | 2018-05-29 | 中国科学院沈阳自动化研究所 | 一种水下机器人的观测深度分段自适应规划方法 |
CN107276684B (zh) * | 2017-07-19 | 2020-10-09 | 河海大学常州校区 | 水下传感器网络中基于auv位置预测的数据收集方法 |
CN107548029B (zh) * | 2017-08-21 | 2020-05-15 | 河海大学常州校区 | 一种基于海水分层的水下传感网络中auv数据收集方法 |
CN108045530A (zh) * | 2017-12-04 | 2018-05-18 | 国网山东省电力公司电力科学研究院 | 一种海底电缆探测水下机器人及作业方法 |
-
2018
- 2018-07-13 CN CN201810769809.9A patent/CN109213179B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109213179A (zh) | 2019-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100443369C (zh) | 深海太阳能潜水器 | |
CN106043632B (zh) | 一种深海无人潜航器的使用方法 | |
CN110803270B (zh) | Auv的浮力调节装置及控制方法 | |
US20120180712A1 (en) | Submersible vehicles and methods for transiting the same in a body of liquid | |
CN100357155C (zh) | 浮力和推进器双驱动方式远程自治水下机器人 | |
CN104527952B (zh) | 一种微型自主式水下航行器 | |
CN106394833A (zh) | 一种爬游混合型无人潜水器及其使用方法 | |
CN206171736U (zh) | 一种可变形半潜式无人船 | |
AU2016301238A1 (en) | Water drone | |
JPH0749277B2 (ja) | 重力・浮力調整による艇姿勢の制御を用いたグライダ−型潜水艇 | |
CN111645835A (zh) | 一种一带多水下无人子母潜航器 | |
CN112591059B (zh) | 水下航行器控制方法 | |
Yoshida et al. | An autonomous underwater vehicle with a canard rudder for underwater minerals exploration | |
CN110673615A (zh) | 一种自主水下无人航行器控制系统 | |
CN113734393A (zh) | 基于攻角法的仿生机器鱼定深控制方法和装置 | |
NO20190556A1 (en) | Underwater sailing body and method of controlling posture of underwater sailing body | |
Ahmad Mazlan | A fully actuated tail propulsion system for a biomimetic autonomous underwater vehicle | |
CN205916310U (zh) | 一种深海无人潜航器 | |
CN109213179B (zh) | 一种全海深auv折线式下潜控制方法 | |
Yokota et al. | Development and sea trial of an autonomous underwater vehicle equipped with a sub-bottom profiler for surveying mineral resources | |
CN109018278B (zh) | 适用于全海深auv的无纵倾无动力下潜方法及抑制纵倾装置 | |
KR20140139153A (ko) | 무인 잠수정과 그의 하강 및 승강 방법 | |
Spino et al. | Development and testing of unmanned semi-submersible vehicle | |
CN109213180A (zh) | 立扁体auv下潜过程中的安全抛载及深度控制方法 | |
JPH0749276B2 (ja) | グライダ−型潜水艇 |
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 |