CN113156965A - 一种基于纵向速度规划的气垫船高速回转控制方法 - Google Patents
一种基于纵向速度规划的气垫船高速回转控制方法 Download PDFInfo
- Publication number
- CN113156965A CN113156965A CN202110480855.9A CN202110480855A CN113156965A CN 113156965 A CN113156965 A CN 113156965A CN 202110480855 A CN202110480855 A CN 202110480855A CN 113156965 A CN113156965 A CN 113156965A
- Authority
- CN
- China
- Prior art keywords
- hovercraft
- speed
- longitudinal
- follows
- rotation
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Abstract
本发明涉及气垫船运动控制领域,具体涉及的是一种基于纵向速度规划的气垫船高速回转控制方法。本发明采用基于侧滑角约束的航速规划方法解决了气垫船采用传统非线性反馈控制在高速回转时的失速问题,能够保证气垫船在回转的同时实现精确的航速跟踪,提高了气垫船的机动性和作业能力,本发明在保证气垫船在高速回转过程中准确跟踪期望艏向的同时避免回转率过大导致的甩尾现象,提高了气垫船在高速回转时的可靠性和安全性。
Description
技术领域
本发明涉及气垫船运动控制领域,具体涉及的是一种基于纵向速度规划的气垫船高速回转控制方法。
背景技术
气垫船作为一种特种船舶,航行过程由于船体与水面不直接接触因而所受阻力小,形成其航速快、机动性高的性能优势,在军事抢滩登陆、民用抢险救灾等方面具有广阔的应用前景。然而,由于气垫船结构复杂(包含刚性船体与柔性围裙)、高速航行过程存在比较大的环境干扰,导致模型存在较大的非线性和耦合,同时大部分气垫船没有横向执行机构属于典型的欠驱动船(即不能产生横向控制力),这对气垫船高速下的安全控制造成较大挑战。
气垫船的高速回转控制主要存在以下几个难点:1)由于气垫船存在多个阻力峰,无法完全通过纵向通道的反馈控制实现回转过程中的航速保持;2)欠驱动特性使得气垫船无法直接通过控制横向速度实现对侧滑角的约束;3)传统的基于辅助系统的控制方法不能将回转率严格限制在指定范围内。
由于以上的控制难点,目前的气垫船为了保证安全性都将高速航行下的回转运动限制在保守的范围内,大大制约了气垫船本身的性能和应用场景。因此,研究气垫船高速航行下的回转控制对于提高国产气垫船的运动控制性能和可靠性具有十分重要的工程实用价值。
发明内容
本发明的目的在于提供实现气垫船在恒定期望速度下的安全回转的一种基于纵向速度规划的气垫船高速回转控制方法。
本发明的目的是这样实现的:
一种基于纵向速度规划的气垫船高速回转控制方法,包括以下步骤:
步骤1:基于气垫船运动模型设计二阶滑模观测器,实现对纵向和回转两个自由度的系统模型不确定性和干扰的估计;
气垫船纵向和回转运动模型为:
纵向和回转的模型不确定性及外界干扰项Du,Dr通过如下的二阶滑模观测器进行估计:
纵向: 回转:
步骤2:基于侧滑角约束进行纵向速度规划,并设计基于对数型SBLF方法的纵向航速控制律,保证气垫船高速回转过程中不失速;
步骤2.1:将侧滑角角约束βmax转化为纵向速度约束umin
步骤2.2:纵向航速规划如下:
其中,ku>0,δ>0,εumin>0为设计参数,通过参数的合理设计,可以确保始终有ud>umin。
步骤2.3:通过SBLF来设计纵向控制律。
定义航速误差为:
选取一阶滑模面为:
s=keu
选择李雅普诺夫函数为:
易知,V在集合|ξu|<1上是连续可微的。对上式求导可得:
设计航速控制律为:
步骤3:根据期望的艏向角和给定的最大回转率,设计基于IBLF方法的回转约束控制律,避免出现回转率过大导致的甩尾现象。
步骤3.1:采用反步法设计虚拟回转角速度αr
航向-回转模型为:
回转控制目标为:
定义航向误差及导数、回转率误差为:
eψ=ψ-ψd
er=r-αr
选择第一个障碍李雅普诺夫函数为:
对上式求导可得:
虚拟回转率设计为:
其中,cψ>0为设计参数。
步骤3.2:基于IBLF设计回转控制力矩τr
构建第二个障碍李雅普诺夫函数为:
对上式求导可得:
其中,
设计航向控制律为:
其中,η1>0为设计参数。
与现有技术相比,本发明的有益效果是:
1.本发明采用基于侧滑角约束的航速规划方法解决了气垫船采用传统非线性反馈控制在高速回转时的失速问题,能够保证气垫船在回转的同时实现精确的航速跟踪,提高了气垫船的机动性和作业能力;
2.本发明基于IBLF的控制方法实现对气垫船回转率的严格约束,在保证气垫船在高速回转过程中准确跟踪期望艏向的同时避免回转率过大导致的甩尾现象,提高了气垫船在高速回转时的可靠性和安全性。
附图说明
图1基于纵向速度规划的气垫船高速回转控制框图;
图2具有回转率约束的气垫船回转控制框图;
图3纵向速度估计和扰动估计;
图4回转率估计和回转方向扰动估计;
图5纵向航速跟踪效果及侧滑角变化曲线;
图6艏向角跟踪效果曲线;
图7rmax=3时的虚拟回转率及实际回转率变化曲线;
具体实施方式
下面结合附图与具体实施方式对本发明作进一步详细描述。
本发明的基本原理框图如图1所示,具体实施方式如下:
1.基于气垫船四自由度模型,设计二阶滑模观测器,实现对纵向和回转两个自由度的系统模型不确定性和干扰的估计;
步骤1.建立气垫船四自由度模型为
其中,m为气垫船质量,Jx,Jz分别为绕纵向和垂向的转动惯量;u,v,p,r分别为纵速度、横向速度、横倾角速度、回转角速度;FxD,FyD,MxD,MzD分别表示根据当前航行状态下所对应的精确的纵向阻力、横向阻力、横倾阻力矩;τp,τr分别表示纵向推进力和回转力矩。
由于气垫船只有纵向和回转是可以控制的,因此将四自由度模型简化为
纵向和回转的模型不确定性及外界干扰项Du,Dr通过设计如下的二阶滑模观测器进行估计:
纵向: 回转:
其中,lu和lr为纵向和回转方向的不确定项的上界,。满足|Du|≤lu和|Dr|≤lr。
2.将最大侧滑角约束转化为纵向速度约束,然后根据期望的航速进行纵向速度规划,并设计基于对数型SBLF方法的航速控制律,保证气垫船高速回转过程中不失速;
步骤2.1将侧滑角角约束βmax转化为纵向速度约束umin:
假设初始航速满足:
umin(0)<u(0)<2ud(0)-umin(0)
其中,初始期望航速ud(0)>umin(0)。
步骤2.2规划纵向航速如下:
其中,ku>0,δ>0,εumin>0为设计参数,通过参数的合理设计,可以确保始终有ud>umin。
步骤2.3基于SBLF来设计纵向控制律。
定义航速误差为:
选取一阶滑模面为:
s=keu
选择李雅普诺夫函数为:
易知,V在集合|ξu|<1上是连续可微的。对上式求导可得:
纵向航速控制律设计为:
3.根据期望的艏向角和给定的最大回转率,设计基于IBLF方法的回转约束控制律,避免出现回转率过大导致的甩尾现象;
步骤3.1采用反步法设计虚拟回转角速度αr
航向-回转模型为:
回转控制目标为:
定义航向误差及导数、回转率误差为:
eψ=ψ-ψd
er=r-αr
选择第一个障碍李雅普诺夫函数为:
对上式求导可得:
虚拟回转率设计为:
其中,cψ>0为设计参数。
可得:
步骤3.2基于IBLF设计回转控制力矩τr
构建第二个障碍李雅普诺夫函数为:
对上式求导可得:
其中,
ρ2(er,αr)的偏导为:
由洛必达法则可得:
设计航向控制律为:
其中,η1>0为设计参数。
将控制力矩带入可得:
选取整个回转控制系统的李雅普诺夫函数为:
V=V1+V2
则其导数为:
只需设计切换增益η1≥|eDr|,就可以保证气垫船收敛于期望航向同时满足控制回转率严格小于rmax。
Claims (1)
1.一种基于纵向速度规划的气垫船高速回转控制方法,其特征是:包括以下步骤:
步骤1:基于气垫船运动模型设计二阶滑模观测器,实现对纵向和回转两个自由度的系统模型不确定性和干扰的估计;
气垫船纵向和回转运动模型为:
纵向和回转的模型不确定性及外界干扰项Du,Dr通过如下的二阶滑模观测器进行估计:
步骤2:基于侧滑角约束进行纵向速度规划,并设计基于对数型SBLF方法的纵向航速控制律,保证气垫船高速回转过程中不失速;
步骤2.1:将侧滑角角约束βmax转化为纵向速度约束umin
步骤2.2:纵向航速规划如下:
其中,ku>0,δ>0,εumin>0为设计参数,通过参数的合理设计,可以确保始终有ud>umin。
步骤2.3:通过SBLF来设计纵向控制律。
定义航速误差为:
选取一阶滑模面为:
s=keu
选择李雅普诺夫函数为:
易知,V在集合|ξu|<1上是连续可微的。对上式求导可得:
设计航速控制律为:
步骤3:根据期望的艏向角和给定的最大回转率,设计基于IBLF方法的回转约束控制律,避免出现回转率过大导致的甩尾现象。
步骤3.1:采用反步法设计虚拟回转角速度αr
航向-回转模型为:
回转控制目标为:
定义航向误差及导数、回转率误差为:
eψ=ψ-ψd
er=r-αr
选择第一个障碍李雅普诺夫函数为:
对上式求导可得:
虚拟回转率设计为:
其中,cψ>0为设计参数。
步骤3.2:基于IBLF设计回转控制力矩τr构建第二个障碍李雅普诺夫函数为:
对上式求导可得:
其中,
设计航向控制律为:
其中,η1>0为设计参数。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110480855.9A CN113156965B (zh) | 2021-04-30 | 2021-04-30 | 一种基于纵向速度规划的气垫船高速回转控制方法 |
GB2208660.7A GB2621306A (en) | 2021-04-30 | 2021-12-29 | Hovercraft high-speed rotation control method based on longitudinal speed planning |
PCT/CN2021/142437 WO2022227666A1 (zh) | 2021-04-30 | 2021-12-29 | 一种基于纵向速度规划的气垫船高速回转控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110480855.9A CN113156965B (zh) | 2021-04-30 | 2021-04-30 | 一种基于纵向速度规划的气垫船高速回转控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113156965A true CN113156965A (zh) | 2021-07-23 |
CN113156965B CN113156965B (zh) | 2023-01-03 |
Family
ID=76872743
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110480855.9A Active CN113156965B (zh) | 2021-04-30 | 2021-04-30 | 一种基于纵向速度规划的气垫船高速回转控制方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN113156965B (zh) |
WO (1) | WO2022227666A1 (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022227666A1 (zh) * | 2021-04-30 | 2022-11-03 | 哈尔滨工程大学 | 一种基于纵向速度规划的气垫船高速回转控制方法 |
WO2023050636A1 (zh) * | 2021-09-29 | 2023-04-06 | 哈尔滨工程大学 | 一种全垫升气垫船路径跟踪方法 |
GB2618860A (en) * | 2021-09-29 | 2023-11-22 | Univ Harbin Eng | Path tracking method for air cushion vehicle |
GB2621306A (en) * | 2021-04-30 | 2024-02-14 | Univ Harbin Eng | Hovercraft high-speed rotation control method based on longitudinal speed planning |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105204337A (zh) * | 2015-09-24 | 2015-12-30 | 哈尔滨工程大学 | 一种基于虚拟传感器的气垫船传感器故障处理方法 |
CN107450318A (zh) * | 2017-08-21 | 2017-12-08 | 哈尔滨工程大学 | 一种基于二阶滑模控制的气垫船路径跟踪控制方法 |
WO2018100749A1 (ja) * | 2016-12-02 | 2018-06-07 | ヤマハ発動機株式会社 | 小型船舶及びその制御方法 |
CN108594639A (zh) * | 2018-03-28 | 2018-09-28 | 哈尔滨工程大学 | 一种基于强化学习的全垫升气垫船航迹跟踪控制方法 |
CN109460043A (zh) * | 2018-12-29 | 2019-03-12 | 上海海事大学 | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 |
CN110618611A (zh) * | 2019-10-23 | 2019-12-27 | 哈尔滨工程大学 | 一种基于回转率约束的无人艇轨迹跟踪安全控制方法 |
CN111045332A (zh) * | 2019-12-27 | 2020-04-21 | 哈尔滨工程大学 | 一种无人艇路径跟踪导引策略和扰动补偿方法 |
CA3081611A1 (en) * | 2020-04-03 | 2020-09-11 | Pablo Air Co., Ltd. | Method in which small fixed-wing unmanned aerial vehicle follows path and lgvf path-following controller using same |
CN112506192A (zh) * | 2020-11-25 | 2021-03-16 | 哈尔滨工程大学 | 一种针对全回转推进器故障的动力定位船容错控制方法 |
CN112596509A (zh) * | 2019-09-17 | 2021-04-02 | 广州汽车集团股份有限公司 | 车辆控制方法、装置、计算机设备及计算机可读存储介质 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105334854A (zh) * | 2015-09-17 | 2016-02-17 | 哈尔滨工程大学 | 应用于气垫船航向控制与横倾控制的解耦控制装置及方法 |
CN105223955A (zh) * | 2015-10-14 | 2016-01-06 | 浪潮电子信息产业股份有限公司 | 一种气垫船航迹向控制方法及控制系统 |
US10845823B2 (en) * | 2018-12-19 | 2020-11-24 | Joby Aero, Inc. | Vehicle navigation system |
CN113156965B (zh) * | 2021-04-30 | 2023-01-03 | 哈尔滨工程大学 | 一种基于纵向速度规划的气垫船高速回转控制方法 |
-
2021
- 2021-04-30 CN CN202110480855.9A patent/CN113156965B/zh active Active
- 2021-12-29 WO PCT/CN2021/142437 patent/WO2022227666A1/zh active Application Filing
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105204337A (zh) * | 2015-09-24 | 2015-12-30 | 哈尔滨工程大学 | 一种基于虚拟传感器的气垫船传感器故障处理方法 |
WO2018100749A1 (ja) * | 2016-12-02 | 2018-06-07 | ヤマハ発動機株式会社 | 小型船舶及びその制御方法 |
CN107450318A (zh) * | 2017-08-21 | 2017-12-08 | 哈尔滨工程大学 | 一种基于二阶滑模控制的气垫船路径跟踪控制方法 |
CN108594639A (zh) * | 2018-03-28 | 2018-09-28 | 哈尔滨工程大学 | 一种基于强化学习的全垫升气垫船航迹跟踪控制方法 |
CN109460043A (zh) * | 2018-12-29 | 2019-03-12 | 上海海事大学 | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 |
CN112596509A (zh) * | 2019-09-17 | 2021-04-02 | 广州汽车集团股份有限公司 | 车辆控制方法、装置、计算机设备及计算机可读存储介质 |
CN110618611A (zh) * | 2019-10-23 | 2019-12-27 | 哈尔滨工程大学 | 一种基于回转率约束的无人艇轨迹跟踪安全控制方法 |
CN111045332A (zh) * | 2019-12-27 | 2020-04-21 | 哈尔滨工程大学 | 一种无人艇路径跟踪导引策略和扰动补偿方法 |
CA3081611A1 (en) * | 2020-04-03 | 2020-09-11 | Pablo Air Co., Ltd. | Method in which small fixed-wing unmanned aerial vehicle follows path and lgvf path-following controller using same |
CN112506192A (zh) * | 2020-11-25 | 2021-03-16 | 哈尔滨工程大学 | 一种针对全回转推进器故障的动力定位船容错控制方法 |
Non-Patent Citations (8)
Title |
---|
FU, MINGYU,等: "Adaptive Trajectory Tracking Safety Control of Air Cushion Vehicle with Unknown Input Effective Parameters", 《APPLIED SCIENCES》 * |
XIAOGONG LIN,等: "Heading control of Air Cushion Vehicle with disturbance observer based on terminal sliding mode", 《2017 IEEE INTERNATIONAL CONFERENCE ON MECHATRONICS AND AUTOMATION (ICMA)》 * |
万磊等: "欠驱动智能水下机器人的自抗扰路径跟踪控制", 《上海交通大学学报》 * |
付明玉等: "基于扰动观测器的动力定位船终端滑模航迹跟踪控制", 《中国造船》 * |
王力等: "固定翼无人机的二阶PID滑模控制方法", 《计算机仿真》 * |
陈光祥等: "基于反步法的全垫升气垫船航向增稳控制", 《自动化技术与应用》 * |
陈涛等: "基于反演自适应动态滑模的气垫船航向控制", 《计算机仿真》 * |
魏健雄等: "基于神经网络PID的气垫船转艏角速度保持控制研究", 《软件导刊》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022227666A1 (zh) * | 2021-04-30 | 2022-11-03 | 哈尔滨工程大学 | 一种基于纵向速度规划的气垫船高速回转控制方法 |
GB2621306A (en) * | 2021-04-30 | 2024-02-14 | Univ Harbin Eng | Hovercraft high-speed rotation control method based on longitudinal speed planning |
WO2023050636A1 (zh) * | 2021-09-29 | 2023-04-06 | 哈尔滨工程大学 | 一种全垫升气垫船路径跟踪方法 |
GB2618860A (en) * | 2021-09-29 | 2023-11-22 | Univ Harbin Eng | Path tracking method for air cushion vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN113156965B (zh) | 2023-01-03 |
WO2022227666A1 (zh) | 2022-11-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113156965B (zh) | 一种基于纵向速度规划的气垫船高速回转控制方法 | |
CN103407443B (zh) | 一种气垫船航行安全性的协调控制方法 | |
CN109189087B (zh) | 一种垂直起降重复使用运载器的自适应容错控制方法 | |
US6246929B1 (en) | Enhanced stall and recovery control system | |
CN109814392B (zh) | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 | |
CN109062042B (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
CN103558857A (zh) | 一种btt飞行器的分布式复合抗干扰姿态控制方法 | |
WO2022242633A1 (zh) | 一种吊舱式无人艇航向控制方法 | |
CN109240289B (zh) | 波浪滑翔器艏摇信息自适应滤波方法 | |
CN106970633B (zh) | 抑制控制输入饱和的飞行控制方法 | |
CN110244556B (zh) | 基于期望航向修正的欠驱动船舶航向控制方法 | |
CN110865539A (zh) | 一种随机干扰下的无人艇跟踪误差约束控制方法 | |
WO2023050636A1 (zh) | 一种全垫升气垫船路径跟踪方法 | |
CN105425812A (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
CN110333658A (zh) | 一种带输入约束和漂角补偿的欠驱动船舶航向控制方法 | |
CN107491083A (zh) | 一种基于饱和自适应滑模控制的四旋翼自主着船方法 | |
CN110262513B (zh) | 一种海洋机器人轨迹跟踪控制结构的设计方法 | |
CN112650257A (zh) | 一种无人艇区域保持控制方法及装置 | |
CN110320927A (zh) | 智能变形飞行器的飞行控制方法及系统 | |
CN113110527B (zh) | 一种自主水下航行器有限时间路径跟踪的级联控制方法 | |
CN111413996B (zh) | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 | |
CN110647161B (zh) | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 | |
CN112987771A (zh) | 基于多端口输出误差触发机制的机帆船路径跟踪控制方法 | |
CN109752957B (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 |