CN106970646B - 基于自适应积分反步的四旋翼飞行器控制方法 - Google Patents
基于自适应积分反步的四旋翼飞行器控制方法 Download PDFInfo
- Publication number
- CN106970646B CN106970646B CN201710370621.2A CN201710370621A CN106970646B CN 106970646 B CN106970646 B CN 106970646B CN 201710370621 A CN201710370621 A CN 201710370621A CN 106970646 B CN106970646 B CN 106970646B
- Authority
- CN
- China
- Prior art keywords
- control
- controller
- derivation
- backstepping
- order
- 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.)
- Expired - Fee Related
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/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
本发明公开了自适应积分反步的四旋翼飞行器控制方法,属于自动控制技术领域。本发明包括双闭环控制结构,外环为位移控制器,由高度控制器和水平位移控制器所组成,分别由z、y、x的期望值zd、yd、xd与其实际反馈值做差后,经过自适应积分反步控制算法求出控制高度和水平位移的输入项即U1,ux和uy,再进入内环即姿态控制器,由ux和uy反解算出俯仰和横滚两个姿态角的期望值φd、θd,与实际反馈值做差,而后经过积分反步控制算法,获得控制俯仰角和横滚角的输入项即U2,U3,控制航向角的输入项U4也如此。
Description
技术领域
本发明涉及基于自适应积分反步的四旋翼飞行器控制方法,属于自动控制技术领域。
背景技术
过去二十年中,无人机在世界各地的军民两用领域都得以扩大应用。无人机目前用于军事各个部门,从侦查,监测,情报收集到战场损害评估等。民用领域包括遥感,运输,勘探和科学研究等。由于航空领域多样化的使命,无人机发挥越来越重要的作用。
反步法(Backstepping)是以Lyapunov控制理论为基础,要求系统方程为严反馈形式,一种由前向后递推的设计方法。其主要优点是可以与自适应技术结合使用。自适应控制一般以不同程度的不确定性为研究对象,通过量测信号对被控对象的未知参数进行在线估计,从而实时改变控制器的输入。将自适应控制与反步法相结合,应用于飞行器的飞行控制上,比传统的反步法有了明显的抗干扰性,飞行更稳定,鲁棒性更强。积分反步法是在传统的反步法基础上添加了跟踪误差的积分项,以此来弥补稳态误差,用于控制飞行器稳定飞行,但在飞行器受到外界扰动时,表现稍差。
发明内容
为了克服上述的不足,本发明提出了将自适应控制与积分反步法相结合,应用到受外界环境干扰的飞行器的轨迹跟踪上,既可以减少稳态误差,又可以提高飞行器自身的飞行抗干扰性,大大增强了飞行器的鲁棒性。
本发明采取的技术方案如下:
基于自适应积分反步的四旋翼飞行器控制方法,包括双闭环控制结构,外环为位移控制器,由高度控制器和水平位移控制器所组成,分别由z、y、x的期望值zd、yd、xd与其实际反馈值做差后,经过本发明提出的自适应积分反步控制算法求出控制高度和水平位移的输入项即U1,ux和uy,再进入内环即姿态控制器,由ux和uy反解算出俯仰和横滚两个姿态角的期望值φd、θd,与实际反馈值做差,而后经过积分反步控制算法,获得控制俯仰角和横滚角的输入项即U2,U3,控制航向角的输入项U4也如此。
高度控制器的设计方法如下:
针对二阶系统:
首先,定义一个跟踪误差以及其积分项:
一般情况,阵风假定扰动在数值上是未知的和不可测量的,而且是时不变的时不变的,故
定义一个Lyapunov函数:
可以很明显看出V(K5,e5)≥0,即正定,对上式进行求导可得:
f1是虚拟控制量,令
其次,定义一个二阶的跟踪误差:
那么,
在这里,定义一个Lyapunov函数:
显然是正定的,同样求导可得:
系统稳定时可得:
水平位移控制器的设计方法如下:水平位移控制器分为X方向位移控制与Y方向位移控制,由于两者算法推导相似,故这里只给出Y方向位移控制方法推导:
假设二阶虚拟系统:
同高度Z方向,可以定义并推导得出式(25-32):
同样,定义一个Lyapunov函数:
这里的ε是一个关于e4的函数,对上式求导可得:
令
此时,
若
那么,
假设,下式成立:
ζ是一个包含K3,e3,e4三个变量的函数,那么,若
则
同理可以求出X方向上的控制项,即:
其中,
最后,通过反解模块就可将俯仰角和横滚角的期望值求出,即
其中,
ux=(cosφsinθcosψ+sinφsinψ),
uy=(cosφsinθcosψ-sinφsinψ),
姿态控制器的设计方法如下:内环的姿态控制中,我们采用基于积分型的反步控制,且由于对俯仰角、航向角和横滚角的算法推导近似,故只列写俯仰角θ的推导公式:
假设二阶虚拟系统:
同理可定义并推导得到公式(48-53):
在这里,定义一个Lyapunov函数:
显然是正定的,同样求导可得:
同理可知,该系统是稳定的,由上式可知,
同理可得:
其中:
最后通过式(1)反解并开方可得飞行器的四个电机的运转速度,即:
本发明有益效果:
本文提出的基于积分型的自适应反步的控制算法应用于MIMO且呈非线性强耦合的四旋翼无人机飞行控制系统中,不但能有效减小稳态误差,而且可以防止飞行器因外界较强的阵风环境干扰等不确定因素而偏移期望轨迹。通过与积分反步算法进行比较实验,充分证明系统收敛性好且稳定,稳态误差极小,控制效果较为理想,轨迹跟踪特性较强,具有较强的鲁棒性与抗阵风干扰性。后续工作即将本文的控制算法进行实物飞行试验,进一步测试算法在真实飞行过程中的优化性能。
附图说明
图1飞行器的速度。
图2飞行器的速度绝对误差。
图3飞行器的位置。
图4飞行器的位置绝对误差。
图5三维轨迹。
图6俯视轨迹。
图7飞行器的姿态角。
图8飞行器的姿态角绝对误差。
图9飞行器的控制输入。
图10飞行器电机转速。
图11阵风干扰估计的绝对误差。
具体实施方式
我们设定的期望轨迹如式(59),初始状态为:X=[012×1]。本文拟设定飞行器受到的外界阵风干扰为D=[Dx,Dy,Dy]T=[20,20,20]T,即三个方向上的干扰力均为20N的较强阵风。
从图1可以看出,uvw分别为飞行器机体坐标轴xyz三个方向上的速度,可以清晰地看出在外界环境即阵风的干扰下,采用自适应积分反步控制可以快速跟踪期望速度,而积分反步控制则反映出跟踪迟缓的问题。
图2将飞行器的三个方向速度uvw与期望速度进行做差并取绝对值,可以看出采用自适应积分反步控制算法要比只是积分反步算法的速度绝对误差值小很多,尤其是z方向上的速度w。
图3展示了飞行器的xyz三个方向上的位移,可以清楚的看出,采用自适应积分反步算法可以较快地跟踪期望位移,而积分反步法跟踪效果稍差。
图4同样对比了运用自适应积分反步算法和积分反步算法在xyz三个方向上的位移跟踪绝对误差,可以看出自适应积分反步算法可以快速地将跟踪误差降低到很小。
图5展示了飞行器跟踪轨迹的三维视图,立体地观看出飞行器采用自适应积分反步算法在轨迹跟踪任务上的优越性。
图6展示了飞行器进行轨迹跟踪任务的三维俯视图,可以看出飞行器采用自适应积分反步法进行轨迹跟踪,一开始就可以快速跟踪上期望轨迹,而不需要很长的过度时间,轨迹基本与期望轨迹吻合。
图7展示了飞行器在受到较强阵风干扰时的三个姿态角的变化示意图,从图中可以看出应用自适应积分反步算法来控制飞行器的姿态角,可以更快地跟踪期望姿态角,几乎吻合。
图8展示了飞行器在进行轨迹跟踪任务时,因受到持续阵风干扰,姿态角与期望姿态角有一定的绝对误差,但是应用自适应积分反步法控制的姿态角的绝对误差值稳定在一个极小的范围内。
图9展示了飞行器在运行自适应积分反步控制算法时进行轨迹跟踪任务的四个控制输入随时间变化的示意图。
图10展示的是飞行器在进行轨迹跟踪任务时的四个电机的转速。
图11展示了飞行器在未知强度的阵风干扰下,运用自适应积分反步控制算法对未知阵风干扰进行估计与实际阵风的绝对误差,且其数值非常之小。
Claims (1)
1.基于自适应积分反步的四旋翼飞行器控制方法,其特征在于:包括双闭环控制结构,外环为位移控制器,由高度控制器和水平位移控制器所组成,分别由z、y、x的期望值zd、yd、xd与其实际反馈值做差后,经过自适应积分反步控制算法求出控制高度和水平位移的输入项即U1,ux和uy,再进入内环即姿态控制器,由ux和uy反解算出俯仰和横滚两个姿态角的期望值φd、θd,与实际反馈值做差,而后经过积分反步控制算法,获得控制俯仰角和横滚角的输入项即U2,U3,控制航向角的输入项U4也如此;
高度控制器的设计方法如下:
针对二阶系统:
首先,定义一个跟踪误差以及其积分项:
一般情况,阵风假定扰动在数值上是未知的和不可测量的,而且是时不变的时不变的,故
定义一个Lyapunov函数:
可以很明显看出V(K5,e5)≥0,即正定,对上式进行求导可得:
f1是虚拟控制量,令
其次,定义一个二阶的跟踪误差:
那么,
在这里,定义一个Lyapunov函数:
显然是正定的,同样求导可得:
系统稳定时可得:
水平位移控制器的设计方法如下:水平位移控制器分为X方向位移控制与Y方向位移控制,由于两者算法推导相似,故这里只给出Y方向位移控制方法推导:
假设二阶虚拟系统:
同高度Z方向,可以定义并推导得出式(25-32):
同样,定义一个Lyapunov函数:
这里的ε是一个关于e4的函数,对上式求导可得:
令
此时,
若
那么,
假设,下式成立:
ζ是一个包含K3,e3,e4三个变量的函数,那么,若
同理可以求出X方向上的控制项,即:
其中,
最后,通过反解模块就可将俯仰角和横滚角的期望值求出,即
其中,
ux=(cosφsinθcosψ+sinφsinψ),
uy=(cosφsinθcosψ-sinφsinψ),
姿态控制器的设计方法如下:内环的姿态控制中,我们采用基于积分型的反步控制,且由于对俯仰角、航向角和横滚角的算法推导近似,故只列写俯仰角θ的推导公式:
假设二阶虚拟系统:
同理可定义并推导得到公式(48-53):
在这里,定义一个Lyapunov函数:
显然是正定的,同样求导可得:
同理可知,该系统是稳定的,由上式可知,
同理可得:
其中:
最后通过式(1)反解并开方可得飞行器的四个电机的运转速度,即:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710370621.2A CN106970646B (zh) | 2017-05-23 | 2017-05-23 | 基于自适应积分反步的四旋翼飞行器控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710370621.2A CN106970646B (zh) | 2017-05-23 | 2017-05-23 | 基于自适应积分反步的四旋翼飞行器控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106970646A CN106970646A (zh) | 2017-07-21 |
CN106970646B true CN106970646B (zh) | 2020-12-01 |
Family
ID=59326298
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710370621.2A Expired - Fee Related CN106970646B (zh) | 2017-05-23 | 2017-05-23 | 基于自适应积分反步的四旋翼飞行器控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106970646B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107994939A (zh) * | 2017-12-04 | 2018-05-04 | 中国人民解放军陆军工程大学 | 一种基于无人机动态中继的自适应微波通信数据链 |
CN107942672B (zh) * | 2017-12-06 | 2020-02-21 | 浙江工业大学 | 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 |
CN108536166A (zh) * | 2018-04-18 | 2018-09-14 | 西安科技大学 | 一种多系统小型无人直升机的稳定性设计方法 |
CN108445766B (zh) * | 2018-05-15 | 2020-02-21 | 山东大学 | 基于rpd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 |
CN111026160B (zh) * | 2019-12-26 | 2020-12-08 | 华中科技大学 | 一种四旋翼无人机轨迹跟踪控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104102128A (zh) * | 2013-04-09 | 2014-10-15 | 中国人民解放军第二炮兵工程大学 | 一种适用于小型无人飞行器的抗干扰姿态控制方法 |
CN104932512A (zh) * | 2015-06-24 | 2015-09-23 | 北京科技大学 | 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102439646B (zh) * | 2009-03-26 | 2014-11-26 | 俄亥俄州立大学 | 轨迹跟踪飞行控制器 |
-
2017
- 2017-05-23 CN CN201710370621.2A patent/CN106970646B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104102128A (zh) * | 2013-04-09 | 2014-10-15 | 中国人民解放军第二炮兵工程大学 | 一种适用于小型无人飞行器的抗干扰姿态控制方法 |
CN104932512A (zh) * | 2015-06-24 | 2015-09-23 | 北京科技大学 | 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法 |
Non-Patent Citations (4)
Title |
---|
Adaptive Backstepping Control of an Indoor Micro-Quadrotor;Zheng Fang,etc;《Research Journal of Applied Sciences, Engineering and Technology》;20121231;第4216-4226页 * |
Adaptive Integral Backstepping Control of a Micro-Quadrotor;Zheng Fang,etc;《The 2 nd international conference on intelligent control and information processing 》;20141231;第910-915页 * |
基于滤波反步法的欠驱动AUV 三维路径跟踪控制;王宏健,等;《自动化学报》;20150331;第41卷(第3期);第631-645页 * |
基于自适应反步跟踪的反馈调整稳定性控制算法;林统喜,等;《智能计算机与应用》;20160430;第6卷(第2期);第5-8页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106970646A (zh) | 2017-07-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106970646B (zh) | 基于自适应积分反步的四旋翼飞行器控制方法 | |
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
Zheng et al. | Error-constrained LOS path following of a surface vessel with actuator saturation and faults | |
CN105159304B (zh) | 接近并跟踪空间非合作目标的有限时间容错控制方法 | |
CN107562068B (zh) | 一种四旋翼飞行器姿态的动态面输出调节控制方法 | |
CN107491081B (zh) | 一种抗干扰四旋翼无人机姿态控制方法 | |
CN107357166B (zh) | 小型无人直升机的无模型自适应鲁棒控制方法 | |
CN109917800B (zh) | 无人机控制方法、装置、计算机设备及存储介质 | |
CN103576693A (zh) | 基于二阶滤波器的水下机器人三维路径跟踪控制方法 | |
CN108121354A (zh) | 基于指令滤波反步法的四旋翼无人机稳定跟踪控制方法 | |
CN110162067B (zh) | 一种无人机非奇异自适应非光滑姿态跟踪控制方法 | |
Lin et al. | Finite-time formation control of unmanned vehicles using nonlinear sliding mode control with disturbances | |
CN110825122A (zh) | 一种四旋翼无人机圆形轨迹主动抗干扰跟踪控制方法 | |
CN114047773A (zh) | 一种基于扩张状态观测器的水下集矿机器人反步滑模自适应姿态控制方法 | |
CN108459611B (zh) | 一种近空间飞行器的姿态跟踪控制方法 | |
Qi et al. | Three-dimensional formation control based on filter backstepping method for multiple underactuated underwater vehicles | |
Meng et al. | Nonlinear sliding mode formation control for underactuated surface vessels | |
CN113821028B (zh) | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 | |
CN111435253A (zh) | 四旋翼飞行器有界输出控制 | |
Shine et al. | Active disturbance rejection control for AUV pitch angle | |
CN114115335A (zh) | 一种基于跟踪微分器的多四旋翼无人机安全编队控制方法 | |
Bai et al. | Trajectory tracking control of hovercraft based on Shutting-Backstepping Sliding Model | |
Suoliang et al. | Finite-time robust control for inertially stabilized platform based on terminal sliding mode | |
CN110673616A (zh) | 基于自适应滑模的固定翼无人机有限时间容错控制方法 | |
Ma et al. | Finite-time trajectory tracking control of quadrotor UAV via adaptive RBF neural network with lumped uncertainties |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20201201 Termination date: 20210523 |
|
CF01 | Termination of patent right due to non-payment of annual fee |