CN111827395B - 一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法 - Google Patents
一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法 Download PDFInfo
- Publication number
- CN111827395B CN111827395B CN202010602244.2A CN202010602244A CN111827395B CN 111827395 B CN111827395 B CN 111827395B CN 202010602244 A CN202010602244 A CN 202010602244A CN 111827395 B CN111827395 B CN 111827395B
- Authority
- CN
- China
- Prior art keywords
- suction hopper
- hopper dredger
- trailing suction
- external disturbance
- formula
- 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
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F5/00—Dredgers or soil-shifting machines for special purposes
- E02F5/28—Dredgers or soil-shifting machines for special purposes for cleaning watercourses or other ways
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/88—Dredgers; Soil-shifting machines mechanically-driven with arrangements acting by a sucking or forcing effect, e.g. suction dredgers
- E02F3/8833—Floating installations
- E02F3/885—Floating installations self propelled, e.g. ship
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/88—Dredgers; Soil-shifting machines mechanically-driven with arrangements acting by a sucking or forcing effect, e.g. suction dredgers
- E02F3/90—Component parts, e.g. arrangement or adaptation of pumps
- E02F3/907—Measuring or control devices, e.g. control units, detection means or sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Health & Medical Sciences (AREA)
- Ocean & Marine Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法,获取带有未知外部扰动的耙吸挖泥船的运动学和动力学模型;设计外部扰动观测器的滑模面及外部扰动观测器;对耙吸挖泥船设计能够在运动学上实现目标跟踪的虚拟控制器;对耙吸挖泥船设计动力学控制器并求得耙吸挖泥船运动学参数,并在外部扰动观测器的配合下使得耙吸挖泥船运动学参数收敛至虚拟控制器,实现目标跟踪。具有基于有限时间的参数优化,嵌套层数低,物理意义明确的优点;且在实际控制过程中耙吸挖泥船的运动平稳性好,鲁棒性较优良。
Description
技术领域
本发明涉及耙吸挖泥船的控制技术领域,尤其涉及一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法。
背景技术
传统的耙吸挖泥船的跟踪控制方法大多采用定义误差系统来达到渐近收敛的目的,时间效益较低,目前对于船的姿态的控制算法大致有两种:1)自适应控制方法,2)鲁邦分析法;但是这些算法计算嵌套程度高,结构复杂,单步运算量大,耗时长,且对计算机的性能要求较高,不适合实际推广应用。
发明内容
本发明的目的是提供一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法,以便解决现有技术存在的计算嵌套程度高,结构复杂,单步运算量大,耗时长,且对计算机的性能要求较高的问题。
本发明的上述技术目的是通过以下技术方案得以实现的:
本发明提供了一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法,包括:
获取带有未知外部扰动的耙吸挖泥船的运动学和动力学模型;
设计外部扰动观测器的滑模面及外部扰动观测器;
对耙吸挖泥船设计能够在运动学上实现目标跟踪的虚拟控制器;
对耙吸挖泥船设计动力学控制器并求得耙吸挖泥船运动学参数,并在外部扰动观测器的配合下使得耙吸挖泥船运动学参数收敛至虚拟控制器,实现目标跟踪。
优选地,通过建立笛卡尔坐标系获取带有未知外部扰动的耙吸挖泥船的运动学和动力学模型。
优选地,采用公式(1)获取所述运动学和动力学模型:
式中:[xg,yg]T∈R2表示耙吸挖泥船在笛卡尔坐标系中的位置;φg表示耙吸挖泥船的铅直速度与X轴正方向的夹角;ug表示耙吸挖泥船的铅直速度;vg表示耙吸挖泥船的水平速度;wg表示耙吸挖泥船的航行角速度;m1,m2,m3表示包括质量在内的惯性;τu,τv,τw表示耙吸挖泥船的输入力或力矩;τud,τvd,τwd表示未知外部扰动;d1,d2,d3分别表示与耙吸挖泥船铅直运动,水平运动和转动有关的流体动力阻尼系数。
优选地,采用公式(2)获取所述耙吸挖泥船与被追踪的以[xo,yo]∈R2为位置坐标,uo为被追踪目标的速度,φo为运动方向与X轴正方向的夹角的被追踪目标之间的运动学关系:
式中:d表示耙吸挖泥船与被追踪目标之间的距离;ζ表示耙吸挖泥船与被追踪目标之间的相对位置矢量与X轴正方向的夹角;β1表示耙吸挖泥船的运动方向与挖泥船和追踪目标之间连线所偏离的角度;β2表示被追踪目标的运动方向与耙吸挖泥船和追踪目标之间连线所偏离的角度。
优选地,采用公式(3)和公式(4)分别获取未知外部扰动的滑模面及外部扰动观测器:
式中参数cu,cv,cw,pu,pv,pw,ju,jv.jw,ku,kv,kw满足的条件如下:
式中:cu,cv,cw,pu,pv,pw,ηu,ηv,ηw,ju,jv.jw,ku,kv,kw为设计滑模面及滑模扰动观测器所必须的控制参数;Lu,Lv,Lw为控制过程中的中间变量;su、sv、sw为滑模表面。
优选地,采用公式(5)获取Lu,Lv,Lw:
式中:φg表示耙吸挖泥船的铅直速度与X轴正方向的夹角;ug表示耙吸挖泥船的铅直速度;vg表示耙吸挖泥船的水平速度;wg表示耙吸挖泥船的航行角速度;m1,m2,m3表示包括质量在内的惯性;τu,τv,τw表示耙吸挖泥船的输入力或力矩;d1,d2,d3分别表示与耙吸挖泥船铅直运动,水平运动和转动有关的流体动力阻尼系数。
优选地,采用公式(7)获取动力学控制器[τu,τv,τw]:
式中:ug表示耙吸挖泥船的铅直速度;vg表示耙吸挖泥船的水平速度;wg表示耙吸挖泥船的航行角速度。
优选地,采用公式(8)获取动力学控制器误差系统[Δu,Δv,Δw]:
式中:ug表示耙吸挖泥船的铅直速度;vg表示耙吸挖泥船的水平速度;wg表示耙吸挖泥船的航行角速度。
式中:表示耙吸挖泥船的运动方向与挖泥船和追踪目标之间连线所偏离的角度的一阶导数;为运动方向与X轴正方向的夹角的被追踪目标之间的运动学关系的一阶导数;为运动方向与X轴正方向的夹角的被追踪目标之间的运动学关系的二阶导数;为便于控制器设计而引入的变量的一阶导数;为耙吸挖泥船与被追踪目标之间的距离的一阶导数;为被追踪目标速度的一阶导数;d为耙吸挖泥船与被追踪目标之间的距离。
本发明的有益效果如下:
本发明提出带有未知外部扰动的耙吸挖泥船的跟踪控制方法具有基于有限时间的参数优化,嵌套层数低,物理意义明确的优点;且在实际控制过程中耙吸挖泥船的运动平稳性好,鲁棒性较优良。
附图说明
图1是根据本发明实施例提供的一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法的运动示意图。
具体实施方式
下面结合附图对本发明作进一步描述。以下实施例仅用于更加清楚地说明本发明的技术方案,而不能以此来限制本发明的保护范围。
如图1所示,本发明公开了一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法,具体包括:
通过建立笛卡尔坐标系获取带有未知外部扰动的耙吸挖泥船的运动学和动力学模型;
设计外部扰动观测器的滑模面及外部扰动观测器,使得外部扰动观测器收敛至未知外部扰动的固定倍数,从而能测算出外部扰动值;
对耙吸挖泥船设计能够在运动学上实现目标跟踪的虚拟控制器;
设计有限时间动力学控制器,并求得耙吸挖泥船的铅直速度、水平速度及航行角速度;
控制铅直速度、水平速度及航行角速度在有限时间内收敛到虚拟控制器,实现目标跟踪。
步骤1、利用笛卡尔坐标系获取带有未知外部扰动的耙吸挖泥船的运动学和动力学模型;
所述耙吸挖泥船的运动学和动力学模型可由公式(11)得到:
式中:[xg,yg]T∈R2表示耙吸挖泥船在笛卡尔坐标系中的位置;φg表示耙吸挖泥船的铅直速度与X轴正方向的夹角;ug表示耙吸挖泥船的铅直速度;vg表示耙吸挖泥船的水平速度;wg表示耙吸挖泥船的航行角速度;m1,m2,m3表示包括质量在内的惯性;τu,τv,τw表示耙吸挖泥船的输入力或力矩;τud,τvd,τwd表示未知外部扰动;d1,d2,d3分别表示与耙吸挖泥船铅直运动,水平运动和转动有关的流体动力阻尼系数;
所述耙吸挖泥船与被追踪的以[xo,yo]∈R2为位置坐标,uo为速度大小,φo为运动方向与X轴正方向的夹角的被追踪目标之间的运动学关系可描述为:
式中:d表示耙吸挖泥船与被追踪目标之间的距离;ζ表示耙吸挖泥船与被追踪目标之间的相对位置矢量与X轴正方向的夹角;β1表示耙吸挖泥船的运动方向与挖泥船和追踪目标之间连线所偏离的角度;β2表示被追踪目标的运动方向与耙吸挖泥船和追踪目标之间连线所偏离的角度。
步骤2、设计外部扰动观测器的滑模面及外部扰动观测器,所设计的用于估计未知外部扰动的滑模表面及观测器可分别由公式(13)和公式(14)得到:
公式(13)中Lu,Lv,Lw由公式(15)得到:
公式(15)中参数cu,cv,cw,pu,pv,pw,ju,jv.jw,ku,kv,kw满足(16)中的条件
式中:cu,cv,cw,pu,pv,pw,ηu,ηv,ηw,ju,jv.jw,ku,kv,kw为设计滑模面及滑模扰动观测器所必须的控制参数;Lu,Lv,Lw为控制过程中的中间变量;su、sv、sw为滑模表面。
步骤4、对耙吸挖泥船设计有限时间动力学控制器[τu,τv,τw],由公式(18)得到:
式中控制参数lu,lv,lw>0,εu,εv,εw∈(0,1),[Δu,Δv,Δw]由公式(19)获得:
步骤5、由动力学控制器[τu,τv,τw]求得带有外部未知扰动的耙吸挖泥船的铅直速度ug、水平速度vg及航行角速度wg在有限时间内分别收敛到虚拟控制器基于虚拟控制器带有未知外部扰动的耙吸挖泥船的跟踪控制任务能在有限时间内完成。
首先利用笛卡尔坐标系获取带有未知外部扰动的耙吸挖泥船的运动学和动力学模型,然后设计外部扰动观测器的滑模面及外部扰动观测器用于估计未知外部扰动的数值,接着设计虚拟控制器使得耙吸挖泥船在该虚拟运动学控制器下能实现跟踪的控制要求,最后设计实际的动力学控制器使得挖泥船的运动学参数能在有限时间内收敛至设计的虚拟控制器,从而最终实现目标的跟踪。
以上对本发明的较佳实施进行了具体说明,当然,本发明还可以采用与上述实施方式不同的形式,熟悉本领域的技术人员在不违背本发明精神的前提下所作的等同的变换或相应的改动,都应该属于本发明的保护范围内。
Claims (7)
1.一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法,其特征在于,包括:通过建立笛卡尔坐标系获取带有未知外部扰动的耙吸挖泥船的运动学和动力学模型,采用公式(1)获取所述运动学和动力学模型:
式中:[xg,yg]T∈R2表示耙吸挖泥船在笛卡尔坐标系中的位置;φg表示耙吸挖泥船的铅直速度与X轴正方向的夹角;ug表示耙吸挖泥船的铅直速度;vg表示耙吸挖泥船的水平速度;wg表示耙吸挖泥船的航行角速度;m1,m2,m3表示包括质量在内的惯性;τu,τv,τw表示耙吸挖泥船的输入力或力矩;τud,τvd,τwd表示未知外部扰动;d1,d2,d3分别表示与耙吸挖泥船铅直运动,水平运动和转动有关的流体动力阻尼系数;
设计外部扰动观测器的滑模面及外部扰动观测器;
对耙吸挖泥船设计能够在运动学上实现目标跟踪的虚拟控制器;
对耙吸挖泥船设计动力学控制器并求得耙吸挖泥船运动学参数,并在外部扰动观测器的配合下使得耙吸挖泥船运动学参数收敛至虚拟控制器,实现目标跟踪;采用公式(3)和公式(4)分别获取未知外部扰动的滑模面及外部扰动观测器:
式中参数cu,cv,cw,pu,pv,pw,ju,jv.jw,ku,kv,kw满足的条件如下:
式中:cu,cv,cw,pu,pv,pw,ηu,ηv,ηw,ju,jv.jw,ku,kv,kw为设计滑模面及滑模扰动观测器所必须的控制参数;Lu,Lv,Lw为控制过程中的中间变量;su、sv、sw为滑模表面。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010602244.2A CN111827395B (zh) | 2020-06-29 | 2020-06-29 | 一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010602244.2A CN111827395B (zh) | 2020-06-29 | 2020-06-29 | 一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111827395A CN111827395A (zh) | 2020-10-27 |
CN111827395B true CN111827395B (zh) | 2022-02-11 |
Family
ID=72898953
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010602244.2A Active CN111827395B (zh) | 2020-06-29 | 2020-06-29 | 一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111827395B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61119493A (ja) * | 1984-11-15 | 1986-06-06 | Yokogawa Electric Corp | 舶用オ−トパイロツト |
CN102768539A (zh) * | 2012-06-26 | 2012-11-07 | 哈尔滨工程大学 | 基于迭代的自主水下航行器三维曲线路径跟踪控制方法 |
CN109116856A (zh) * | 2018-09-28 | 2019-01-01 | 上海海事大学 | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 |
CN109358499A (zh) * | 2018-09-25 | 2019-02-19 | 大连海事大学 | 基于速度与航向双重制导的无人船精确路径跟踪控制方法 |
CN110134012A (zh) * | 2019-04-30 | 2019-08-16 | 上海海事大学 | 一种用于不确定系统的船舶路径跟踪控制方法 |
CN110716566A (zh) * | 2019-10-15 | 2020-01-21 | 哈尔滨工程大学 | 一种欠驱动无人艇的有限时间轨迹跟踪控制方法 |
CN108427414B (zh) * | 2018-03-31 | 2020-10-27 | 西北工业大学 | 一种自主水下航行器水平面自适应轨迹跟踪控制方法 |
-
2020
- 2020-06-29 CN CN202010602244.2A patent/CN111827395B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61119493A (ja) * | 1984-11-15 | 1986-06-06 | Yokogawa Electric Corp | 舶用オ−トパイロツト |
CN102768539A (zh) * | 2012-06-26 | 2012-11-07 | 哈尔滨工程大学 | 基于迭代的自主水下航行器三维曲线路径跟踪控制方法 |
CN108427414B (zh) * | 2018-03-31 | 2020-10-27 | 西北工业大学 | 一种自主水下航行器水平面自适应轨迹跟踪控制方法 |
CN109358499A (zh) * | 2018-09-25 | 2019-02-19 | 大连海事大学 | 基于速度与航向双重制导的无人船精确路径跟踪控制方法 |
CN109116856A (zh) * | 2018-09-28 | 2019-01-01 | 上海海事大学 | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 |
CN110134012A (zh) * | 2019-04-30 | 2019-08-16 | 上海海事大学 | 一种用于不确定系统的船舶路径跟踪控制方法 |
CN110716566A (zh) * | 2019-10-15 | 2020-01-21 | 哈尔滨工程大学 | 一种欠驱动无人艇的有限时间轨迹跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
欠驱动船舶轨迹跟踪的自适应滑模控制研究;王茹;《中国优秀硕士学位论文全文数据库科技II辑》;20180615(第6期);11-16 * |
Also Published As
Publication number | Publication date |
---|---|
CN111827395A (zh) | 2020-10-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108614426B (zh) | 一种基于干扰观测器的多移动机器人编队鲁棒控制方法 | |
CN112241124B (zh) | 一种自适应反演积分非奇异快速终端滑模控制器设计方法 | |
CN111152225A (zh) | 存在输入饱和的不确定机械臂固定时间轨迹跟踪控制方法 | |
CN110032197B (zh) | 一种基于有限时间制导和控制的无人船路径跟踪控制方法 | |
CN111665857B (zh) | 基于复合智能学习的变体飞行器控制方法 | |
CN110716566B (zh) | 一种欠驱动无人艇的有限时间轨迹跟踪控制方法 | |
CN111026160B (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
CN110471438B (zh) | 一种刚性飞行器的固定时间自适应姿态跟踪控制方法 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂系统 | |
CN108267952B (zh) | 一种水下机器人自适应有限时间控制方法 | |
CN113220021B (zh) | 基于虚拟领导者的飞行编队协同自适应跟踪控制方法 | |
CN111580387B (zh) | 一种基于时滞分数阶船舶运动自适应滑模控制方法及系统 | |
CN111813140A (zh) | 一种具有高精度的四旋翼无人机轨迹跟踪控制方法 | |
CN115556111A (zh) | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 | |
CN112947430A (zh) | 一种移动机器人的智能轨迹跟踪控制方法 | |
CN115576341A (zh) | 基于函数微分和自适应变增益的无人机轨迹跟踪控制方法 | |
CN111827395B (zh) | 一种带有未知外部扰动的耙吸挖泥船的跟踪控制方法 | |
CN113741433A (zh) | 一种水面无人船的分布式编队方法 | |
CN115268475B (zh) | 基于有限时间扰动观测器的机器鱼精确地形跟踪控制方法 | |
CN113954077B (zh) | 带有能量优化的水下游动机械臂轨迹跟踪控制方法及装置 | |
CN114800521A (zh) | 一种带约束的三自由度机械臂固定路径点运动控制系统 | |
CN115959307B (zh) | 一种绳系卫星的预定时间姿态稳定控制方法 | |
CN111474939B (zh) | 一种全驱动船的跟踪控制方法 | |
CN112904719B (zh) | 一种适用于水下机器人位置环形区域跟踪控制方法 | |
CN117590754B (zh) | 一种机器人系统的智能学习输出调控方法 |
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 |