CN113359459A - 旋翼飞行器滑模变结构的姿态控制方法 - Google Patents
旋翼飞行器滑模变结构的姿态控制方法 Download PDFInfo
- Publication number
- CN113359459A CN113359459A CN202110706604.8A CN202110706604A CN113359459A CN 113359459 A CN113359459 A CN 113359459A CN 202110706604 A CN202110706604 A CN 202110706604A CN 113359459 A CN113359459 A CN 113359459A
- Authority
- CN
- China
- Prior art keywords
- sliding mode
- rotorcraft
- formula
- establishing
- control method
- 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
- 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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种旋翼飞行器滑模变结构的姿态控制方法,包括如下步骤:1)建立旋翼飞行器模型;1.1)建立旋翼飞行器的运动学方程;1.2)建立旋翼飞行器的动力学方程;2)设计滑模姿态控制律;2.1)建立旋翼飞行器的动力学状态方程;2.2)设计滑动模态;2.3)设计滑模控制律;3)设计微分***;3.1)建立对二阶离散***;3.2)构造最速控制综合函数;3.3)将带入二阶离散***,得到微分***;4)设计非线性非光滑反馈控制律。本发明的旋翼飞行器滑模变结构的姿态控制方法,采用滑模变结构控制技术,在参数正负拉偏30%的条件下依然能够具有很好的控制平直,使得无人机的飞行控制品质具有很强的鲁棒性,有效保障了采用无人机自动飞行执行任务的可靠性。
Description
技术领域
本发明属于无人机技术领域,旨在设计一种无人机场无人化值班飞行控制技术,使其在核电站等重要场所自主化巡逻、安全保障领域使用过程中能够更加稳定和可靠。
背景技术
随着无人机控制技术以及传感器技术的发展,无人机场已经被应用在越来越多的领域,比如石油管道巡检、水利巡检、电力巡检、光伏和风电巡检、道路和智慧城市/园区、军事等领域。
无人机场通常包含如下两个主要部分:(1)无人机场停机坪;(2)旋翼/垂直起降固定翼无人机。其中,无人机场停机坪主要作用:(1)为无人机自动充放电池;(2)将无人机获取的前端视屏图像数据通过网络传输给后台云端;(3)遥测数据转发;(4)自动收纳以及放飞无人机。
由于无人机场、无人机经常工作在恶劣的环境如大风天气,以及空中卸载等情况,这些苛刻的作业环境需要无人机具备强大的控制鲁棒性以及适应性,以保证无人机的飞行安全。传统的串级PID控制,虽然也能实现对无人机的飞行控制,但是这种控制方式,需要根据无人机的作业工况调整控制参数,往往一组PID控制参数无法满足所有工况。
发明内容
有鉴于此,为了克服现有技术的缺陷,本发明的目的是提供一种旋翼飞行器滑模变结构的姿态控制方法。
为了达到上述目的,本发明采用以下的技术方案:
一种旋翼飞行器滑模变结构的姿态控制方法,包括如下步骤:
1)建立旋翼飞行器模型
1.1)建立旋翼飞行器的运动学方程:
1.2)建立旋翼飞行器的动力学方程:
2)设计滑模姿态控制律
2.1)建立旋翼飞行器的动力学状态方程
2.2)设计滑动模态
式中,e为跟踪误差向量,C为Hurwitz矩阵;
2.3)设计滑模控制律
式中,K为比例系数;
3)设计微分***
3.1)建立对二阶离散***
式中,x1为二阶离散***的输入,u1为二阶离散***的输出,x2为x1的积分;h为积分步长,r为速度因子;
3.2)构造最速控制综合函数fhan(x1,x2,r,h)
3.3)将u1=fhan(x1,x2,r,h)带入二阶离散***,得到微分***
式中,h为积分步长,r为速度因子;
4)设计非线性非光滑反馈控制律
u2=β0fal(e0,α0,δ)+β1fal(e1,α1,δ)+β2fal(e2,α2,δ)
式中:α0<0<α1<1<α2,或者0<α0<α1<1<α2;e0,e1,e2为非线性非光滑曲线上的不同的误差的阈值。
式中,ψ表示航向角,θ表示俯仰角,γ表示滚转角。
根据本发明的一些优选实施方面,步骤1.2)旋翼飞行器的动力学方程中三个方向的扭力U2,U3,U4的分别按照如下公式进行计算:
根据本发明的一些优选实施方面,步骤2.1)建立旋翼飞行器的动力学状态方程按照如下方式得到:
根据角动量守恒定律有如下公式成立:
将上式展开得到如下公式:
进而得到旋翼飞行器的动力学状态方程:
根据本发明的一些优选实施方面,步骤2.1)建立旋翼飞行器的动力学状态方程中旋翼飞行器的角速率与欧拉角的微分之间的转换关系如下:
根据本发明的一些优选实施方面,步骤2.2)设计滑动模态中e=x1-yd,式中yd=[yd1,yd2,yd3]T。
根据本发明的一些优选实施方面,步骤4)设计非线性非光滑反馈控制律采用如下形式的非线性控制律:
由于采用了上述技术方案,与现有技术相比,本发明的有益之处在于:本发明的旋翼飞行器滑模变结构的姿态控制方法,采用滑模变结构控制技术,在参数正负拉偏30%的条件下依然能够具有很好的控制平直,使得无人机的飞行控制品质具有很强的鲁棒性,有效保障了采用无人机自动飞行执行任务的可靠性。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明优选实施例的标称条件下的控制效果;
图2为本发明优选实施例的参数正拉偏30%的控制效果;
图3为本发明优选实施例的参数负拉偏30%的控制效果;
图4为本发明优选实施例的四旋翼无人机的示意图;
图5为本发明优选实施例的滑模变结构姿态控制器框图。
具体实施方式
为了使本技术领域的人员更好地理解本发明的技术方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。
本发明的无人机场旋翼飞行器滑模变结构姿态控制律设计方法,实现了无人机自动控制的鲁棒性,有效保障了采用无人机自动飞行执行任务在可靠性,包含:(1)设计一种滑模变结构控制律,用于控制四旋翼飞行器;(2)设计了非线性误差反馈控制律,用于反馈控制。
本实施例的旋翼飞行器滑模变结构的姿态控制方法,具体包括如下步骤:
步骤1:建立旋翼飞行器模型
如图4所示,本实施例以四旋翼飞行器为例建立动力学和运动学模型,在推导旋翼飞行器的六自由度模型之前,需要对一些后续用到的变量进行说明。后续用到的变量定义如表1所示。
表1物理变量定义
①建立旋翼飞行器的运动学方程
旋翼飞行器主要受到如下几个力:重力、升力、阻力。根据旋翼飞行器的空气动力学理论,升力U1以及三个方向的扭力(U2,U3,U4)的具体计算方法与旋翼飞行器的转速相关,表达式如下:
式中的各个字母含义如表1所示。根据旋翼飞行器的受力情况,运用牛顿第二定律得到旋翼飞行器的运动学方程:
公式(5)中的等号右边最后一项为阻力项,其与旋翼飞行器的速度成正比,符号相反。
式(6)中的ψ表示航向角,θ表示俯仰角,γ表示滚转角。
②建立旋翼飞行器的动力学方程
旋翼飞行器的角速率与欧拉角的微分之间的转换关系如下:
根据角动量守恒定律有如下公式成立:
将公式(8)详细展开如下:
进而可以得到旋翼飞行器的姿态动力学方程:
式(7)和式(10)分别为旋翼飞行器的运动学和动力学模型方程,用于描述旋翼飞行器在空间的平移运动和旋转运动。
步骤2:滑模姿态控制律设计
进一步考虑步骤1中旋翼飞行器姿态的动力学方程,即公式(10),并定义状态变量x1和x2。
定义状态变量x1:
定义状态变量x2:
将公式(10)与公式(11)、公式(12)结合,公式(10)可以转化为如下表达式:
公式(13)即为旋翼飞行器的姿态动力学状态方程,公式(13)为公式(10)不同形式。公式(13)中的表达式f和B分别如公式(14)和(15)所示:
公式(13)中Δf为模型误差,ΔB为控制矩阵误差,二者均来源于惯量、风阻系数、质心与旋翼中心距离的测量误差,d为外界干扰。
设定期望信号为yd=[yd1,yd2,yd3]T,定义跟踪误差向量为e=x1-yd,那么跟踪误差动态为:
进而可设计滑模控制律如下:
其中,K为比例系数,可使滑动变量有限时间收敛为0,进而使跟踪误差渐进收敛。
步骤3:微分***设计
微分***作用是尽快地跟踪输入信号,并给出跟踪信号的微分(用来近似输入信号的微分信号),故可以用来安排过渡过程。其核心意义在于对噪声的放大效应很低,从而避免了经典微分器小时间常数下对噪声放大严重以至于淹没微分信号的缺点。
设计对二阶离散***
上述方程中,x1为二阶离散***的输入,u1为二阶离散***的输出,x2为x1的积分,构造最速控制综合函数fhan(x1,x2,r,h),算法如下:
将u1=fhan(x1,x2,r,h)带入***,得到如下式所示的最速微分***:
步骤4:非线性非光滑反馈控制律
非线性非光滑反馈在改造***动态性能和抑制不确定扰动方面较线性反馈和非线性光滑反馈效果要好得多。
本实施例采用如下形式的非线性控制律:
当α<1时,fal函数具有:小误差、大增益;大误差、小增益的特性。
并采用如下形式的非线性组合:
u2=β0fal(e0,α0,δ)+β1fal(e1,α1,δ)+β2fal(e2,α2,δ) (23)
上式中:α0<0<α1<1<α2,或者0<α0<α1<1<α2。e0,e1,e2为非线性非光滑曲线上的不同的误差的阈值。上述的α0、α1、α2以及e0、e1、e2为可调整参数,需要根据实际控制效果进行调整。
通过上述步骤1-步骤4,设计得到本实施例的滑模姿态控制器,其表达形式包括三部分:
①滑模控制律
②最速微分***
③非线性非光滑反馈控制律
u2=β0fal(e0,α0,δ)+β1fal(e1,α1,δ)+β2fal(e2,α2,δ) (23)
上式中:α0<0<α1<1<α2,或者0<α0<α1<1<α2。
将式(18)中的s中的线性反馈部分Ke使用u2代替(Ks中的表达式中线性反馈部分为Ke),如下式所示。
即公式(18)、(21)和(23)共同做组成了无人机场旋翼飞行器的滑模变结构姿态控制器,即本发明中的旋翼飞行器滑模变结构的姿态控制方法。三个公式之间的运行关系如图5所示。
实施例
下方以具体数据进一步说明本发明的技术方案。假设四旋翼飞行器的参数如表2所示。
表2四旋翼飞行器参数
序号 | 参数 | 数值 |
1 | m/kg | 1.2 |
2 | L/m | 0.2 |
3 | k<sub>t</sub>×10<sup>-5</sup>/(N·s<sup>2</sup>) | 3.13 |
4 | k<sub>d</sub>×10<sup>-7</sup>/(N·ms<sup>2</sup>) | 7.5 |
5 | I<sub>xx</sub>×10<sup>-3</sup>/(kg·m<sup>2</sup>) | 2.353 |
6 | I<sub>yy</sub>×10<sup>-3</sup>/(kg·m<sup>2</sup>) | 2.353 |
7 | I<sub>zz</sub>×10<sup>-3</sup>/(kg·m<sup>2</sup>) | 5.262 |
标称情况下控制效果如图1所示,在旋翼无人机参数正拉偏30%条件下的控制效果如图2所示,旋翼无人机参数负拉偏30%条件下的控制效果如图3所示。不管参数是正拉偏还是负拉偏,旋翼无人机的俯仰角、偏航角以及滚转角的控制效果都能达到比较理想的效果,滑模变结构控制器都能取得优秀的控制品质。
本发明的旋翼飞行器滑模变结构的姿态控制方法,采用滑模变结构控制技术,取得了很好的控制响应;在参数正负拉偏30%的条件下依然能够具有很好的控制平直,使得无人机的飞行控制品质具有很强的鲁棒性,有效保障了采用无人机自动飞行执行任务的可靠性;为无人机场无人机实现常态话作业提供了控制基础。
上述实施例只为说明本发明的技术构思及特点,其目的在于让熟悉此项技术的人士能够了解本发明的内容并据以实施,并不能以此限制本发明的保护范围,凡根据本发明精神实质所作的等效变化或修饰,都应涵盖在本发明的保护范围之内。
Claims (8)
1.一种旋翼飞行器滑模变结构的姿态控制方法,其特征在于,包括如下步骤:
1)建立旋翼飞行器模型
1.1)建立旋翼飞行器的运动学方程:
1.2)建立旋翼飞行器的动力学方程:
2)设计滑模姿态控制律
2.1)建立旋翼飞行器的动力学状态方程
2.2)设计滑动模态
式中,e为跟踪误差向量,C为Hurwitz矩阵;
2.3)设计滑模控制律
式中,K为比例系数;
3)设计微分***
3.1)建立对二阶离散***
式中,x1为二阶离散***的输入,u1为二阶离散***的输出,x2为x1的积分;h为积分步长,r为速度因子;
3.2)构造最速控制综合函数fhan(x1,x2,r,h)
3.3)将u1=fhan(x1,x2,r,h)带入二阶离散***,得到微分***
式中,h为积分步长,r为速度因子;
4)设计非线性非光滑反馈控制律
u2=β0fal(e0,α0,δ)+β1fal(e1,α1,δ)+β2fαl(e2,α2,δ)
式中:α0<0<α1<1<α2,或者0<α0<α1<1<α2;e0,e1,e2为非线性非光滑曲线上的不同的误差的阈值。
7.根据权利要求1所述的姿态控制方法,其特征在于,步骤2.2)设计滑动模态中e=x1-yd,式中yd=[yd1,yd2,yd3]T。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110706604.8A CN113359459B (zh) | 2021-06-24 | 2021-06-24 | 旋翼飞行器滑模变结构的姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110706604.8A CN113359459B (zh) | 2021-06-24 | 2021-06-24 | 旋翼飞行器滑模变结构的姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113359459A true CN113359459A (zh) | 2021-09-07 |
CN113359459B CN113359459B (zh) | 2022-09-20 |
Family
ID=77536141
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110706604.8A Active CN113359459B (zh) | 2021-06-24 | 2021-06-24 | 旋翼飞行器滑模变结构的姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113359459B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114355963A (zh) * | 2021-12-27 | 2022-04-15 | 海兴东方新能源发电有限公司 | 基于旋翼无人机实现高度控制的方法、***、终端及介质 |
CN114355959A (zh) * | 2021-10-08 | 2022-04-15 | 湖北隆感科技有限公司 | 空中机器人的姿态输出反馈控制方法、装置、介质和设备 |
CN115657703A (zh) * | 2022-12-27 | 2023-01-31 | 南京理工大学 | 基于改进自抗扰控制器的消防无人机姿态控制方法 |
CN117389154A (zh) * | 2023-12-06 | 2024-01-12 | 北京航空航天大学杭州创新研究院 | 基于动态控制分配的变构飞行器抗干扰姿态协调控制方法 |
CN117908384A (zh) * | 2024-03-19 | 2024-04-19 | 南京航空航天大学 | 一种基于自适应滑模的变体飞行器串级控制方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105182750A (zh) * | 2015-09-02 | 2015-12-23 | 中国人民解放军军械工程学院 | 一种线性/非线性自抗扰控制***切换控制方法 |
CN105759832A (zh) * | 2016-05-20 | 2016-07-13 | 武汉科技大学 | 一种基于反演法的四旋翼飞行器滑模变结构控制方法 |
CN106325291A (zh) * | 2016-10-10 | 2017-01-11 | 上海拓攻机器人有限公司 | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及*** |
CN106527128A (zh) * | 2016-10-13 | 2017-03-22 | 南京航空航天大学 | 兼顾瞬态响应与鲁棒稳定性的飞行控制律设计新方法 |
WO2020062499A1 (zh) * | 2018-09-28 | 2020-04-02 | 东南大学 | 一种针对电子节气门***的非线性抗干扰控制方法及装置 |
-
2021
- 2021-06-24 CN CN202110706604.8A patent/CN113359459B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105182750A (zh) * | 2015-09-02 | 2015-12-23 | 中国人民解放军军械工程学院 | 一种线性/非线性自抗扰控制***切换控制方法 |
CN105759832A (zh) * | 2016-05-20 | 2016-07-13 | 武汉科技大学 | 一种基于反演法的四旋翼飞行器滑模变结构控制方法 |
CN106325291A (zh) * | 2016-10-10 | 2017-01-11 | 上海拓攻机器人有限公司 | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及*** |
CN106527128A (zh) * | 2016-10-13 | 2017-03-22 | 南京航空航天大学 | 兼顾瞬态响应与鲁棒稳定性的飞行控制律设计新方法 |
WO2020062499A1 (zh) * | 2018-09-28 | 2020-04-02 | 东南大学 | 一种针对电子节气门***的非线性抗干扰控制方法及装置 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114355959A (zh) * | 2021-10-08 | 2022-04-15 | 湖北隆感科技有限公司 | 空中机器人的姿态输出反馈控制方法、装置、介质和设备 |
CN114355959B (zh) * | 2021-10-08 | 2024-04-19 | 湖北隆感科技有限公司 | 空中机器人的姿态输出反馈控制方法、装置、介质和设备 |
CN114355963A (zh) * | 2021-12-27 | 2022-04-15 | 海兴东方新能源发电有限公司 | 基于旋翼无人机实现高度控制的方法、***、终端及介质 |
CN115657703A (zh) * | 2022-12-27 | 2023-01-31 | 南京理工大学 | 基于改进自抗扰控制器的消防无人机姿态控制方法 |
CN117389154A (zh) * | 2023-12-06 | 2024-01-12 | 北京航空航天大学杭州创新研究院 | 基于动态控制分配的变构飞行器抗干扰姿态协调控制方法 |
CN117389154B (zh) * | 2023-12-06 | 2024-02-27 | 北京航空航天大学杭州创新研究院 | 基于动态控制分配的变构飞行器抗干扰姿态协调控制方法 |
CN117908384A (zh) * | 2024-03-19 | 2024-04-19 | 南京航空航天大学 | 一种基于自适应滑模的变体飞行器串级控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN113359459B (zh) | 2022-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113359459B (zh) | 旋翼飞行器滑模变结构的姿态控制方法 | |
CN109614633B (zh) | 一种复合式旋翼飞行器非线性建模及线性化配平方法 | |
Zhao et al. | Attitude control for quadrotors subjected to wind disturbances via active disturbance rejection control and integral sliding mode control | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
CN108873929B (zh) | 一种固定翼飞机自主着舰方法及*** | |
Maqsood et al. | Optimization of transition maneuvers through aerodynamic vectoring | |
CN110928322B (zh) | 四旋翼飞行器运送悬挂负载的非线性运动控制方法 | |
CN107215454A (zh) | 一种新型复合滚转姿态控制***及方法 | |
CN113342025A (zh) | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 | |
CN112947062B (zh) | 一种复合翼垂直起降无人机旋翼模式控制方法及*** | |
CN106527128B (zh) | 兼顾瞬态响应与鲁棒稳定性的飞行控制律设计方法 | |
Zhao et al. | Robust transition control of a Martian coaxial tiltrotor aerobot | |
CN111077897B (zh) | 一种改进型非线性pid的四旋翼飞行器控制方法 | |
Qingtong et al. | Backstepping-based attitude control for a quadrotor UAV using nonlinear disturbance observer | |
BOUZID et al. | Generic dynamic modeling for multirotor VTOL UAVs and robust Sliding Mode based Model-Free Control for 3D navigation | |
CN113093809A (zh) | 一种复合翼无人机的自抗扰控制器及其建立方法 | |
CN116088549B (zh) | 一种尾座式垂直起降无人机姿态控制方法 | |
CN115685764B (zh) | 变翼展飞行器任务自适应的抗干扰跟踪控制方法及*** | |
CN114564047B (zh) | 一种考虑气象条件的无人机等速飞行控制方法 | |
CN114115323B (zh) | 一种三舵机驱动的仿鸟类扑翼飞行器的建模及控制方法 | |
CN113885545B (zh) | 考虑缆绳张力变化的系留无人机控制方法 | |
Brahim et al. | Finite Time Adaptive SMC for UAV Trajectory Tracking Under Unknown Disturbances and Actuators Constraints | |
CN113238572A (zh) | 基于预设性能控制的预设时间四旋翼无人机姿态跟踪方法 | |
Qu et al. | Dynamic Modeling and Control of Small-size Quadrotor Considering Wind Field Disturbance | |
CN113885358B (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 |