CN112034865B - 基于优化算法的全驱动水下航行器航迹跟踪控制方法 - Google Patents
基于优化算法的全驱动水下航行器航迹跟踪控制方法 Download PDFInfo
- Publication number
- CN112034865B CN112034865B CN202010807187.1A CN202010807187A CN112034865B CN 112034865 B CN112034865 B CN 112034865B CN 202010807187 A CN202010807187 A CN 202010807187A CN 112034865 B CN112034865 B CN 112034865B
- Authority
- CN
- China
- Prior art keywords
- aircraft
- speed
- track
- attitude
- constraint
- 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
- 238000005457 optimization Methods 0.000 title claims abstract description 40
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 17
- 239000013598 vector Substances 0.000 claims abstract description 29
- 239000011159 matrix material Substances 0.000 claims description 29
- 238000013461 design Methods 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 2
- 238000013016 damping Methods 0.000 claims description 2
- 238000003032 molecular docking Methods 0.000 description 5
- 238000004088 simulation Methods 0.000 description 5
- 238000013459 approach Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 239000002131 composite material Substances 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 210000001503 joint Anatomy 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 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
技术领域
本发明涉及水下航行器航迹跟踪控制技术领域,具体地说,涉及一种基于优化算法的全驱动水下航行器航迹跟踪控制方法。
背景技术
水下航行器是海洋工程,如水下管道检查,三维地形测绘,高价值目标搜索中的重要工具,而三维航迹跟踪是水下航行器执行这些任务的基础问题。目前有多种算法已经成功应用于水下航行器的航迹跟踪,例如自适应控制、滑模控制、神经网络控制、模糊控制等,根据适用对象不同可分为欠驱动航行器和全驱动航行器控制算法。
就三维航迹跟踪问题来说,欠驱动航行器,如常见的鱼雷型航行器,可提供纵荡,纵摇和横摇方向上的控制,且这些方向上的控制必须被全部利用以跟踪三维航迹。
而全驱动航行器的优势在于六自由度运动均可控制,因此若给出一条空间三维航迹,且不考虑运行中的姿态,全驱动航行器的控制是存在冗余的。然而,航行器的运行姿态在进行某些任务时至关重要:在执行回坞任务时,错误的姿态会导致航行器无法与泊坞接驳;对于地形测量任务,航行器本身的俯仰或者横滚会影响测量精度。
公布号为CN105527967A的发明专利文献公开了一种AUV反演对接控制方法,AUV的头部安装有USBL收发器,回收站的两侧安装两个USBL应答器B1和B2;在AUV靠近对接站的过程中,AUV通过USBL定位***获取应答器在体坐标系中的位置,AUV应答器位置测量方程式对时间求导,在AUV体坐标系中定义对接误差。对接过程中AUV处于全驱动航行模式,针对对接误差,设计非线性反演控制器,使AUV沿着期望的直线航迹航行直至抵达对接站。
另有公布号为CN109634307A的发明专利文献公开了一种无人水下航行器复合航迹跟踪控制方法,包括以下步骤:S1:结合运动学模型和动力学模型构建大地坐标系下的无人水下航行器动态模型;S2:在无人水下航行器动态模型的基础上进行变量变换:S3:根据所设计的水下航行器控制器定义Lyapunov函数,采用矩阵Young不等式求出Lyapunov函数关于时间的导数,证明该复合航迹跟踪控制方法有限时间内趋于稳定、航迹跟踪误差有限时间内趋近于零;S4:模拟海洋环境下的风、浪、流扰动环境,设置无人水下航行器期望航迹,设计仿真实验证明所提出控制方法的有效性和优越性。
然而,现有技术没有关注到在航迹跟踪问题中的约束,由于航行器在各自由度上能达到的速度受限于航行器的推力配置与水动力性能,使得约束成为航迹跟踪问题中不容忽视的对象。
发明内容
本发明的目的是提供一种基于优化算法的全驱动水下航行器航迹跟踪控制方法,解决全驱动航行器在跟踪三维曲线中的冗余问题,同时考虑了航行器在运动过程中的姿态和速度约束问题。
为了实现上述目的,本发明提供的基于优化算法的全驱动水下航行器航迹跟踪控制方法,包括:获得航行器的运动参数,设计其运动姿态约束向量和速度约束向量;然后计算跟踪误差,并根据航行器的六自由度模型得到运动学控制器和动力学控制器;最后由运动学控制器得到期望速度,由动力学控制器推导出个自由度上的力和力矩;直至航迹跟踪完成。
具体的,包括以下步骤:
2)设航行器的运动姿态约束向量为η2h=[φmax,θmax,ψmax]T和η2l=[φmin,θmin,ψmin]T,其元素分别代表横滚、俯仰和偏航角允许的最大值和最小值;速度约束向量为vh=[umax,vmax,wmax,pmax,qmax,rmax]T和vl=[umin,vmin,wmin,pmin,qmin,rmin]T,其元素表示各自由度上的线速度和角速度限制;
3)根据航行器当前坐标与期望的三维航迹计算跟踪误差e;
4)根据给定的全驱动航行器六自由度模型得到运动学控制器,求得期望速度vd;
5)根据给定的全驱动航行器六自由度模型得到动力学控制器,推导出各自由度上的力和力矩;
6)判断航迹是否跟踪完成,若期望航迹中规划的时间已到,则认为跟踪完成,否则返回步骤2)。
上述技术方案中,通过建立航行器六自由度运动学和动力学模型以反步控制方法构造反馈控制器,选择速度约束构造优化问题的可行域,利用姿态角度构造加权函数,导出运动学优化问题。求解此优化问题得到虚拟控制,即期望速度;再根据反步控制方法和动力学模型得到动力学反馈控制律,使实际速度收敛到期望速度,并在建立的航行器模型上进行模拟。结果表明,针对同一航行器跟踪同一航迹并设置不同的速度和姿态约束,航行器每次运行模式不同,且都满足设置的约束。同时,航行器的空间位置也收敛到所在航迹上。
可选地,步骤3)中,跟踪误差e的计算公式如下:
e=RT(η1-η1d)
其中,η1d是期望的三维航迹,
可选地,步骤4)中,利用所述运动姿态约束向量得到优化权重,利用所述速度约束向量得到优化可行域,求解凸优化问题得到所述的运动学控制器,即期望速度vd,使跟踪误差e收敛。
可选地,步骤4)中所述的凸优化问题为:
可选地,凸优化问题权重矩阵W表示为:
其中,n=3,权重wi为:
η2i表示航行器姿态向量η2的第i项,H(η2)是关于航行器姿态的指标函数。
所述的凸优化问题权重矩阵中的指标函数H(η2)定义为:
η2h,η2l是运动姿态约束向量,分别表示约束上界和下界。
可选地,步骤5)中基于反步法设计各自由度上的力和力矩,包括以下步骤:
5-2)设计的力与力矩向量τ为
其中,σ=[e1,e2,e3,0,0,0]T,Kv是设计的反馈增益,M,C(v),D(v),g(η)由全驱动航行器的模型导出,其中M是6×6的惯性矩阵,由航行器自身质量引发的惯性矩阵和航行器周围水体引发的虚拟惯性矩阵组成;C(v)是6×6的科里奥利和离心力矩阵;D(v)是6×6的阻尼矩阵,表示航行器收到的各种阻力,g(η)是6×1的恢复力向量。
与现有技术相比,本发明的有益之处在于:
本发明提出的控制器具有两层结构,基于优化算法的运动学控制器保证了在速度误差收敛的情况下,水下航行器的航迹收敛到期望航迹上,而动力学学控制器则可以保证速度误差收敛。相较于传统的反步法控制器设计方法,基于优化的控制器考虑了航行器本身的速度约束,符合航行器应用实际;同时在控制器设计中考虑姿态约束,一方面使航行器在进行三维航迹跟踪时满足一系列任务的姿态要求,另一方面避免了传统航行器控制器设计中俯仰角在±π/2的奇异问题;
由姿态与速度约束构造优化问题为凸优化问题,有多种可靠方法求解,且求解速度可满足实时性的要求;充分考虑了全驱动航行器的运行中的速度饱和问题,实用性强。
附图说明
图1为本发明实施例中航行器的位置与姿态示意图,其中(a)表示任务a,(b)表示任务b,(c)表示任务c;
图2为任务b中航行器的横滚、俯仰和航向角度;
图3为任务b中航行器的横荡、纵荡和垂荡速度;
图4为任务c中航行器的横滚、俯仰和航向角度;
图5为任务c中航行器的横荡、纵荡和垂荡速度。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,以下结合实施例及其附图对本发明作进一步说明。显然,所描述的实施例是本发明的一部分实施例,而不是全部的实施例。基于所描述的实施例,本领域普通技术人员在无需创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
除非另外定义,本发明使用的技术术语或者科学术语应当为本发明所属领域内具有一般技能的人士所理解的通常意义。本发明中使用的“包括”或者“包含”等类似的词语意指出现该词前面的元件或者物件涵盖出现在该词后面列举的元件或者物件及其等同,而不排除其他元件或者物件。“连接”或者“相连”等类似的词语并非限定于物理的或者机械的连接,而是可以包括电性的连接,不管是直接的还是间接的。“上”、“下”、“左”、“右”等仅用于表示相对位置关系,当被描述对象的绝对位置改变后,则该相对位置关系也可能相应地改变。
实施例
本实施例的基于优化算法的全驱动水下航行器航迹跟踪控制方法包括以下步骤:
S100,传感器数据采集,利用航行器搭载的惯性导航***、水声定位***获得航行器当前在世界坐标系下的坐标、姿态和体坐标系下的速度。
S200,设计航行器运动姿态约束向量,其元素分别代表横滚,俯仰和偏航角允许的最大和最小角度;速度约束向量,其元素表示各自由度上的线速度和角速度限制。
S300,根据步骤S100中的航行器当前坐标与期望的三维航迹计算跟踪误差。
S400,利用步骤S200的姿态约束向量设计优化权重,速度约束向量设计优化可行域,求解凸优化问题得到虚拟控制器,即期望速度,使航迹跟踪误差收敛;期望速度由求解优化问题获得。
S500,根据给定的全驱动航行器六自由度模型设计动力学控制器,即推导出各自由度上的力和力矩。
S600,判断设计航迹是否跟踪完成,若期望航迹中规划的时间已到,则认为跟踪完成,否则返回步骤S200。
为说明控制器设计方法并验证方法的有效性,先给出具有一般性的六自由度航行器运动学模型与动力学模型分别为:
按照步骤S200给出姿态和速度约束:航行器运动姿态约束向量η2h,η2l,其元素分别代表横滚,俯仰和偏航角允许的最大和最小角度;速度约束向量vh,vl,其元素表示各自由度上的线速度和角速度限制;
按照步骤S300定义位置跟踪误差e=RT(η1-η1d),η1d是期望的三维航迹,那么对其求导得到误差动态:
其中S(v2)是关于v2中元素的反对称矩阵。
按照步骤S400构造优化问题:
其中,n=3,权重wi设计为:
指标函数H(η2)定义为:
使用内点法解上述优化问题,得到期望速度vd。
按照步骤S500设计动力学控制器,即:
其中,σ=[e1,e2,e3,0,0,0]T,K2是设计的反馈增益矩阵。
下面对其进行稳定性证明:
将航行器动力学模型(1)和动力学控制器(7)带入式(8)有:
下面说明使用上述控制器的***满足步骤(2)设计的约束:速度约束vh,vl已在优化问题(3)考虑;由式(6)可知,当航行器的姿态接近约束时,会趋向于无穷,那么对应的旋转自由度权重也将趋向于无穷。由此,运动学控制器给出的期望速度将趋向于0,这避免了航行器旋转角度的继续变化。
下面给出航行器利用本实施例的控制方法在三个具有不同约束的任务中跟踪同一航迹的仿真结果。
任务a、不考虑航行器的姿态约束,航行器以最小速度代价vTv跟踪设计航迹;
任务b、考虑航行器的姿态约束|φ,θ,ψ|≤0.001,不考虑速度约束,仿真航行器在某些姿态敏感任务下的航迹跟踪情况;
仿真结果参见图1,椭球体和三角形部分表示航行器,实线表示期望的轨迹,由图1可知,三种情况下,航行器的位置均跟踪了给定的期望轨迹,任务a航行器是自由姿态,以最小速度代价跟踪,任务b航行器的姿态由于约束基本保持不变,任务c由于侧向和垂直运动速度受到约束,航行器需要不断调整姿态以跟踪给定的轨迹。
图2中上下两条粗黑线表示任务描述中的约束上界和约束下界,由图2可知,航行器的横滚,俯仰和航向角度均被约束在-0.001到0.001之间,其中可以看到角度有一些抖动,这是由于在仿真中添加了外部扰动。
由于航行器的角度都被约束在了很小的范围内,所以可以认为航行器的体坐标系和世界坐标系的三轴方向平行,那么,航行器体坐标系x,y,z轴的速度应该和世界坐标系下期望的三轴速度 一致。由图3可知,航行器的横荡、纵荡和垂荡速度都为正弦,且幅值,相位,频率都与世界坐标系下的期望速度一致。
参见图4,由于航行器在垂直运动和横向运动的速度受限,航行器必须采用类似鱼雷的欠驱动运动模态,即航行器的航向角和俯仰角需要不停调整,以便航行器跟踪给定的轨迹;在此任务中,航行器的横滚角被约束,由图4可见其角度值并未超过约束的上界和下界。
由图5可知,任务c中航行器的横荡和垂荡速度未超过任务要求的约束,纵荡速度没有做约束。
由三种任务的仿真结果可见本发明所提出的控制方法使航行器在进行三维航迹跟踪时可以满足一系列任务的姿态和速度要求。
Claims (6)
1.一种基于优化算法的全驱动水下航行器航迹跟踪控制方法,其特征在于,包括:
获得航行器的运动参数,设计其运动姿态约束向量和速度约束向量;然后计算跟踪误差,并根据航行器的六自由度模型得到运动学控制器和动力学控制器;最后由运动学控制器得到期望速度,由动力学控制器推导出个自由度上的力和力矩;直至航迹跟踪完成,具体包括以下步骤:
2)设航行器的运动姿态约束向量为η2h=[φmax,θmax,ψmax]T和η2l=[φmin,θmin,ψmin]T,其元素分别代表横滚、俯仰和偏航角允许的最大值和最小值;速度约束向量为vh=[umax,vmax,wmax,pmax,qmax,rmax]T和vl=[umin,vmin,wmin,pmin,qmin,rmin]T,其元素表示各自由度上的线速度和角速度限制;
3)根据航行器当前坐标与期望的三维航迹计算跟踪误差e,计算公式如下:
e=RT(η1-η1d)
其中,η1d是期望的三维航迹,
4)根据给定的全驱动航行器六自由度模型得到运动学控制器,求得期望速度vd;
5)根据给定的全驱动航行器六自由度模型得到动力学控制器,推导出各自由度上的力和力矩;
6)判断航迹是否跟踪完成,若期望航迹中规划的时间已到,则认为跟踪完成,否则返回步骤2)。
2.根据权利要求1所述的基于优化算法的全驱动水下航行器航迹跟踪控制方法,其特征在于,步骤4)中,利用所述运动姿态约束向量得到优化权重,利用所述速度约束向量得到优化可行域,求解凸优化问题得到所述的运动学控制器,即期望速度vd,使跟踪误差e收敛。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010807187.1A CN112034865B (zh) | 2020-08-12 | 2020-08-12 | 基于优化算法的全驱动水下航行器航迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010807187.1A CN112034865B (zh) | 2020-08-12 | 2020-08-12 | 基于优化算法的全驱动水下航行器航迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112034865A CN112034865A (zh) | 2020-12-04 |
CN112034865B true CN112034865B (zh) | 2021-10-08 |
Family
ID=73578666
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010807187.1A Active CN112034865B (zh) | 2020-08-12 | 2020-08-12 | 基于优化算法的全驱动水下航行器航迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112034865B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112527018B (zh) * | 2020-12-26 | 2023-02-07 | 九江职业技术学院 | 一种欠驱动自主水下航行器的三维镇定控制方法 |
CN113189867B (zh) * | 2021-03-24 | 2023-11-14 | 大连海事大学 | 一种考虑位姿与速度受限的无人船自学习最优跟踪控制方法 |
CN113110527B (zh) * | 2021-04-12 | 2023-12-01 | 大连海事大学 | 一种自主水下航行器有限时间路径跟踪的级联控制方法 |
CN113311705B (zh) * | 2021-05-19 | 2022-03-25 | 广州大学 | 针对机器鱼的高阶迭代自学习控制方法、装置及存储介质 |
CN116300982B (zh) * | 2023-03-03 | 2024-06-07 | 新兴际华(北京)智能装备技术研究院有限公司 | 水下航行器及其路径跟踪控制方法和装置 |
CN117389312B (zh) * | 2023-11-07 | 2024-05-28 | 中国人民解放军海军工程大学 | 一种基于模型的水下航行器抗横滚三维跟踪控制方法 |
Citations (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102722177A (zh) * | 2012-06-27 | 2012-10-10 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN104317300A (zh) * | 2014-09-22 | 2015-01-28 | 北京航空航天大学 | 一种基于模型预测控制的平流层飞艇平面路径跟踪控制方法 |
CN104793629A (zh) * | 2015-05-04 | 2015-07-22 | 中国人民解放军国防科学技术大学 | 一种飞艇三维航迹跟踪的反步神经网络控制方法 |
CN104881038A (zh) * | 2015-04-22 | 2015-09-02 | 哈尔滨工业大学 | 环境干扰下的水下无人航行器航迹跟踪控制优化方法 |
CN105527967A (zh) * | 2015-12-16 | 2016-04-27 | 西北工业大学 | 一种auv反演对接控制方法 |
CN106406095A (zh) * | 2016-10-26 | 2017-02-15 | 北京航空航天大学 | 输入输出非对称受限的全驱动水面舰船轨迹跟踪控制方法 |
CN106708068A (zh) * | 2017-01-19 | 2017-05-24 | 中国科学院自动化研究所 | 仿生波动鳍推进水下航行器路径跟踪控制方法 |
CN107024863A (zh) * | 2017-03-24 | 2017-08-08 | 哈尔滨工程大学 | 一种避免微分***的uuv轨迹跟踪控制方法 |
CN107085427A (zh) * | 2017-05-11 | 2017-08-22 | 华南理工大学 | 一种基于领导跟随结构的无人水面艇编队控制方法 |
CN107239075A (zh) * | 2017-04-19 | 2017-10-10 | 哈尔滨工程大学 | 自主水下航行器平面直线航线跟踪的智能s面制导控制方法 |
CN107479556A (zh) * | 2017-09-15 | 2017-12-15 | 大连理工大学 | 两轮自平衡车主动避障轨迹规划与稳定跟踪控制方法 |
CN107491088A (zh) * | 2017-08-23 | 2017-12-19 | 中国人民解放军国防科技大学 | 一种输入饱和的飞艇航迹控制方法 |
EP3287862A1 (en) * | 2016-08-25 | 2018-02-28 | Imotec Holding B.V. | Method for steering an underactuated ship |
WO2018084324A1 (en) * | 2016-11-03 | 2018-05-11 | Mitsubishi Electric Corporation | Method and system for controlling vehicle |
CN108897217A (zh) * | 2018-07-04 | 2018-11-27 | 西北工业大学 | 一种基于模型预测控制的欠驱动水面船轨迹跟踪控制方法 |
CN109050835A (zh) * | 2018-08-06 | 2018-12-21 | 江苏科技大学 | 全驱动自主水下机器人结构及回收三维路径跟踪方法 |
CN109212970A (zh) * | 2018-09-18 | 2019-01-15 | 西北工业大学 | 一种欠驱动绳系复合体***的神经网络动态面控制方法 |
CN109343350A (zh) * | 2018-11-20 | 2019-02-15 | 清华大学 | 一种基于模型预测控制的水下机器人路径跟踪控制方法 |
CN109634291A (zh) * | 2018-11-27 | 2019-04-16 | 浙江工业大学 | 一种基于改进型障碍李雅普诺夫函数的刚性飞行器姿态约束跟踪控制方法 |
CN109634307A (zh) * | 2019-01-15 | 2019-04-16 | 大连海事大学 | 一种无人水下航行器复合航迹跟踪控制方法 |
CN109656143A (zh) * | 2019-02-25 | 2019-04-19 | 曲阜师范大学 | 一种海面全驱动船舶的自适应跟踪控制方法及*** |
CN109976384A (zh) * | 2019-03-13 | 2019-07-05 | 厦门理工学院 | 一种自治水下机器人及路径跟随控制方法、装置 |
DE102019102939A1 (de) * | 2018-02-09 | 2019-08-14 | GM Global Technology Operations LLC | Systeme und Verfahren für Bewegungsplanung von autonomen Fahrzeugen |
CN110377036A (zh) * | 2019-07-09 | 2019-10-25 | 哈尔滨工程大学 | 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 |
CN110442135A (zh) * | 2019-08-06 | 2019-11-12 | 南京赛沃夫海洋科技有限公司 | 一种基于改进遗传算法的无人艇路径规划方法及*** |
CN111045332A (zh) * | 2019-12-27 | 2020-04-21 | 哈尔滨工程大学 | 一种无人艇路径跟踪导引策略和扰动补偿方法 |
CN111158383A (zh) * | 2020-01-19 | 2020-05-15 | 浙江大学 | 基于干扰观测器和rbfnn的无人艇航迹跟踪控制方法 |
CN111258216A (zh) * | 2018-11-30 | 2020-06-09 | 浙江工业大学 | 一种适用于四旋翼飞行器的滑模重复控制器 |
CN111273551A (zh) * | 2020-03-12 | 2020-06-12 | 山东大学 | 双舵轮自动导引车轨迹追踪控制方法及*** |
CN111444603A (zh) * | 2020-01-17 | 2020-07-24 | 北京理工大学 | 一种返回式航天器时间最短离轨轨迹快速规划方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103760900B (zh) * | 2014-01-03 | 2016-06-29 | 哈尔滨工程大学 | 一种考虑控制输入约束的船舶运动控制*** |
US10019006B2 (en) * | 2015-04-08 | 2018-07-10 | University Of Maryland, College Park | Surface vehicle trajectory planning systems, devices, and methods |
US11126185B2 (en) * | 2018-09-15 | 2021-09-21 | Toyota Research Institute, Inc. | Systems and methods for predicting vehicle trajectory |
CN110378411B (zh) * | 2019-07-16 | 2021-03-23 | 浙江大学 | 一种基于交互式多模型的支持向量机辅助水下机动目标跟踪方法 |
CN111506079B (zh) * | 2020-05-13 | 2021-08-03 | 浙江大学 | 一种考虑障碍物避让的无人船虚拟结构编队控制方法 |
-
2020
- 2020-08-12 CN CN202010807187.1A patent/CN112034865B/zh active Active
Patent Citations (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102722177A (zh) * | 2012-06-27 | 2012-10-10 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN104317300A (zh) * | 2014-09-22 | 2015-01-28 | 北京航空航天大学 | 一种基于模型预测控制的平流层飞艇平面路径跟踪控制方法 |
CN104881038A (zh) * | 2015-04-22 | 2015-09-02 | 哈尔滨工业大学 | 环境干扰下的水下无人航行器航迹跟踪控制优化方法 |
CN104793629A (zh) * | 2015-05-04 | 2015-07-22 | 中国人民解放军国防科学技术大学 | 一种飞艇三维航迹跟踪的反步神经网络控制方法 |
CN105527967A (zh) * | 2015-12-16 | 2016-04-27 | 西北工业大学 | 一种auv反演对接控制方法 |
EP3287862A1 (en) * | 2016-08-25 | 2018-02-28 | Imotec Holding B.V. | Method for steering an underactuated ship |
CN106406095A (zh) * | 2016-10-26 | 2017-02-15 | 北京航空航天大学 | 输入输出非对称受限的全驱动水面舰船轨迹跟踪控制方法 |
WO2018084324A1 (en) * | 2016-11-03 | 2018-05-11 | Mitsubishi Electric Corporation | Method and system for controlling vehicle |
CN106708068A (zh) * | 2017-01-19 | 2017-05-24 | 中国科学院自动化研究所 | 仿生波动鳍推进水下航行器路径跟踪控制方法 |
CN107024863A (zh) * | 2017-03-24 | 2017-08-08 | 哈尔滨工程大学 | 一种避免微分***的uuv轨迹跟踪控制方法 |
CN107239075A (zh) * | 2017-04-19 | 2017-10-10 | 哈尔滨工程大学 | 自主水下航行器平面直线航线跟踪的智能s面制导控制方法 |
CN107085427A (zh) * | 2017-05-11 | 2017-08-22 | 华南理工大学 | 一种基于领导跟随结构的无人水面艇编队控制方法 |
CN107491088A (zh) * | 2017-08-23 | 2017-12-19 | 中国人民解放军国防科技大学 | 一种输入饱和的飞艇航迹控制方法 |
CN107479556A (zh) * | 2017-09-15 | 2017-12-15 | 大连理工大学 | 两轮自平衡车主动避障轨迹规划与稳定跟踪控制方法 |
DE102019102939A1 (de) * | 2018-02-09 | 2019-08-14 | GM Global Technology Operations LLC | Systeme und Verfahren für Bewegungsplanung von autonomen Fahrzeugen |
CN108897217A (zh) * | 2018-07-04 | 2018-11-27 | 西北工业大学 | 一种基于模型预测控制的欠驱动水面船轨迹跟踪控制方法 |
CN109050835A (zh) * | 2018-08-06 | 2018-12-21 | 江苏科技大学 | 全驱动自主水下机器人结构及回收三维路径跟踪方法 |
CN109212970A (zh) * | 2018-09-18 | 2019-01-15 | 西北工业大学 | 一种欠驱动绳系复合体***的神经网络动态面控制方法 |
CN109343350A (zh) * | 2018-11-20 | 2019-02-15 | 清华大学 | 一种基于模型预测控制的水下机器人路径跟踪控制方法 |
CN109634291A (zh) * | 2018-11-27 | 2019-04-16 | 浙江工业大学 | 一种基于改进型障碍李雅普诺夫函数的刚性飞行器姿态约束跟踪控制方法 |
CN111258216A (zh) * | 2018-11-30 | 2020-06-09 | 浙江工业大学 | 一种适用于四旋翼飞行器的滑模重复控制器 |
CN109634307A (zh) * | 2019-01-15 | 2019-04-16 | 大连海事大学 | 一种无人水下航行器复合航迹跟踪控制方法 |
CN109656143A (zh) * | 2019-02-25 | 2019-04-19 | 曲阜师范大学 | 一种海面全驱动船舶的自适应跟踪控制方法及*** |
CN109976384A (zh) * | 2019-03-13 | 2019-07-05 | 厦门理工学院 | 一种自治水下机器人及路径跟随控制方法、装置 |
CN110377036A (zh) * | 2019-07-09 | 2019-10-25 | 哈尔滨工程大学 | 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 |
CN110442135A (zh) * | 2019-08-06 | 2019-11-12 | 南京赛沃夫海洋科技有限公司 | 一种基于改进遗传算法的无人艇路径规划方法及*** |
CN111045332A (zh) * | 2019-12-27 | 2020-04-21 | 哈尔滨工程大学 | 一种无人艇路径跟踪导引策略和扰动补偿方法 |
CN111444603A (zh) * | 2020-01-17 | 2020-07-24 | 北京理工大学 | 一种返回式航天器时间最短离轨轨迹快速规划方法 |
CN111158383A (zh) * | 2020-01-19 | 2020-05-15 | 浙江大学 | 基于干扰观测器和rbfnn的无人艇航迹跟踪控制方法 |
CN111273551A (zh) * | 2020-03-12 | 2020-06-12 | 山东大学 | 双舵轮自动导引车轨迹追踪控制方法及*** |
Non-Patent Citations (14)
Title |
---|
Adaptive Trajectory Tracking Control of a Fully Actuated Surface Vessel With Asymmetrically Constrained Input and Output;Zewei Zheng etal.;《IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY》;20181231;第1851-1859页 * |
Control of Fully Actuated Ocean Surface Vessels Using a Class of Feedforward Approximators;Keng Peng Tee etal.;《IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY》;20061231;第750-756页 * |
RBF Dynamic Surface Sliding-mode Output Feedback Tracking Control for Fully Actuated Ships Based on ESO;Aihua Zhang , Qian Qian , Jie Zhang;《Proceedings of the 38th Chinese Control Conference》;20191231;第3140-3144页 * |
Stabilization control of underactuated ships with input saturation;Jiangshuai Huang;Rui Hu;Tingting Gao;Dan Zhang;《2017 29th Chinese Control And Decision Conference (CCDC)》;20171231;第6084-6089页 * |
Trajectory Tracking Control of Nonlinear Full Actuated Ship with Disturbances;Yang Yang, Jialu Du, Chen Guo, Guangqiang Li;《2011 International Conference of Soft Computing and Pattern Recognition (SoCPaR)》;20111231;第318-323页 * |
Unmanned Surface Vehicle Course Tracking Control Based on Neural Network and Deep Deterministic Policy Gradient Algorithm;Yan Wang, Jie Tong, Tian-Yu Song, Zhan-Hong Wan;《2018 OCEANS - MTS/IEEE Kobe Techno-Oceans (OTO)》;20181231;第1-5页 * |
一种全驱动船舶的运动镇定控制器设计;康钊等;《船舶电气与通信》;20181231;第51-58页 * |
一种欠驱动船舶编队滑模鲁棒控制方法;杨震等;《电机与控制学报》;20141130;第90-96,105页 * |
全驱动船舶轨迹跟踪的自适应动态面控制研究;张晓玲;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20180615;第C036-294页 * |
大型飞艇轨迹跟踪控制研究;王雪琴;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20200415;第C031-42页 * |
无人船建模及路径跟踪控制;王艳;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20200115;第C036-65页 * |
无人艇的非线性运动控制方法研究;廖煜雷;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20130415;第C036-2页 * |
欠驱动船舶运动的非线性鲁棒控制研究;王岩;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20170415;第C036-16页 * |
自主式智能体的跟踪控制问题研究;杨雪;《中国博士学位论文全文数据库 信息科技辑》;20141115;第I140-15页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112034865A (zh) | 2020-12-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112034865B (zh) | 基于优化算法的全驱动水下航行器航迹跟踪控制方法 | |
Yu et al. | Guidance-error-based robust fuzzy adaptive control for bottom following of a flight-style AUV with saturated actuator dynamics | |
Wang et al. | Surge-heading guidance-based finite-time path following of underactuated marine vehicles | |
CN108008628B (zh) | 一种不确定欠驱动无人艇***的预设性能控制方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
CN102768539B (zh) | 基于迭代的自主水下航行器三维曲线路径跟踪控制方法 | |
CN105807789B (zh) | 基于t-s模糊观测器补偿的uuv控制方法 | |
Han et al. | Active use of restoring moments for motion control of an underwater vehicle-manipulator system | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
CN114047773B (zh) | 一种基于扩张状态观测器的水下集矿机器人反步滑模自适应姿态控制方法 | |
CN111308890B (zh) | 一种带有指定性能的无人船数据驱动强化学习控制方法 | |
Han et al. | Modeling and fuzzy decoupling control of an underwater vehicle-manipulator system | |
CN112068440B (zh) | 基于模型预测控制的auv回收对接动力定位控制方法 | |
CN114115262B (zh) | 基于方位角信息的多auv执行器饱和协同编队控制***和方法 | |
Krupiński et al. | Pipeline tracking for fully-actuated autonomous underwater vehicle using visual servo control | |
Soylu et al. | Dynamics and control of tethered underwater-manipulator systems | |
Chen et al. | Cooperative tracking of vessel trajectories based on curved dynamic coordinates | |
CN114967714A (zh) | 一种自主式水下机器人抗扰运动控制方法及*** | |
CN113741433B (zh) | 一种水面无人船的分布式编队方法 | |
CN113296505B (zh) | 一种基于速变los的无人船多模式路径跟踪控制方法 | |
Dai et al. | Dual closed loop AUV trajectory tracking control based on finite time and state observer | |
Sun et al. | Adaptive nonlinear relative motion control of quadrotors in autonomous shipboard landings | |
Raimondi et al. | Hierarchical fuzzy/lyapunov control for horizontal plane trajectory tracking of underactuated AUV | |
CN112925332B (zh) | 无人艇与水下无人潜器联合***的协同交会对接控制方法 | |
de Cerqueira Gava et al. | AUV cruising auto pilot for a long straight confined underwater tunnel |
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 |