基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法技术

技术编号:19008643 阅读:69 留言:0更新日期:2018-09-22 08:36
一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,针对四旋翼飞行器的动力学系统,选择一种非对称时变对数正切复合型约束李雅普诺夫函数,设计一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法。非对称时变对数正切复合型约束李雅普诺夫函数的设计是为了保证系统的输出能够限制在一定的范围内,避免过大的超调,同时还能减少到达时间。从而改善四旋翼飞行器系统的动态响应性能。本发明专利技术提供一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,使系统具有较好的动态响应过程。

Output Restricted Control Method for Quad-Rotor Aircraft Based on Asymmetric Time-Varying Logarithmic Tangent Composite Constrained Lyapunov Function

An output-constrained control method for quad-rotor aircraft based on asymmetric time-varying logarithmic tangent complex constrained Lyapunov function is proposed. For the dynamic system of quad-rotor aircraft, an asymmetric time-varying logarithmic tangent complex constrained Lyapunov function is selected and an asymmetric time-varying logarithmic tangent compound is designed. Constrained output control method for four rotor aircraft with Lyapunov function constraint. The Lyapunov function with asymmetric time-varying logarithmic tangent constraints is designed to ensure that the output of the system can be limited to a certain range, avoid overshoot and reduce the arrival time. Thereby improving the dynamic response performance of the four rotor aircraft system. The invention provides an output limited control method for a Four-rotor aircraft based on an asymmetrical time-varying logarithmic tangent constrained Lyapunov function, so that the system has a better dynamic response process.

【技术实现步骤摘要】
基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法
本专利技术涉及一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,使四旋翼飞行器系统有较好的动态响应过程。
技术介绍
四旋翼飞行器作为旋翼式飞行器的一种,以其体积小、机动性能好、设计简单、制造成本低廉等优点,吸引了国内外大学、研究机构、公司的广泛关注。然而,由于四旋翼飞行器体积小且重量轻,飞行中易受到外部干扰,如何实现对四旋翼飞行器的高性能运动控制已经成为一个热点问题。针对四旋翼飞行器的控制问题,存在很多控制方法,例如PID控制、自抗扰控制、滑模控制、反步控制等。其中反步控制已经广泛应用于非线性系统,其优点包括响应速度快、实施方便、对系统不确定和外部干扰的鲁棒性等。传统的反步控制,只是考虑了四旋翼飞行器的稳态性能,并没有过多地关注其瞬态响应性能。因此,传统的反步控制方法使得四旋翼飞行器系统在实际情况中的应用有很大阻碍。为解决这一问题,基于约束李雅普诺夫函数的反步控制方法被提出,这种方法在实际情况中能够有效地改善四旋翼飞行器系统的瞬态性能。
技术实现思路
为了改善四旋翼飞行器系统瞬态性能,本专利技术提供了一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,减少了超调量和超调时间,使四旋翼飞行器系统具有一个良好的动态响应性能。为了解决上述技术问题提出的技术方案如下:一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,包括以下步骤:步骤1,建立四旋翼飞行器系统的动态模型,设定系统的初始值、采样时间以及控制参数,过程如下:1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵T:其中,φ,θ,ψ分别是四旋翼飞行器的翻滚角、俯仰角、偏航角,表示飞行器依次绕惯性坐标系的各坐标轴旋转的角度;1.2四旋翼飞行器平动过程中的动态模型如下:其中,x,y,z分别表示四旋翼飞行器在惯性坐标系下的三个位置,Uf表示四旋翼飞行器的输入力矩,m为四旋翼飞行器的质量,g表示重力加速度;将式(1)代入式(2)得:1.3四旋翼飞行器转动过程中的动态模型为:其中,τx,τy,τz分别代表机体坐标系上各个轴的力矩分量,Ixx,Iyy,Izz分别表示机体坐标系下的各个轴的转动惯量的分量,×表示叉乘,ωp表示翻滚角速度,ωq表示俯仰角速度,ωr表示偏航角速度,表示翻滚角加速度,表示俯仰角加速度,表示偏航角加速度;考虑到飞行器处于低速飞行或者悬停状态,认为因此式(4)改写为:联立式(3)和式(5),得到四旋翼飞行器的动力学模型为:其中,ux=cosφsinθcosψ+sinφsinψ,uy=cosφsinθsinψ-sibφcosψ;1.4根据式(6),定义φ,θ的期望值分别为:其中,φd为φ的期望信号值,θd为θ期望信号值,arcsin为反正弦函数;步骤2,在每一个采样时刻,计算位置跟踪误差及其一阶导数;计算姿态角跟踪误差及其一阶导数;设计位置和姿态角控制器,过程如下:2.1定义z跟踪误差及其一阶导数:其中,zd表示z的期望信号;2.2定义q1:2.3设计约束李雅普诺夫函数V11:其中,Ka1,Kb1为时变参数:2.4求解式(10)一阶导数,得:其中,α1为虚拟控制量,其表达式为:其中,k11,β1为正常数;将式(13)代入式(12),得:2.5设计李雅普诺夫函数V12为:求解式(15)一阶导数并联立式(14),得:其中将式(17)和式(6)代入式(16),得:2.6设计Uf:其中,k12为正常数;2.7定义x,y跟踪误差分别为e2,e3,则有:其中,xd,yd分别表示x,y的期望信号;2.8定义q2,q3:2.9设计约束李雅普诺夫函数V21,V31:其中,Ka2,Kb2,Ka3,Kb3为时变参数:2.10求解式(23)一阶导数,得:其中,α2,α3为虚拟控制量,其表达式为:其中,k21,k31,β2,β3为正常数;将式(26)代入式(25),得:2.11设计李雅普诺夫函数V22,V32为:求解式(28)的一阶导数并联立式(27)得:其中将式(30)和式(6)代入式(29),得:2.12设计ux,uy:其中,k22,k32为正常数;2.13定义姿态角跟踪误差及其一阶导数:其中,j=4,5,6,x4=φ,x5=θ,x6=ψ,x4d表示φ的期望值,x5d表示θ的期望值,x6d表示ψ的期望值,e4表示φ的跟踪误差,e5表示θ的跟踪误差,e6表示ψ的跟踪误差;2.14定义qj:2.15设计约束李雅普诺夫函数:其中,Kaj,Kbj为时变参数:2.16求解式(35)一阶导数,得:其中,αj为虚拟控制量,其表达式为:其中,kj1,βj为正常数;将式(38)代入式(37),得:2.17设计李雅普诺夫函数Vj2为:求解式(40)的一阶导数并联立式(39),得:其中将式(42)和式(6)代入式(41),得:2.18通过式(43)设计τx,τy,τz:其中,k42,k52,k62为正常数;步骤3,验证四旋翼飞行器系统的稳定性,过程如下:3.1将式(19)代入式(18),得:3.2将式(32)代入式(31),得:3.3将式(44)代入式(43),得3.4通过(45),(46),(47)知四旋翼飞行器系统是稳定的。本专利技术基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,改善了系统的瞬态性能,减少了超调量和到达时间。本专利技术的技术构思为:针对四旋翼飞行器的动力学系统,设计一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法。非对称时变对数正切复合型约束李雅普诺夫函数的设计是为了保证系统的输出能够限制在一定的范围内,避免过大的超调,同时还能减少到达时间。从而改善四旋翼飞行器系统的动态响应性能。本专利技术优点为:降低超调量,减少到达时间,改善瞬态性能。附图说明图1为本专利技术的位置跟踪效果示意图。图2为本专利技术的姿态角跟踪效果示意图。图3为本专利技术的位置控制器输入示意图。图4为本专利技术的姿态角控制器输入示意图。图5为本专利技术的控制流程示意图。具体实施方式下面结合附图对本专利技术做进一步说明。参照图1-图5,一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,包括以下步骤:步骤1,建立四旋翼飞行器系统的动态模型,设定系统的初始值、采样时间以及控制参数,过程如下:1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵T:其中,φ,θ,ψ分别是四旋翼飞行器的翻滚角、俯仰角、偏航角,表示飞行器依次绕惯性坐标系的各坐标轴旋转的角度;1.2四旋翼飞行器平动过程中的动态模型如下:其中,x,y,z分别表示四旋翼飞行器在惯性坐标系下的三个位置,Uf表示四旋翼飞行器的输入力矩,m为四旋翼飞行器的质量,g表示重力加速度;将式(1)代入式(2)得:1.3四旋翼飞行器转动过程中的动态模型为:其中,τx,τy,τz分别代表机体坐标系上各个轴的力矩分量,Ixx,Iyy,Izz分别表示机体坐标系下的各个轴的转动惯量的分量,×表示叉乘,ωp表示翻滚角速度,ωq表示俯仰角速度,ωr表示偏航角速度,表示翻滚角加速度,表示俯仰角加速度,表示偏航角本文档来自技高网...
基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法

