CN111077897B - 一种改进型非线性pid的四旋翼飞行器控制方法 - Google Patents
一种改进型非线性pid的四旋翼飞行器控制方法 Download PDFInfo
- Publication number
- CN111077897B CN111077897B CN202010086746.4A CN202010086746A CN111077897B CN 111077897 B CN111077897 B CN 111077897B CN 202010086746 A CN202010086746 A CN 202010086746A CN 111077897 B CN111077897 B CN 111077897B
- Authority
- CN
- China
- Prior art keywords
- control
- aircraft
- parameters
- rotor
- attitude
- 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
-
- 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- 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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P.I., P.I.D.
-
- 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Abstract
本发明涉及一种非线性PID的四旋翼飞行器控制方法,以满足四旋翼飞行器对给定姿态和高度快速准确跟踪的性能要求,同时控制算法简单可靠并且计算量小。本发明提供的改进型非线性PID的控制方法,在传统非线性PID控制的基础上,进一步将姿态跟踪和滚转角跟踪的控制系数非线性化,提高跟踪速度,最终使得系统在不需要精确的系统数学模型的情况下,可以实现四旋翼飞行器的姿态快速跟踪控制。
Description
技术领域
本发明涉及一种四旋翼飞行器的改进型非线性PID控制方法,以满足四旋翼飞行器对给定姿态和高度快速准确跟踪的性能要求。
背景技术
四旋翼无人飞行器结构简单,能够垂直起降、并且操纵方便,目前在电力巡检、安防、视频拍摄、侦查、遥感遥测等方面都得到了大面积应用。由于结构上改进空间有限,近年来针对四旋翼飞行器研究主要集中在控制算法上,以提升操控性能,提升飞行稳定度。
针对四旋翼的特点,目前发展出了滑模,神经网络,自适应以及多种算法融合的控制算法。滑模控制的难点在于滑模面的设计复杂度较高。在传统PID控制的基础上,利用神经网络的非线性映射能力和优化算法可提高传统 PID的控制效果,但是该方法训练时间较长,且训练的数据只能用于被训练对象。
非线性PID控制算法最早由韩京清提出,旨在使用非线性方法构建PID的参数,进一步提升PID的跟踪性能。目前非线性PID控制算法在很多场合也已经得到了应用,在动态性能和控制精度方面体现了良好的性能。通过分析非线性PID对四旋翼飞行器的轨迹跟踪性能,并将其与滑模控制、传统PID方法进行比较,发现非线性PID具有更好的轨迹跟踪能力。将非线性PID用于四旋翼飞行器的定高控制,结果表明其高度跟踪速度较快,但是该算法只跟踪了高度,不够完善。因此在传统非线性PID原理的基础上,本发明提供一种改进型非线性PID的控制方法,进一步将姿态跟踪和滚转角跟踪的控制系数非线性化,提高跟踪速度。
发明内容
为满足四旋翼飞行器对给定姿态和高度快速准确跟踪的性能要求,同时控制算法简单可靠并且计算量小,本发明提供一种基于改进型非线性PID的控制方法,在传统非线性PID控制的基础上,进一步将姿态跟踪和滚转角跟踪的PID控制系数非线性化,在不需要精确的系统数学模型的情况下,可以实现四旋翼飞行器的姿态跟踪控制。
为解决上述技术问题的技术方案如下:
一种基于非线性PID的四旋翼飞行器控制方法,包括以下步骤:
步骤1,建立四旋翼飞行器的动态系统,初始化系统参数、采样时间以及控制参数。四旋翼飞行器系统的动力学模型表达式形式为:
其中,为飞行器在惯性坐标系中的位置坐标;代表飞行器的欧拉角,分别为滚转角、俯仰角和偏航角;l为飞行器旋翼末端到飞行器质心的距离;m为飞行器的负载总重量;为转动惯量;(i=1,2...6)为助力系数;u为假设的中间控制输入,其定义为
步骤2,确定控制系统采用的控制方式为双闭环的控制方法,外环为位置控制系统,内环为姿态控制系统。由于系统为欠驱动控制系统,控制器不能够同时对6个自由度都进行跟踪控制,设定控制的目标为航迹和滚转角,同时稳定另外两个角度。系统的控制目标为x趋于0,y趋于0,z趋于,趋于,即四旋翼飞行器为定高,定姿态飞行模式。控制过程先确定位置控制PID参数,再确定姿态控制PID参数,过程如下:
则根据PD控制的规则,设计的控制输入结构形式为
2.2姿态控制为内环控制,采用前馈补偿的方法,设计得到的输入为
2.3计算非线性误差,根据非线性PID的结构设计方法,系统没有积分环节,只有比例和微分环节,控制输入设计为
2.4计算非线性系数,根据PD控制系统的需求,比例系数p可调节系统的响应速度,系数越大,控制作用越强,所以在初始时,误差较大,为保证跟踪的速度,系数p取值较大,随着误差的减小,P值逐渐减小。微分环节有助于系统减小超调,克服振荡,加快系统的响应速度,减小调节时间,从而达到改善系统动态性能的目标,实际输出与控制目标之差为负值且其值越大,微分系数越大,随着差值的减小,微分系数渐渐稳定到一个固定值。设计参数为
附图说明
图1为本发明的控制流程示意图;
图2为本发明的控制算法与传统非线性控制算法对x轴控制的效果;
图3为本发明的控制算法与传统非线性控制算法对y轴控制的效果;
图4为本发明的控制算法与传统非线性控制算法对z轴跟踪的效果;
具体实施方式
以下结合附图对本发明的原理和特征进行描述,所举实例只用于解释本发明,并非用于限定本发明的范围。
参照图1,一种基于非线性PID的四旋翼飞行器控制方法,包括以下步骤:
步骤1,建立四旋翼飞行器的动态系统,初始化系统参数、采样时间以及控制参数。四旋翼飞行器系统的动力学模型表达式形式为:
其中,为飞行器在惯性坐标系中的位置坐标;代表飞行器的欧拉角,分别为滚转角、俯仰角和偏航角;l为飞行器旋翼末端到飞行器质心的距离;m为飞行器的负载总重量;为转动惯量;(i=1,2...6)为助力系数;u为假设的中间控制输入,其定义为
其中,b为升力系数,(i=1,2,3,4)为第i个旋翼的转速,d为反扭矩系数。飞行器的参数设计为m=2; l=0.2; g=9.8; K1=0.01; K2=0.01; K3=0.01; K4=0.012; K5=0.012; K6=0.012; I1=1.25; I2=1.25; I3=2.5。
步骤2,确定控制系统采用的控制方式为双闭环的控制方法,外环为位置控制系统,内环为姿态控制系统。由于系统为欠驱动控制系统,控制器不能够同时对6个自由度都进行跟踪控制,设定控制的目标为航迹和滚转角,同时稳定另外两个角度。系统的控制目标为x趋于0,y趋于0,z趋于,趋于,即四旋翼飞行器为定高,定姿态飞行模式,。控制过程先确定位置控制PID参数,再确定姿态控制PID参数,过程如下:
则根据PD控制的规则,设计的控制输入结构形式为
2.2姿态控制为内环控制,采用前馈补偿的方法,设计得到的输入为
2.3计算非线性误差,根据非线性PID的结构设计方法,系统没有积分环节,只有比例和微分环节,控制输入设计为
2.4根据控制系统的目标为z稳定到,稳定到,由此在z和的闭环控制回路上,将比例系数和微分系数也进行非线性化,以进一步提高控制系统的跟踪性能。计算非线性系数,根据PD控制系统的需求,比例系数p可调节系统的响应速度,系数越大,控制作用越强,所以在初始时,误差较大,为保证跟踪的速度,系数p取值较大,随着误差的减小,P值逐渐减小。微分环节有助于系统减小超调,克服振荡,加快系统的响应速度,减小调节时间,从而达到改善系统动态性能的目标,实际输出与控制目标之差为负值且其值越大,微分系数越大,随着差值的减小,微分系数渐渐稳定到一个固定值。设计参数为
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种基于非线性PID的四旋翼飞行器控制方法,包括以下步骤:步骤1,建立四旋翼飞行器的动态系统,初始化系统参数、采样时间以及控制参数;四旋翼飞行器系统的动力学模型表达式形式为:
其中,为飞行器在惯性坐标系中的位置坐标;代表飞行器的欧拉角,分别为滚转角、俯仰角和偏航角;l为飞行器旋翼末端到飞行器质心的距离;m为飞行器的负载总重量;I1、I2、I3分别为俯仰角、偏航角和滚转角方向的转动惯量;K1、K2、K3、K4、K5、K6分别为x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角方向的助力系数;u为假设的中间控制输入,其定义为
其中,b为升力系数,Ω1、Ω2、Ω3、Ω4分别为第1、2、3、4个旋翼的转速,d为反扭矩系数;
步骤2,确定控制系统采用的控制方式为双闭环的控制方法,外环为位置控制系统,内环为姿态控制系统;
由于系统为欠驱动控制系统,控制器不能够同时对6个自由度都进行跟踪控制,设定控制的目标为航迹和滚转角,同时稳定另外两个角度;
控制过程先确定位置控制PID参数,再确定姿态控制PID参数,过程如下:
设计的控制输入结构形式为
2.2姿态控制为内环控制,采用前馈补偿的方法,设计得到的输入为
2.3计算非线性误差,控制输入设计为
sech为MATLAB环境下的双曲正割函数,exp为MATLAB环境下的指数函数;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010086746.4A CN111077897B (zh) | 2020-02-11 | 2020-02-11 | 一种改进型非线性pid的四旋翼飞行器控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010086746.4A CN111077897B (zh) | 2020-02-11 | 2020-02-11 | 一种改进型非线性pid的四旋翼飞行器控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111077897A CN111077897A (zh) | 2020-04-28 |
CN111077897B true CN111077897B (zh) | 2022-04-29 |
Family
ID=70324206
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010086746.4A Active CN111077897B (zh) | 2020-02-11 | 2020-02-11 | 一种改进型非线性pid的四旋翼飞行器控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111077897B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112000096A (zh) * | 2020-08-12 | 2020-11-27 | 中国计量大学 | 一种基于麻雀搜索算法的差速agv轨迹跟踪控制方法 |
CN113342024A (zh) * | 2021-06-24 | 2021-09-03 | 湘潭大学 | 基于预见控制的四旋翼飞行器的定点巡航控制方法 |
CN114706295B (zh) * | 2022-06-07 | 2022-08-26 | 中国飞机强度研究所 | 用于空天飞机强度测试的热试验中快时变热载荷控制方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104865968B (zh) * | 2015-04-22 | 2017-06-23 | 浙江工业大学 | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 |
CN105182984B (zh) * | 2015-07-16 | 2018-05-15 | 孙明玮 | 飞行器俯仰姿态的线性自抗扰控制器设计与参数整定方法 |
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106647241B (zh) * | 2016-12-05 | 2020-02-04 | 南昌航空大学 | 一种新型的非线性pid控制器 |
CN107894708A (zh) * | 2017-04-24 | 2018-04-10 | 长春工业大学 | 一种环形耦合型多轴机器人系统的同步控制方法 |
CN109676634B (zh) * | 2018-08-28 | 2021-02-19 | 杭州电子科技大学 | 自抗扰控制器及工业机器人 |
CN109936080B (zh) * | 2019-03-28 | 2020-05-22 | 郑州大学 | 一种无人机巡检输电线路的方法 |
-
2020
- 2020-02-11 CN CN202010086746.4A patent/CN111077897B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111077897A (zh) | 2020-04-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111077897B (zh) | 一种改进型非线性pid的四旋翼飞行器控制方法 | |
CN110377045B (zh) | 一种基于抗干扰技术的飞行器全剖面控制方法 | |
Shen et al. | Prescribed performance dynamic surface control for trajectory tracking of quadrotor UAV with uncertainties and input constraints | |
CN111290421A (zh) | 一种考虑输入饱和的高超声速飞行器姿态控制方法 | |
CN111367182A (zh) | 考虑输入受限的高超声速飞行器抗干扰反步控制方法 | |
CN108873929B (zh) | 一种固定翼飞机自主着舰方法及系统 | |
CN109460050B (zh) | 一种针对变体无人机的复合分层抗干扰控制方法 | |
CN111506099B (zh) | 一种无人机高度智能控制系统及方法 | |
CN112578805B (zh) | 一种旋翼飞行器的姿态控制方法 | |
CN111045440B (zh) | 一种高超声速飞行器俯冲段快速滚转控制方法 | |
CN111290278B (zh) | 一种基于预测滑模的高超声速飞行器鲁棒姿态控制方法 | |
CN106802570B (zh) | 一种无人直升机位置跟踪的方法与装置 | |
CN112000127B (zh) | 一种基于反步法的飞行器横侧向联合控制方法 | |
CN113504721A (zh) | 基于bp-pid神经网络的弹载电动舵机舵偏角位置跟踪方法 | |
CN110347036B (zh) | 基于模糊滑模控制的无人机自主抗风智能控制方法 | |
CN114089780B (zh) | 一种面向城市空间的多旋翼无人机路径规划方法 | |
CN111007867A (zh) | 一种可预设调整时间的高超声速飞行器姿态控制设计方法 | |
CN116203840A (zh) | 可重复使用运载器自适应增益调度控制方法 | |
CN114637203A (zh) | 一种针对中高速、大机动无人机的飞行控制系统 | |
Qingqing et al. | A PID gain adjustment scheme based on reinforcement learning algorithm for a quadrotor | |
Ma et al. | Finite-time trajectory tracking control of quadrotor UAV via adaptive RBF neural network with lumped uncertainties | |
CN112904876B (zh) | 一种考虑电机饱和的高机动微型无人机控制分配方法 | |
CN113885358B (zh) | 一种混合构型固定翼无人机机动仿真控制律设计方法 | |
CN114167885B (zh) | 一种升力式飞行器多模式解析制导方法 | |
Abedini et al. | Robust trajectory-tracking for a Bi-copter Drone using IBKS and SPNN Adaptive Controller |
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 |