CN113009924A - 一种基于非二次型逆最优控制的水下无人器避障方法 - Google Patents
一种基于非二次型逆最优控制的水下无人器避障方法 Download PDFInfo
- Publication number
- CN113009924A CN113009924A CN202110248990.0A CN202110248990A CN113009924A CN 113009924 A CN113009924 A CN 113009924A CN 202110248990 A CN202110248990 A CN 202110248990A CN 113009924 A CN113009924 A CN 113009924A
- Authority
- CN
- China
- Prior art keywords
- obstacle avoidance
- underwater
- obstacle
- quadratic
- optimal control
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 52
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 20
- 238000001514 detection method Methods 0.000 claims abstract description 14
- 239000013598 vector Substances 0.000 claims description 11
- 230000004888 barrier function Effects 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 230000006870 function Effects 0.000 abstract description 55
- 238000012544 monitoring process Methods 0.000 description 5
- 239000003795 chemical substances by application Substances 0.000 description 3
- 238000013461 design Methods 0.000 description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000009472 formulation Methods 0.000 description 1
- 239000012535 impurity Substances 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000012795 verification 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/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-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)
Abstract
本发明公开一种基于非二次型逆最优控制的水下无人器避障方法:建立每个多无人水下潜航器的二阶动力学模型,同时定义误差状态和状态空间描述;建立三个代价函数,分别表示编队成形代价函数、避障代价函数和控制能量代价函数,同时定义障碍物范围、检测范围和避障安全范围;针对海底礁石或山峰等障碍物,抽象建立海底锥形非二次型避障势函数,同时在势函数中加入改进避障角度调整法;最后从逆最优控制角度推导得到最优编队成形和避障的控制输入,在成形过程中避免障碍,同时控制输入最优。本发明构建了一种新的海底避障模型和势函数,依据传统圆形检测范围和角度调整法进行改进,以期达到水下复杂环境多水下无人器成形过程中的快速避障。
Description
技术领域
本发明属于水下多智能体模型编队成形和避障领域,具体涉及一种基于非二次型逆最优控制的水下无人器避障方法。
背景技术
在最近几年中,关于海域无人系统的应用越来越广泛,水下无人器的技术与复杂程度越来越高,在海洋科考、水下探索和军事反潜与探测等领域有广泛应用。但是单个的复杂水下无人器的成本较高,在一些需要大面积监视的水下监视情况下,单个无人器不能完成大面积海域态势感知,因此多个低成本,高鲁棒性的水下无人器受到越来越多的研究人员关注。传统的海域态势感知与监测是通过在水下或水面布置大量的静态传感器如浮标或水下声呐等,这样虽然可以大面积覆盖,但只能实现特定区域或近海布置,不具有广泛的灵活性。因此在多个水下无人器上装配传感器可以通过水下自主移动实现对不同目标海域实现监测甚至追踪。同时,由于水下环境的复杂性,不同的水下自主潜航器在前往目标海域的路径可能不同,在路径过程中可能存在障碍物等环境因素,因此避免与水下障碍物发生碰撞时实现海域目标监测感知的必要前提,为多无人水下潜航器设计成形编队的同时考虑路径障碍物避障显得尤为重要。
在具有避障功能的一致性成形问题中,大多数避障研究的领域主要集中在路径规划和人工势场法,传统的路径规划需要构造网格地图,必须提前规划好轨迹,一般应用在对轨迹要求比较高的场合,针对水下环境,许多的障碍物可能并不能满足构造网格地图,而且需要对障碍物避碰越快越好,采用势函数法可能会更容易实现避障。在关于势函数的避障研究中,大量学者的研究集中在二维平面内比较理想的避障形状和区域中,在二维平面的避障区域大多为圆形障碍物区域,少数为方形。三维空间中避障的障碍物往往抽象成方体,而在考虑到水下障碍物的情况比较复杂,一般不能将障碍物抽象成类似方体和球体,一般礁石类或海底山峰类障碍物是水下比较常见的障碍物类型,这类障碍物可以统一建模成圆锥三维模型,这样水下无人器可以根据所遇障碍物高度来改变避障区域的大小,同时改进传统的圆形检测法,利用角度调整法优化避障角度,避免避障路径发生冗杂,达到快速避障的目的。
本发明公开的方法是基于一种非二次型势函数的逆最优控制方法,其中非二次型势函数负责进行避障控制输入,逆最优控制法可以同时设计水下无人器编队成形和避障控制输入。因此对于水下编队和成形过程中的避障问题具有很大的意义。
发明内容
发明目的:本发明针对水下二阶动力学建模的无人器对海底山峰或礁石类障碍物实现快速避障并达到编队成形位置。
技术方案:本发明为解决上述问题提出一种基于非二次型逆最优控制的水下无人器避障方法。本发明计划与设计方案主要集中在以下工作步骤:
(1)建立非二次型逆最优控制水下自主潜航器的二阶运动学模型;
(2)根据逆最优控制法,建立成形代价函数、非二次型避障代价函数、控制量代价函数,定义水下锥形障碍物范围、检测范围和避障范围;
(3)建立障碍物抽象几何模型,同时设计基于速度和位置的非二次型避障势函数,依据改进的角度调整法设立快速避障安全范围;
(4)根据逆最优控制原理和李雅普诺夫原理推导并计算成形与非二次型避障两个部分的控制输入律。
步骤(1)建立水下自主潜航器的二阶运动学所需模型的表达式为:
其中,X代表系统位置状态,V代表速度状态,U代表控制输入。
步骤(2)所述中编队成形代价函数和控制量代价函数表达式设计如下:
步骤(2)需要同时定义各个范围,用来衡量避障的情况:
碰撞区域:
检测区域:
安全区域:
步骤(3)所述建立锥形障碍物抽象避障模型,锥形模型不同高度的水平切面可以看做不同半径的圆形障碍物组合,其中水平面半径由锥形模型的高度决定:
步骤(3)所述中依据速度和位置向量定义的障碍物势函数表达式如下:
步骤(4)所述控制输入律由以下两部分组成:
其中表达式前一项是保证编队成形的控制输入,后一项是非二次型势函数所得出的避障控制输入。
相对于现有技术本发明的优点为:
一 本发明相比传统二维平面避障,提出了一种将山峰威胁模型应用到水下无人器避障,建立锥形避障抽象模型;
二 本发明应用一种非二次型避障势函数方法,可以结合逆最优控制法得到水下无人器编队成形与避障控制输入;
三 本发明改进了传统的圆形避障区域中的角度调整方法,使之适应建立的锥形避障区域,可以达到快速避障的目的,避免避障路径产生冗杂。
附图说明
图1:本发明所应用的锥形山峰威胁模型;
图2:本发明所述改进的角度调整法快速避障示意图;
图3:本发明所述基于非二次型避障势函数逆最优控制结构图;
图4:本发明所述水下无人系统针对锥形障碍物避障仿真结果图;
图5:本发明图4中仿真结果X轴方向放大图;
图6:本发明一种基于非二次型逆最优控制的水下无人器避障方法流程图。
具体实施方式
一种基于非二次型逆最优控制的水下无人器避障方法,用于针对水下二阶动力学建模的无人器对海底山峰或礁石类障碍物实现快速避障并达到编队成形位置。本发明建立二阶水下无人器动力模型、基于角度调整快速避障范围模型和锥形类障碍物模型(模拟山峰或礁石),设立成形、避障、控制量三个代价函数。设计非二次型避障势函数和逆最优控制输入。依据技术方案,进行非二次型逆最优控制的水下无人器避障与编队成形的理论假设、计算与验证,具体步骤如下:
步骤一:针对非二次型逆最优控制的要求建立水下自主潜航器的二阶运动学模型:
其中,X代表系统位置状态,V代表速度状态,U代表控制输入。
步骤二:针对逆最优控制的要求分别建立成形代价函数、避障代价函数、控制量代价函数,定义障碍物范围、检测范围和避障范围;
编队成形代价函数和控制量代价函数定义如下:
其中Q,R是权值矩阵。
成本函数需要单独定义,其具体的形式需要在后面进行逆最优控制的推导,其定义为:
所有的代价函数如下:
min:J=J1+J2
同时定义各个范围,用来衡量避障的情况:
碰撞区域:
检测区域:
安全区域:
步骤三:针对水下常见礁石或山峰类障碍物建立锥形几何模型,同时设计基于速度和位置的非二次型避障势函数,依据改进的角度调整法设立快速避障安全范围:
锥形模型不同高度的水平切面可以看做不同半径的圆形障碍物组合,其中水平面半径由锥形模型的高度决定:
定义障碍物的非二次型避障势函数:
从附图2中可以看出:
如果无人器的期望位置在障碍物水平线上方则:
如果期望位置在障碍物水平线下方:
期望的避障速度矢量为:
步骤四:根据步骤三中的避障势函数和逆最优控制法设计推导并计算成形与避障两个部分的控制输入律:
首先考虑以下动力学系统:
其中f(0,0)=0,成本函数如下:
D→Ω:
V(0)=0 (12)
φ(0)=0 (14)
则可以设计如下控制律:
其能量函数为:
系统状态方程可以重新表述为:
其性质是连续可微的,P是黎卡提方程的解。哈密顿函数可以写成如下形式:
其中矩阵函数对向量的求导分别为:
同样带入到哈密顿函数中:
为了满足中的上述公式中的(16),令公式(28)和(29)为零,可以分别得到以下条件:
其中(30)是黎卡提方程,可以求解出满足条件的矩阵P,(31)中令:
可知条件公式(13)满足,根据公式(16)和(30),哈密顿函数可以重新推导如下:
上述公式中(17)得证,公式中(15)如下计算:
V(0)=0
则满足上述公式中的(12)和(14).
至此,当时间趋于无穷时,趋于零,则达到期望的编队形状,则反馈控制律是最优解,闭环系统也是全局渐进稳定的。本发明中的控制律(20)中由两部分组成,前一项可以实现编队的成形。后一项是非二次型势函数最优控制项,负责实现水下障碍物的快速避障。
综上所述:本发明公开一种基于非二次型避障势函数与逆最优控制的水下多无人器避障与成形方法。方法包括:首先建立每个多无人水下潜航器的二阶动力学模型,同时定义误差状态和状态空间描述。其次建立三个代价函数,分别表示编队成形代价函数、避障代价函数和控制能量代价函数,同时定义障碍物范围、检测范围和避障安全范围。然后,考虑水下特定环境,针对海底礁石或山峰等障碍物,抽象建立海底锥形非二次型避障势函数,同时为达到快速避障和避免路径冗余的目的,在势函数中加入改进避障角度调整法。最后从逆最优控制角度推导得到最优编队成形和避障的控制输入,在成形过程中避免障碍,同时控制输入最优。本发明构建了一种新的海底避障模型和势函数,依据传统圆形检测范围和角度调整法进行改进,以期达到水下复杂环境多水下无人器成形过程中的快速避障。
Claims (5)
1.一种基于非二次型逆最优控制的水下无人器避障方法,其特征在于,包括于以下步骤:
(1)建立非二次型逆最优控制水下自主潜航器的二阶运动学模型;
(2)根据逆最优控制法,建立成形代价函数、非二次型避障代价函数、控制量代价函数,定义水下锥形障碍物范围、检测范围和避障范围;
(3)建立障碍物抽象几何模型,同时设计基于速度和位置的非二次型避障势函数,依据改进的角度调整法设立快速避障安全范围;
(4)根据逆最优控制原理和李雅普诺夫原理推导并计算成形与非二次型避障两个部分的控制输入律。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110248990.0A CN113009924A (zh) | 2021-03-08 | 2021-03-08 | 一种基于非二次型逆最优控制的水下无人器避障方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110248990.0A CN113009924A (zh) | 2021-03-08 | 2021-03-08 | 一种基于非二次型逆最优控制的水下无人器避障方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113009924A true CN113009924A (zh) | 2021-06-22 |
Family
ID=76407776
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110248990.0A Pending CN113009924A (zh) | 2021-03-08 | 2021-03-08 | 一种基于非二次型逆最优控制的水下无人器避障方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113009924A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113721638A (zh) * | 2021-08-03 | 2021-11-30 | 哈尔滨工程大学 | 一种水域异构多无人器一致性编队方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9262929B1 (en) * | 2014-05-10 | 2016-02-16 | Google Inc. | Ground-sensitive trajectory generation for UAVs |
CN111522351A (zh) * | 2020-05-15 | 2020-08-11 | 中国海洋大学 | 水下机器人三维编队及避障方法 |
WO2020253028A1 (zh) * | 2019-06-18 | 2020-12-24 | 华南理工大学 | 一种基于航迹重规划的水面无人艇动态避碰方法 |
-
2021
- 2021-03-08 CN CN202110248990.0A patent/CN113009924A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9262929B1 (en) * | 2014-05-10 | 2016-02-16 | Google Inc. | Ground-sensitive trajectory generation for UAVs |
WO2020253028A1 (zh) * | 2019-06-18 | 2020-12-24 | 华南理工大学 | 一种基于航迹重规划的水面无人艇动态避碰方法 |
CN111522351A (zh) * | 2020-05-15 | 2020-08-11 | 中国海洋大学 | 水下机器人三维编队及避障方法 |
Non-Patent Citations (4)
Title |
---|
JIANAN WANG等: "Integrated Optimal Formation Control of Multiple", 《IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY》 * |
XUEKUAN YANG等: "Distributed optimal consensus with obstacle avoidance algorithm of", 《ISA TRANSACTIONS》 * |
李桂芳等: "一类非线性耗散系统的逆最优控制", 《控制与决策》 * |
魏瑞轩等: "无人机自主防碰撞控制技术新进展", 《科技导报》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113721638A (zh) * | 2021-08-03 | 2021-11-30 | 哈尔滨工程大学 | 一种水域异构多无人器一致性编队方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Jin et al. | Six-degree-of-freedom hovering control of an underwater robotic platform with four tilting thrusters via selective switching control | |
CN105353763B (zh) | 一种非合作目标航天器相对轨道姿态有限时间控制方法 | |
CN108427414A (zh) | 一种自主水下航行器水平面自适应轨迹跟踪控制方法 | |
Kong et al. | Dynamics modeling and motion control of an new unmanned underwater vehicle | |
Sun et al. | A formation collision avoidance system for unmanned surface vehicles with leader-follower structure | |
CN110609556A (zh) | 一种基于los导航法的多无人艇协同控制方法 | |
CN111650948A (zh) | 一种可底栖式auv的水平面轨迹快速跟踪控制方法 | |
Jagtap et al. | Control of autonomous underwater vehicle using reduced order model predictive control in three dimensional space | |
CN105425812B (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
Guo et al. | Study on the autonomous multirobot collaborative control system based on spherical amphibious robots | |
Sverdrup-Thygeson et al. | A control framework for biologically inspired underwater swimming manipulators equipped with thrusters | |
Fan et al. | Formation control of multiple unmanned surface vehicles using the adaptive null-space-based behavioral method | |
Khalaji et al. | Lyapunov-based formation control of underwater robots | |
Xin et al. | Overview of research on transformation of multi-AUV formations | |
Wang et al. | Path following control of the wave glider in waves and currents | |
CN109739249B (zh) | 一种速度状态缺失条件下的多uuv编队协调控制方法 | |
CN113721638A (zh) | 一种水域异构多无人器一致性编队方法 | |
Zhu et al. | A hybrid control strategy of 7000 m-human occupied vehicle tracking control | |
CN113009924A (zh) | 一种基于非二次型逆最优控制的水下无人器避障方法 | |
Yu et al. | 3D path following for under-actuated AUV via nonlinear fuzzy controller | |
CN114779647A (zh) | 无人艇集群的围堵控制方法 | |
Xu et al. | Trajectory tracking for underwater rescue salvage based on backstepping control | |
CN114564015B (zh) | 一种拒止环境下的欠驱动无人艇分布式编队控制方法 | |
Mohamed et al. | Dynamic model and control of an autonomous underwater vehicle | |
Padir | Kinematic redundancy resolution for two cooperating underwater vehicles with on-board manipulators |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210622 |
|
RJ01 | Rejection of invention patent application after publication |