【技术保护点】
1.一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,其特征在于,所述方法包括以下步骤:步骤1,建立四旋翼飞行器系统的动态模型,设定系统的初始值、采样时间以及控制参数,过程如下:1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵T:

【技术特征摘要】
1.一种基于非对称时变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法,其特征在于,所述方法包括以下步骤:步骤1,建立四旋翼飞行器系统的动态模型,设定系统的初始值、采样时间以及控制参数,过程如下:1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵T:其中,φ,θ,ψ分别是四旋翼飞行器的翻滚角、俯仰角、偏航角,表示飞行器依次绕惯性坐标系的各坐标轴旋转的角度;1.2四旋翼飞行器平动过程中的动态模型如下:其中,x,y,z分别表示四旋翼飞行器在惯性坐标系下的三个位置,Uf表示四旋翼飞行器的输入力矩,m为四旋翼飞行器的质量,g表示重力加速度;将式(1)代入式(2)得:1.3四旋翼飞行器转动过程中的动态模型为:其中,τx,τy,τz分别代表机体坐标系上各个轴的力矩分量,Ixx,Iyy,Izz分别表示机体坐标系下的各个轴的转动惯量的分量,×表示叉乘,ωp表示翻滚角速度,ωq表示俯仰角速度,ωr表示偏航角速度,表示翻滚角加速度,表示俯仰角加速度,表示偏航角加速度;考虑到飞行器处于低速飞行或者悬停状态,认为因此式(4)改写为:联立式(3)和式(5),得到四旋翼飞行器的动力学模型为:其中,ux=cosφsinθcosψ+sinφsinψ,uy=cosφsinθsinψ-sinφcosψ;1.4根据式(6),定义φ,θ的期望值分别为:其中,φd为φ的期望信号值,θd为θ期望信号值,arcsin为反正弦函数;步骤2,在每一个采样时刻,计算位置跟踪误差及其一阶导数;计算姿态角跟踪误差及其一阶导数;设计位置和姿态角控制器,过程如下:2.1定义z跟踪误差及其一阶导数:其中,zd表示z的期望信号;2.2定义q1:2.3设计约束李雅普诺夫函数V11:其中,Ka1,Kb1为时变参数:2.4求解式(10)一阶导数,得:其中,α1为虚拟控制量,其表达式为:其中,k11,β1为正常数;将...

【专利技术属性】
技术研发人员:陈强胡忠君施卉辉胡轶吴春
申请(专利权)人:浙江工业大学
类型:发明
国别省市:浙江,33

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1