CN103854302B - 一种多约束条件下的auv航行环境空间构建方法 - Google Patents
一种多约束条件下的auv航行环境空间构建方法 Download PDFInfo
- Publication number
- CN103854302B CN103854302B CN201310714121.8A CN201310714121A CN103854302B CN 103854302 B CN103854302 B CN 103854302B CN 201310714121 A CN201310714121 A CN 201310714121A CN 103854302 B CN103854302 B CN 103854302B
- Authority
- CN
- China
- Prior art keywords
- navigation
- curved surface
- auv
- lower boundary
- 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.)
- Expired - Fee Related
Links
Landscapes
- Processing Or Creating Images (AREA)
Abstract
本发明属于水下潜器航行环境空间建模技术领域,具体涉及一种多约束条件下的AUV航行环境空间构建方法。包括:构建初始航行上边界曲面;构建初始航行下边界曲面;下潜深度约束处理;最小离底间距约束处理;根据航行上、下边界曲面确定AUV航行环境空间。本发明提出一种多约束条件下的AUV航行环境空间构建方法,在考虑AUV航行约束条件下生成AUV航行的上边界曲面和下边界曲面,上述两个曲面构成了AUV的航行环境空间,基于该航行环境空间进行航路规划可以提高航路的实用性,同时降低了航路规划的计算量,进而可以提高航路规划效率。
Description
技术领域
本发明属于水下潜器航行环境空间建模技术领域,具体涉及一种多约束条件下的AUV航行环境空间构建方法。
背景技术
航行环境建模是对AUV航行所处的海洋环境空间进行抽象建模,以构建航路规划的规划空间。航行环境空间建模是航路规划的基础,直接影响规划的效率与精度。传统的航行空间建模方法一般将海底地形以上、海平面以下的空间作为AUV航行空间。这种建模方法一方面忽略了AUV自身的约束条件,导致在此环境中规划出的航路不能使用;另一方面加大了航路规划算法的计算量。
AUV的实际航行环境是一个三维空间,海底地形是海洋环境最基本的空间框架,构成了AUV航行环境的下边界。而为了保证不被敌方的空中侦察发现,AUV必须至少航行在海水透明度以下,透明度决定了AUV航行的上边界。因此,AUV的实际航行空间就是航行上、下边界之间的区域,我们可以通过构建航行边界曲面来确定航行空间。为了保证航行的安全和隐蔽,AUV航行过程中要充分考自身机动性能的约束,如每条AUV都有最大下潜深度和最小下潜深度的限制;为了保障航行的安全性,AUV与海底距离不能过小;上浮和下潜时,每条AUV都有一个最大升沉角度。因此,为了提高航行边界曲面的实用性,必须在构建航行边界曲面时考虑AUV航行过程中的约束条件。现有的文献表明,目前还没有关于多约束条件下的AUV航行环境空间构建方法方面的研究。
发明内容
本发明的目的在于提供一种提高航路规划效率的多约束条件下的AUV航行环境空间构建方法。
多约束条件下的AUV航行环境空间构建方法,包括以下步骤:
(1)构建初始航行上边界曲面
以透明度历史统计数据为基础数据源,采用二维三次卷积插值方法对数据进行插值,以生成初始航行上边界曲面;
(2)构建初始航行下边界曲面
以电子海图中的水深数据为基础数据,利用自然单元插值方法对水深数据进行插值,生成初始航行下边界曲面;
(2.1)根据AUV的航行区域选择电子海图作为基础数据源
根据AUV的航行任务确定航行的海域范围,以能够包围该海域的最大比例尺海图作为AUV航行区域最佳的基础数据源;
(2.2)从电子海图中提取水深数据,生成基础数据
提取步骤(2.1)确定的海图中航行区域内的水深点并以此存入水深点数据结构中;
(2.3)将岛屿、沉船、井架进行地形等价处理
将海洋中的岛屿等价位水深值为0的地形;将沉船、井架等价为海底地形,该处地形的深度为海水深度减去沉船或者井架的高度;
(2.4)对下边界高程数据进行插值,生成初始航行下边界曲面
采用自然单元插值对离散高程数据进行内插处理,生成初始航行下边界曲面
{Vdown(i)=(xi,yi,di),i=1,2,...,N};
其中,(xi,yi)表示水平坐标,di是(xi,yi)处的海深值;
(3)下潜深度约束处理
(3.1)航行上边界曲面下潜深度约束处理
对于上边界曲面上的任一点(xi,yi),设该点的透明度值为T0(xi,yi),AUV的最小下潜深度为hmin,进行最小下潜深度约束处理后的航行上边界曲面深度值Hup0(x,y)为:
(3.2)航行下边界曲面下潜深度约束处理
AUV的最大下潜深度为hmax,下边界曲面上的任一点(xi,yi)的水深值为Hbed(xi,yi),进行最大下潜深度约束处理后的航行下边界曲面深度值Hdown0(x,y)为:
(4)最小离底间距约束处理
AUV的最小离底间距为Hmin,即对于下边界曲面上的每一个网格点,处理后的下边界曲面深度值Hdown(xi,yi)为:
Hdown(xi,yi)=Hdown0(xi,yi)+Hmin;
(5)最大升沉角约束处理
最大升沉角对应航行曲面的坡度角,AUV的最大升沉角度为θ,相邻两个网格点i和i+1的属性值分别为v(i)和v(i+1),间隔为l,相邻两个网格点组成直线的坡度角为φ,
则调整坡度角,保证每一点的坡度均能满足最大升沉角约束
v(i)<v(i+1)时,
v(i)=v(i+1)时,坡度角为0,不需要进行处理;
v(i)<v(i+1)时,
(6)根据航行上、下边界曲面确定AUV航行环境空间
航行上边界曲面确定了航行环境空间的上边界,航行下边界曲面确定了航行环境空间的下边界,二者之间的空间既是AUV航行环境空间,航行环境空间中任意点(x0,y0),则该点的深度值H(x0,y0)应该满足如下关系:
Hup0(x0,y0)<H(x0,y0)<Hdown(x0,y0)。
本发明的优点在于:本发明提出一种多约束条件下的AUV航行环境空间构建方法,在考虑AUV航行约束条件下生成AUV航行的上边界曲面和下边界曲面,上述两个曲面构成了AUV的航行环境空间,基于该航行环境空间进行航路规划可以提高航路的实用性,同时降低了航路规划的计算量,进而可以提高航路规划效率。
附图说明
图1:本发明提出的航行环境空间生成流程图。
图2:本发明中采用的电子海图水深数据提取流程图。
图3:本发明中采用的三种坡度角示意图。
具体实施方式
下面对本发明的一种多约束条件下的AUV航行边界曲面生成方法进行详细说明。
本发明公开了一种多约束条件下的AUV航行边界曲面生成方法,主要包括以下步骤:
步骤一:初始航行上边界曲面构建。以透明度历史统计数据为基础数据,利用二维三次卷积插值方法对透明度数据进行插值,生成初始航行上边界曲面。
步骤二:初始航行下边界曲面构建。以电子海图中的水深数据为基础数据,利用二维三次卷积插值方法对透明度数据进行插值,生成初始航行下边界曲面。
步骤三:下潜深度约束处理。为了满足AUV的下潜深度约束,对初始航行上边界曲面进行最小下潜深度约束处理,对初始航行下边界曲面进行最大下潜深度约束处理。
步骤四:最小离底间距约束处理。为了满足AUV的最小离底间距约束,对初始航行下边界曲面进行最小离底间距约束处理。
步骤五:最大深沉角约束处理。为了满足AUV的最大深沉角约束,对航行上边界曲面和航行下边界曲面分别进行最小离底间距约束处理。
步骤六:根据航行上、下边界曲面确定AUV航行环境空间。
具体步骤如下:
步骤一:初始航行上边界曲面构建。
在考虑AUV机动和物理约束条件下,总可以找到这么一个曲面,在该曲面之下的区域可以满足AUV的航行要求,而该曲面以上的空间不利于AUV的航行隐蔽,我们将该曲面定义为AUV航行上边界曲面。
AUV航行上边界曲面可以看作一种离散的数学表达,具体用一个三维向量有限序列来表示:
{Vup(i)=(xi,yi,ti),i=1,2,...,N} (1)
其中,(xi,yi)表示水平坐标,ti是(xi,yi)处的深度值。
海水透明度是影响AUV隐蔽航行的重要因素。因此,可以以透明度数据为基础数据,利用二维三次卷积插值方法对透明度数据进行插值,生成初始航行上边界曲面。海水透明度随时间变化很小,因此历史统计数据可以反映真实透明度分布情况。透明度历史统计数据以网格的形式存在,对于非网格点位置的数据无法直接获得。但是,在生成上边界曲面的过程中需要用到航行范围内任意点的透明度数据,这就需要对透明度历史统计数据进行插值处理,从而获得任意非网格点的透明度值。本专利采用二维三次卷积插值方法对透明度数据进行插值,以生成透明度曲面,进而生成初始航行上边界曲面。
步骤二:初始航行下边界曲面构建。
在实际的航行过程中,并不是海有多深AUV的航行深度就可到达多深。考虑AUV所受的各种约束条件,总可以找到这么一个曲面,该曲面以上的空间可以满足AUV的航行要求,而曲面之下的区域是AUV不能到达的。我们把该曲面定义为AUV航行下边界曲面。航行下边界曲面可以看作是对海底地形的一种离散的数学表达,用一个三维向量有限序列来表示:
{Vdown(i)=(xi,yi,di),i=1,2,...,N} (2)
其中,(xi,yi)表示水平坐标,di是(xi,yi)处的海深值。
以电子海图中的水深数据为基础数据,利用自然单元插值方法对透明度数据进行插值,生成初始航行下边界曲面。具体流程如下:
步骤2.1根据AUV的航行区域选择电子海图作为基础数据源
为了使生成的地形更真实,细节更详尽,需要选择水深数据相对密集的海图。而比例尺越大的电子海图信息量越大,根据这一原则,电子海图的选择方法如下:首先根据AUV的航行任务确定航行的海域范围,然后搜索电子海图库,找到能够包围该海域的最大比例尺海图,该海图即可作为AUV航行区域最佳的基础数据源。
步骤2.2从电子海图中提取水深数据,生成基础数据
电子海图中的水深数据与海底地形相关,水深数据是点状要素,存储在单独的水深图层中。水深数据的提取流程如下:首先遍历选步骤2.1确定的海图中的所有要素,找到与航行区域有交集的水深图层,依次读取水深点,如果当前水深点在航行区域内则提取该点,并存入水深点的数据结构中,如此循环,直到提取出航行区域中的所有水深数据。水深点的数据结构如下:
步骤2.3将岛屿、沉船、井架等进行地形等价处理
AUV的航行环境是海洋,海洋中的岛屿、沉船、井架等构成了航行障碍物。为了便于建模,必须对上述要素进行等价处理。具体处理方法如下:对于海洋中的岛屿,将其等价为海底地形,水深设置为0;对于沉船、井架,等价为海底地形,该处地形的深度为海水深度减去沉船或者井架的高度。
步骤2.4对下边界高程数据进行插值,生成初始航行下边界曲面
从电子海图中提取的水深数据是离散分布的,数据量也很少,为了生成连续的海底地形曲面,必须对水深数据进行位置变换和加密处理,即进行内插。内插方法很多,鉴于海底地形具有连续性的特点,某点的水深值受其周围水深点的影响较大,而受与其距离较远的水深点的影响较小,因此本专利采用自然单元插值对离散高程数据进行处理。
步骤三:下潜深度约束处理。
为了满足AUV的下潜深度约束,对初始航行上边界曲面进行最小下潜深度约束处理,对初始航行下边界曲面进行最大下潜深度约束处理。具体处理方法分为以下两个步骤:
步骤3.1航行上边界曲面约束处理
最小下潜深度决定着AUV隐蔽航行空间的上边界。根据AUV自身的性能约束,每条AUV都有一个最小下潜深度hmin,只有在最小下潜深度以下才能保证其航行的隐蔽性和稳定性。因此,考虑最小下潜深度后航行上边界曲面Hup0(x,y)应该表示如下:
其中,(xi,yi)表示航行上边界曲面上的任意点,T0(xi,yi)表示该点的透明度值。
步骤3.2航行下边界曲面约束处理
最大下潜深度决定着AUV航行空间的下边界。根据AUV自身的性能约束,每条AUV都有一个最大下潜深度hmax,只有在最大下潜深度以上航行才能保证其航行安全。因此,考虑最大下潜深度后航行下边界曲面Hdown0(x,y)应该表示如下:
其中,(xi,yi)表示航行下边界曲面上的任意点,Hbed(xi,yi)表示该点的水深值。
步骤四:最小离底间距约束处理。
为了保证AUV的航行安全,每一条AUV都有一个最小离底间距Hmin。为了满足这个约束,可以直接将该值与下边界航行曲面相叠加,以保证下边界曲面以上的区域均是安全的。即对于下边界曲面上的每一个网格点,由:
Hdown(xi,yi)=Hdown0(xi,yi)+Hmin (5)
其中,(xi,yi)表示航行下边界曲面上的任意点,Hdown0(xi,yi)表示施加最小离底间距约束前的水深值。
步骤五:最大升沉角约束处理。
最大升沉角对应航行曲面的坡度角。设AUV的最大升沉角度为θ,插值后相邻的两个网格点i和i+1的属性值分别为v(i)和v(i+1),间隔为l,相邻两个网格点组成直线的坡度角为φ,则:
坡度角为φ存在如图3所示的三种情况。
对于第二种情况,坡度角为0,不需要进行处理。对于另外两种情况,则需要判断AUV升沉角和坡度角的关系进行相应处理。如果坡度角为φ大于AUV的最大升沉角度为θ,那么需要调整网格点i的值,使坡度角为φ的值等于AUV的最大升沉角度为θ,否则就不需要调整。
第一种情况需要调整网格点i的属性值,处理方式如下:
第三种情况需要调整网格点i+1的属性值,处理方式如下:
按照上述两个公式分别对组成上下两个边界曲面的网格点沿x,y方向逐个进行处理,即可得到满足最大升沉角度约束的边界曲面。
步骤六:根据航行上、下边界曲面确定AUV航行环境空间
航行上边界曲面确定了航行环境空间的上边界,航行下边界曲面确定了航行环境空间的下边界,二者之间的空间既是AUV航行环境空间。设航行环境空间中任意点(x0,y0),则该点的深度值H(x0,y0)应该满足如下关系:
Hup0(x0,y0)<H(x0,y0)<Hdown(x0,y0) (9)
Claims (1)
1.一种多约束条件下的AUV航行环境空间构建方法,其特征在于,包括以下步骤:
(1)构建初始航行上边界曲面
以透明度历史统计数据为基础数据源,采用二维三次卷积插值方法对数据进行插值,以生成初始航行上边界曲面;
(2)构建初始航行下边界曲面
以电子海图中的水深数据为基础数据,利用自然单元插值方法对水深数据进行插值,生成初始航行下边界曲面;
(2.1)根据AUV的航行区域选择电子海图作为基础数据源
根据AUV的航行任务确定航行的海域范围,以能够包围该海域的最大比例尺海图作为AUV航行区域最佳的基础数据源;
(2.2)从电子海图中提取水深数据,生成基础数据
提取步骤(2.1)确定的海图中航行区域内的水深点并以此存入水深点数据结构中;
(2.3)将岛屿、沉船、井架进行地形等价处理
将海洋中的岛屿等价位水深值为0的地形;将沉船、井架等价为海底地形,该处地形的深度为海水深度减去沉船或者井架的高度;
(2.4)对下边界高程数据进行插值,生成初始航行下边界曲面
采用自然单元插值对离散高程数据进行内插处理,生成初始航行下边界曲面
{Vdown(i)=(xi,yi,di),i=1,2,...,N};
其中,(xi,yi)表示水平坐标,di是(xi,yi)处的海深值;
(3)下潜深度约束处理
(3.1)航行上边界曲面下潜深度约束处理
对于上边界曲面上的任一点(xi,yi),设该点的透明度值为T0(xi,yi),AUV的最小下潜深度为hmin,进行最小下潜深度约束处理后的航行上边界曲面深度值Hup0(xi,yi)为:
(3.2)航行下边界曲面下潜深度约束处理
AUV的最大下潜深度为hmax,下边界曲面上的任一点(xi,yi)的水深值为Hbed(xi,yi),进行最大下潜深度约束处理后的航行下边界曲面深度值Hdown0(xi,yi)为:
(4)最小离底间距约束处理
AUV的最小离底间距为Hmin,即对于下边界曲面上的每一个网格点,处理后的下边界曲面深度值Hdown(xi,yi)为:
Hdown(xi,yi)=Hdown0(xi,yi)+Hmin;
(5)最大升沉角约束处理
最大升沉角对应航行曲面的坡度角,AUV的最大升沉角度为θ,相邻两个网格点i和i+1的属性值分别为v(i)和v(i+1),间隔为l,相邻两个网格点组成直线的坡度角为φ,
则调整坡度角,保证每一点的坡度均能满足最大升沉角约束
v(i)<v(i+1)时,
v(i)=v(i+1)时,坡度角为0,不需要进行处理;
v(i)<v(i+1)时,
(6)根据航行上、下边界曲面确定AUV航行环境空间
航行上边界曲面确定了航行环境空间的上边界,航行下边界曲面确定了航行环境空间的下边界,二者之间的空间既是AUV航行环境空间,航行环境空间中任意点(x0,y0),则该点的深度值H(x0,y0)应该满足如下关系:
Hup0(x0,y0)<H(x0,y0)<Hdown(x0,y0)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310714121.8A CN103854302B (zh) | 2013-12-23 | 2013-12-23 | 一种多约束条件下的auv航行环境空间构建方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310714121.8A CN103854302B (zh) | 2013-12-23 | 2013-12-23 | 一种多约束条件下的auv航行环境空间构建方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103854302A CN103854302A (zh) | 2014-06-11 |
CN103854302B true CN103854302B (zh) | 2016-09-28 |
Family
ID=50861912
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310714121.8A Expired - Fee Related CN103854302B (zh) | 2013-12-23 | 2013-12-23 | 一种多约束条件下的auv航行环境空间构建方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103854302B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104390646B (zh) * | 2014-09-15 | 2017-06-16 | 东南大学 | 水下潜器地形辅助惯性导航***的位置匹配方法 |
CN106003104B (zh) * | 2015-07-03 | 2018-05-11 | 中国运载火箭技术研究院 | 一种适用于多约束条件下视觉信息导引的机械臂规划方法 |
CN112987762B (zh) | 2021-05-10 | 2021-09-07 | 北京三快在线科技有限公司 | 一种轨迹规划方法、装置、存储介质及电子设备 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101650837A (zh) * | 2009-07-16 | 2010-02-17 | 浙江大学 | 一种海洋水体虚拟现实的建模方法 |
CN102831645A (zh) * | 2012-07-18 | 2012-12-19 | 哈尔滨工程大学 | 一种应用于海底地形的数字高程模型的建立方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7358969B2 (en) * | 2004-09-27 | 2008-04-15 | International Business Machines Corporation | Method and system for partitioning the surface of a three dimentional digital object model in order to map a texture |
-
2013
- 2013-12-23 CN CN201310714121.8A patent/CN103854302B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101650837A (zh) * | 2009-07-16 | 2010-02-17 | 浙江大学 | 一种海洋水体虚拟现实的建模方法 |
CN102831645A (zh) * | 2012-07-18 | 2012-12-19 | 哈尔滨工程大学 | 一种应用于海底地形的数字高程模型的建立方法 |
Non-Patent Citations (3)
Title |
---|
《Geometric Primitives-Based AUV Path Planning In Cluttered Waterspaces》;Matko Barisic等;《Procedings of Ifac Conference on Control Applications in Marine Systems》;20101231;全文 * |
《基于蚁群算法的水下潜器三维空间路径规划》;刘利强等;《***仿真学报》;20080731;第20卷(第14期);全文 * |
《并入约束的二次曲面重构》;王素等;《机械科学与技术》;20040831;第23卷(第8期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN103854302A (zh) | 2014-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103344954B (zh) | 一种基于多来源水深数据融合的海底地形地貌构建方法 | |
CN106503837B (zh) | 一种基于改进水平集算法的时间最优航路规划方法 | |
CN103854302B (zh) | 一种多约束条件下的auv航行环境空间构建方法 | |
CN103900573A (zh) | 一种基于s57标准电子海图的水下运载器多约束航路规划方法 | |
CN108489491A (zh) | 一种水下自主航行器的三维航迹智能规划方法 | |
CN110796741B (zh) | 一种基于双向布料模拟的机载激光测深点云滤波方法 | |
CN101806596A (zh) | 基于电子海图的最短距离航线自动生成方法 | |
Maki et al. | Volumetric mapping of tubeworm colonies in Kagoshima Bay through autonomous robotic surveys | |
CN111412918B (zh) | 无人艇全局安全路径规划方法 | |
Zhao et al. | Optimisation of hull form of ocean-going trawler | |
Pérez-Arribas | Parametric generation of planing hulls | |
Frey et al. | New model and field data on estimates of Antarctic Bottom Water flow through the deep Vema Channel | |
CN106652030A (zh) | 三维数字航道图的生成与发布方法 | |
CN111591407B (zh) | 一种船体型线特征参数提取方法 | |
Zhou et al. | Simulation of hydrodynamic interaction forces acting on a ship sailing across a submerged bank or an approach channel | |
CN110334137B (zh) | 一种基于潮汐过程的海岛礁形态变化定量描述提取方法 | |
CN104156527A (zh) | 一种用于航海模拟器仿真的雷达模拟数据合并方法 | |
Engsig-Karup et al. | A Stabilised Nodal Spectral Element Method for Fully Nonlinear Water Waves, Part 2: Wave-body interaction | |
Zhou et al. | Ship-Ship hydrodynamic interaction in confined waters with complex boundaries by a Panelled Moving Patch Method | |
CN113239520B (zh) | 一种近水底三维水下地形环境建模方法 | |
Nomikou et al. | Morphological analysis and related volcanic features of the Kolumbo submarine volcanic chain (NE of Santorini Island, Aegean Volcanic Arc) | |
TWI719711B (zh) | 水下地形淤泥量探測方法 | |
CN113124873A (zh) | 基于海洋环境信息的uuv多指标约束三维航路规划方法 | |
CN104239635B (zh) | 一种内河电子海图上可航区域中心线自动绘制方法 | |
CN109143359B (zh) | 一种基于地震数据的海底水道定量描述参数自动提取方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160928 Termination date: 20211223 |
|
CF01 | Termination of patent right due to non-payment of annual fee |