CN107728468B - 一种应用于悬挂负载直升机的新型离散全镇定控制方法 - Google Patents
一种应用于悬挂负载直升机的新型离散全镇定控制方法 Download PDFInfo
- Publication number
- CN107728468B CN107728468B CN201710703039.3A CN201710703039A CN107728468B CN 107728468 B CN107728468 B CN 107728468B CN 201710703039 A CN201710703039 A CN 201710703039A CN 107728468 B CN107728468 B CN 107728468B
- Authority
- CN
- China
- Prior art keywords
- helicopter
- load
- control
- full
- suspension load
- 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
- 239000000725 suspension Substances 0.000 title claims abstract description 42
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000006073 displacement reaction Methods 0.000 claims abstract description 24
- 238000011105 stabilization Methods 0.000 claims abstract description 13
- 238000013178 mathematical model Methods 0.000 claims abstract description 5
- 230000006641 stabilisation Effects 0.000 claims abstract description 4
- 230000008569 process Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 239000002245 particle Substances 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 6
- 230000010355 oscillation Effects 0.000 description 3
- 238000005094 computer simulation Methods 0.000 description 2
- 230000006378 damage Effects 0.000 description 2
- 230000000087 stabilizing effect Effects 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
Images
Classifications
-
- 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)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (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)
- Control And Safety Of Cranes (AREA)
Abstract
本发明提供了一种应用于悬挂负载直升机的新型离散全镇定控制方法，包括如下步骤：1)得出悬挂负载直升机简化数学模型的动力学方程，并采集相关参数；2)根据步骤1)中的动力学方程，结合零化动力学和梯度动力学方法，得出全镇定连续控制器，实现悬挂负载直升机位移与负载摆动角的同时镇定控制；3)根据步骤2)中全镇定连续控制器，采用新型离散公式获得用于计算机数字控制的控制输入量和控制参变量。本发明提供了一种应用于悬挂负载直升机的新型离散全镇定控制方法，实现了对悬挂负载直升机位移和负载摆动角的同时镇定控制。
Description
技术领域
本发明涉及悬挂负载直升机控制领域，更具体涉及一种应用于悬挂负载直升机的新型离散全镇定控制方法。
背景技术
悬挂负载直升机飞行时悬挂物会对直升机的飞行造成较大影响，其飞行运动模式、稳定性和操作性均发生了改变。到达目的地后直升机停止时，悬挂的负载极有可能因为惯性发生类似单摆的运动，造成货物损坏甚至对地面人员安全造成威胁。由此可见，在直升机悬停时对负载的零振荡控制十分必要，这就要求我们同时对悬挂负载直升机位移和负载摆动角进行控制，这样做将会大幅度提高直升机运输效率，缓解驾驶员驾驶压力，保证直升机的安全运输。因此，实现悬挂负载直升机全镇定控制具有非常重要的应用价值，在国防建设等诸多领域具有重要的应用前景。
以前的研究可能只涉及到对悬挂负载直升机位移或者是负载摆动角单独控制的情况，该情况可能导致飞机虽然停下来了，但负载还在发生摆动，或者是负载停下来了，但飞机速度还未减小到零(也即，位移不是常数)，这样就无法实现全镇定控制，从而增加了货物损坏的风险，甚至造成对地面人员的伤害。
发明内容
本发明的目的在于克服现有技术与方法的不足，提供一种应用于悬挂负载直升机的新型离散全镇定控制方法，其中采用全镇定连续控制器，实现悬挂负载直升机位移与负载摆动角的同时镇定控制，并采用新型离散公式获得用于计算机数字控制的控制输入量和控制参变量。
为了实现上述发明目的，采用的技术方案如下：
一种应用于悬挂负载直升机的新型离散全镇定控制方法，包括如下步骤：
S1.得出悬挂负载直升机简化数学模型的动力学方程，并采集相关参数；
S2.根据步骤S1中的动力学方程，结合零化动力学和梯度动力学方法，得出全镇定连续控制器，实现悬挂负载直升机位移与负载摆动角的同时镇定控制；
S3.由于计算机只能处理数字量，根据步骤S2中得出的全镇定连续控制器，采用新型离散公式获得用于计算机数字控制的控制输入量和控制参变量，从而实现计算机同时控制悬挂负载直升机位移与负载摆动角。
步骤S1得出悬挂负载直升机简化数学模型，将负载视为质点，建立其动力学方程为：
其中，x为直升机位移，v为直升机速度，
为直升机加速度，θ为负载摆动角，ω为负载摆动角速度，
为负载摆动角加速度，fh为直升机水平驱动力，上述变量中均省略了作为自变量的时间变量t。采集悬挂负载直升机相关参数用于建模
和
直升机质量M，负载质量m，绳索长度l。
本发明首先结合零化动力学和梯度动力学方法，得出的控制器和它的控制参变量之间建立了耦合关系，使得悬挂负载直升机位移和负载摆动角之间存在一定内在关联，从而实现了悬挂负载直升机位移和负载摆动角的同时镇定控制。由于计算机只能处理数字量，因此，采用新型离散公式获得用于计算机数字控制的控制输入量和控制参变量，从而实现计算机同时控制悬挂负载直升机位移与负载摆动角。
步骤S2中得出全镇定连续控制器：
其中，λ为控制参变量，通过采用梯度动力学方法，得出如下表达式：
将控制参变量λ的表达式代入全镇定连续控制器
中，控制悬挂负载直升机速度最终为零以及负载摆动角最终也为零，即实现悬挂负载直升机位移和负载摆动角的同时镇定控制。
步骤S3中采用新型离散公式，其表达式为：
其中，τ为计算机数字控制的采样间隔，c1，c2，c3，…cn+1为常系数。上述的新型离散公式获得了如下的用于计算机数字控制的控制输入量和控制参变量：
相应地，采用新型离散公式，也得到x(tk+1)，v(tk+1)，θ(tk+1)，ω(tk+1)。根据步骤S2中的全镇定连续控制器：
其中，λ为控制参变量，通过采用梯度动力学方法，得出如下表达式：
采用新型离散公式，进而得到计算机数字控制的控制输入量fh(tk+1)和控制参变量λ(tk+1)的具体表达式，将控制参变量λ(tk+1)代入计算机数字控制的控制输入量fh(tk+1)中，控制悬挂负载直升机速度v(tk+1)最终为零[也即，悬挂负载直升机位移x(tk+1)为常数]以及负载摆动角θ(tk+1)最终也为零。
与现有技术相比，本发明的有益效果为：本发明不仅能够实现对悬挂负载直升机位移的新型离散镇定控制，也能同时实现对负载摆动角的新型离散镇定控制，即实现悬挂负载直升机的新型离散全镇定控制。
附图说明
图1为本发明的流程图；
图2为悬挂负载直升机简化模型的示意图；
图3为本发明方法处理悬挂负载直升机新型离散全镇定控制时v(tk+1)的曲线图；
图4为本发明方法处理悬挂负载直升机新型离散全镇定控制时fh(tk+1)的曲线图；
图5为本发明方法处理悬挂负载直升机新型离散全镇定控制时x(tk+1)的曲线图；
图6为本发明方法处理悬挂负载直升机新型离散全镇定控制时θ(tk+1)的曲线图；
图7为本发明方法处理悬挂负载直升机新型离散全镇定控制时ω(tk+1)的曲线图；
图8为本发明方法处理悬挂负载直升机新型离散全镇定控制时|eθ(tk+1)|的曲线图。
具体实施方式
下面结合附图对本发明方法做进一步说明。
如图1，一种应用于悬挂负载直升机的新型离散全镇定控制方法，包括如下步骤：
S1.得出悬挂负载直升机简化数学模型的动力学方程，并采集相关参数；
S2.根据步骤S1中的动力学方程，结合零化动力学和梯度动力学方法，得出全镇定连续控制器，实现悬挂负载直升机位移与负载摆动角的同时镇定控制；
S3.由于计算机只能处理数字量，根据步骤S2中得出的全镇定连续控制器，采用新型离散公式获得用于计算机数字控制的控制输入量和控制参变量，从而实现计算机同时控制悬挂负载直升机位移与负载摆动角。
图2为悬挂负载直升机的简化模型。将负载视为质点，建立其动力学方程：
根据上述动力学方程，结合零化动力学和梯度动力学方法，得出全镇定连续控制器：
其中，λ为控制参变量，通过采用梯度动力学方法，得出如下表达式：
由于计算机只能处理数字量，根据上述的全镇定连续控制器，采用新型离散公式获得用于计算机数字控制的控制输入量和控制参变量，从而实现计算机同时控制悬挂负载直升机位移与负载摆动角：
为了便于理解与应用，本例以一个具体的新型离散公式为例,来具体实施进行计算机仿真。令
其余为0，则新型离散公式写为：
计算机数字控制的控制输入量和控制参变量进而写为
进行计算机仿真时，采集相关参数如下：m＝0.2kg，M＝1kg，l＝1.2m。另外，计算机数字控制的采样间隔设定为0.01s,执行时间设定为100s。图3、图4、图5、图6、图7和图8分别对应为本发明方法处理悬挂负载直升机新型离散全镇定控制时v(tk+1)、fh(tk+1)、x(tk+1)、θ(tk+1)、ω(tk+1)和|eθ(tk+1)|的曲线图，从这些仿真图中看出，悬挂负载直升机速度、负载摆动角、负载摆动角速度以及负载摆动角的绝对值误差最终都为零，悬挂负载直升机位移最终为一个常数，即，实现了全镇定控制。而且我们能清晰地看到，在大概第5000次采样，即执行时间为50s时，这些状态变量和负载摆动角的绝对值误差基本都收敛到零，说明本发明方法确实有效地实现对悬挂负载直升机新型离散全镇定控制。
以上所述的本发明的实施方式，并不构成对本发明保护范围的限定。任何在本发明的精神原则之内所做出的修改、等同替换和改进等，均应包含在本发明的权利要求保护范围之内。
Claims (2)
1.一种应用于悬挂负载直升机的新型离散全镇定控制方法，其特征在于，包括如下步骤：
S1、得出悬挂负载直升机简化数学模型的动力学方程，并采集相关参数；将负载视为质点，所述动力学方程表达式为：
其中，x为直升机位移，v为直升机速度，
为直升机加速度，θ为负载摆动角，ω为负载摆动角速度，
为负载摆动角加速度，fh为直升机水平驱动力，上述变量中均省略了作为自变量的时间变量t；采集悬挂负载直升机相关参数用于建模
和
直升机质量M，负载质量m，绳索长度l；
S2、根据步骤S1中的动力学方程，结合零化动力学和梯度动力学方法，得出全镇定连续控制器，实现悬挂负载直升机位移与负载摆动角的同时镇定控制；所述全镇定连续控制器为：
其中，λ为控制参变量，通过采用梯度动力学方法，得出如下表达式：
ψh和ψλ均代表映射函数符号；将控制参变量λ的表达式代入全镇定连续控制器
中，控制悬挂负载直升机速度最终为零以及负载摆动角最终也为零，即实现悬挂负载直升机位移和负载摆动角的同时镇定控制；
S3、由于计算机只能处理数字量，根据步骤S2中得出的全镇定连续控制器，采用新型离散公式获得用于计算机数字控制的控制输入量和控制参变量，从而实现计算机同时控制悬挂负载直升机位移与负载摆动角；所述新型离散公式，其表达式为：
其中，τ为计算机数字控制的采样间隔，c1，c2，c3，···cn+1为常系数。
2.根据权利要求1所述的一种应用于悬挂负载直升机的新型离散全镇定控制方法，其特征在于，采用步骤S3中所述的新型离散公式获得了如下的用于计算机数字控制的控制输入量fh(tk+1)和控制参变量λ(tk+1)，进而实现计算机同时控制悬挂负载直升机位移与负载摆动角：
相应地，采用所述新型离散公式，也得到x(tk+1)，v(tk+1)，θ(tk+1)，ω(tk+1)；将控制参变量λ(tk+1)代入计算机数字控制的控制输入量fh(tk+1)中，控制悬挂负载直升机速度v(tk+1)最终为零以及负载摆动角θ(tk+1)最终也为零。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710703039.3A CN107728468B (zh) | 2017-08-16 | 2017-08-16 | 一种应用于悬挂负载直升机的新型离散全镇定控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710703039.3A CN107728468B (zh) | 2017-08-16 | 2017-08-16 | 一种应用于悬挂负载直升机的新型离散全镇定控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107728468A CN107728468A (zh) | 2018-02-23 |
| CN107728468B true CN107728468B (zh) | 2020-11-10 |
Family
ID=61204688
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710703039.3A Active CN107728468B (zh) | 2017-08-16 | 2017-08-16 | 一种应用于悬挂负载直升机的新型离散全镇定控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107728468B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110231823B (zh) * | 2019-06-13 | 2020-07-14 | 中山大学 | 一种双轮机器人的直接控制方法 |
| CN110806688B (zh) * | 2019-11-20 | 2022-12-09 | 中山大学 | 一种时变非线性质量弹簧阻尼系统的运动控制方法 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004280792A (ja) * | 2003-02-14 | 2004-10-07 | United Technol Corp <Utc> | リアルタイムモデル予測制御における二次のプログラミングに対する加速されたアクティブセット探索のシステムおよび方法 |
| US7343232B2 (en) * | 2003-06-20 | 2008-03-11 | Geneva Aerospace | Vehicle control system including related methods and components |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101477764B (zh) * | 2009-01-04 | 2011-05-04 | 上海大学 | 网络化双并联倒立摆 |
| US8190307B2 (en) * | 2010-08-23 | 2012-05-29 | King Fahd University Of Petroleum & Minerals | Control optimization method for helicopters carrying suspended loads |
| CN103760905B (zh) * | 2014-01-29 | 2016-06-01 | 天津大学 | 基于模糊前馈单旋翼无人直升机姿态非线性鲁棒控制方法 |
| CN104597909B (zh) * | 2014-11-26 | 2017-10-17 | 深圳市鸣鑫航空科技有限公司 | 共轴双旋翼无人直升机飞行控制方法 |
| CN105930129B (zh) * | 2016-04-12 | 2019-01-22 | 广东顺德中山大学卡内基梅隆大学国际联合研究院 | 一种应用于直升机吊挂负载摆动角镇定的时变除法方法 |
-
2017
- 2017-08-16 CN CN201710703039.3A patent/CN107728468B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004280792A (ja) * | 2003-02-14 | 2004-10-07 | United Technol Corp <Utc> | リアルタイムモデル予測制御における二次のプログラミングに対する加速されたアクティブセット探索のシステムおよび方法 |
| US7343232B2 (en) * | 2003-06-20 | 2008-03-11 | Geneva Aerospace | Vehicle control system including related methods and components |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107728468A (zh) | 2018-02-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106873624B (zh) | 基于部分反馈线性化四旋翼无人机吊挂飞行控制方法 | |
| CN104865968B (zh) | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 | |
| CN106933104B (zh) | 一种基于dic-pid的四旋翼飞行器姿态与位置的混合控制方法 | |
| Liu et al. | Robust tracking control of a quadrotor helicopter | |
| CN108445895B (zh) | 用于倾转式三旋翼无人机位置控制的鲁棒控制方法 | |
| Kui et al. | Sliding mode control for a quadrotor slung load system | |
| CN108052117A (zh) | 基于部分反馈线性化四旋翼无人机吊挂飞行控制方法 | |
| CN107765553A (zh) | 针对旋翼无人机吊挂运输系统的非线性控制方法 | |
| CN109725643B (zh) | 一种基于主动建模的旋翼飞行器非平衡负载吊运系统的控制方法 | |
| Guo et al. | Initial virtual flight test for a dynamically similar aircraft model with control augmentation system | |
| CN107728468B (zh) | 一种应用于悬挂负载直升机的新型离散全镇定控制方法 | |
| CN109885074B (zh) | 四旋翼无人机有限时间收敛姿态控制方法 | |
| Fang et al. | Adaptive backstepping control of an indoor micro-quadrotor | |
| Raz et al. | Wind tunnel and flight evaluation of passive stabilization of a cargo container slung load | |
| Sheng et al. | Autonomous takeoff and landing control for a prototype unmanned helicopter | |
| Gao et al. | Flight dynamics modeling and control of a novel catapult launched tandem-wing micro aerial vehicle with variable sweep | |
| Oktay et al. | Dynamic Modeling and Simulation of Quadcopter for Several Flight Conditions | |
| CN113031655B (zh) | 一种伴有负载升降的飞行吊运系统及其控制方法 | |
| CN108427426B (zh) | 空中吊车负载振荡控制方法和系统 | |
| Dai et al. | Wind disturbance rejection for unmanned aerial vehicle based on acceleration feedback method | |
| Liu et al. | Quaternion-based robust attitude control for quadrotors | |
| Alcan et al. | Robust hovering control of a quadrotor using acceleration feedback | |
| Zeng et al. | PID vs. MRAC control techniques applied to a quadrotor's attitude | |
| Yao et al. | Trajectory tracking controller based on PID-NLADRC | |
| Liang et al. | A novel nonlinear backstepping-based control approach for quadrotor unmanned aerial vehicle transportation systems |
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 |