一种四旋翼飞行器输出受限控制方法，针对四旋翼飞行器的动力学系统，选择一种对称时不变正切型约束李雅普诺夫函数，设计一种基于对称时不变正切型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法。对称时不变正切型约束李雅普诺夫函数的设计是为了保证系统的输出能够限制在一定的范围内，避免过大的超调，同时还能减少到达时间。从而改善四旋翼飞行器系统的动态响应性能。本发明专利技术提供一种基于对称时不变正切型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法，使系统具有较好的动态响应过程。
【技术实现步骤摘要】
一种四旋翼飞行器输出受限控制方法
本专利技术涉及一种四旋翼飞行器输出受限控制方法，使四旋翼飞行器系统有较好的动态响应过程。
技术介绍
四旋翼飞行器作为旋翼式飞行器的一种,以其体积小、机动性能好、设计简单、制造成本低廉等优点,吸引了国内外大学、研究机构、公司的广泛关注。然而，由于四旋翼飞行器体积小且重量轻，飞行中易受到外部干扰，如何实现对四旋翼飞行器的高性能运动控制已经成为一个热点问题。针对四旋翼飞行器的控制问题，存在很多控制方法，例如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ψ-sinφcosψ；1.4根据式(6)，定义φ,θ的期望值为：其中，φd为φ的期望信号值，θd为θ期望信号值，arcsin为反正弦函数；步骤2，在每一个采样时刻，计算位置跟踪误差及其一阶导数；计算姿态角跟踪误差及其一阶导数；设计位置和姿态角控制器，过程如下：2.1定义z跟踪误差及其一阶导数：其中zd表示z的期望信号；2.2设计约束李雅普诺夫函数并求解其一阶导数：其中，Kb1为e1的边界，满足Kb1>|e1|max，|e1|max为|e1|的最大值,α1为虚拟控制量，其表达式为:其中，k11为正常数；将式(10)代入式(9)，得：2.3设计李雅普诺夫函数V12为：求解式(12)的一阶导数，得：其中将式(14)和式(6)代入式(13)，得：2.4设计Uf：其中，k12为正常数；2.5定义x,y跟踪误差分别为e2,e3,则有：e2＝x-xd,e3＝y-yd,其中，xd,yd分别表示x,y的期望信号；2.6设计约束李雅普诺夫函数分别求解其一阶导数，得：其中，Kb2为e2的边界，满足Kb2>|e2|max，|e2|max为|e2|的最大值；Kb3为e3的边界，满足Kb3>|e3|max，|e3|max为|e3|的最大值；α2,α3为虚拟控制量，其表达式为：其中，k21,k31为正常数；将式(19)代入式(18)，得：2.7设计李雅普诺夫函数V22,V32求解式(21)的一阶导数，得：其中将式(23)，(6)代入式(22)，分别得：2.8通过式(24)，(25)分别设计ux,uy：其中，k22,k32为正常数；2.9定义姿态角跟踪误差及其一阶导数：其中，j＝4,5,6，x4＝φ,x5＝θ,x6＝ψ，x4d表示φ的期望值，x5d表示θ的期望值，x6d表示ψ的期望值，e4表示φ的跟踪误差，e5表示θ的跟踪误差，e6表示ψ的跟踪误差；2.10设计约束李雅普诺夫函数并求解其一阶导数：其中，kj为正常数，Kbj为ej的边界，满足Kbj>|ej|max，|ej|max为|ej|的最大值；αj为姿态角的虚拟控制量，其表达式为:其中，kj1为正常数；将式(29)代入式(28)，得：2.11设计约束李雅普诺夫函数：求解式(31)的一阶导数，得：其中将式(33)和式(6)代入式(32)，分别得：2.12通过式(34)，(35)，(36)分别设计τx,τy,τz：其中，k42,k52,k62为正常数；步骤3，验证四旋翼飞行器系统的稳定性，过程如下：3.1将式(16)代入式(15)，得：3.2将式(26)代入式(24)、(25)，得：3.3把式(37)代入式(34)、(35)、(36)，得3.4通过(38)，(39)，(40)知四旋翼飞行器系统是稳定的。本专利技术基于对称时不变正切型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法，改善了系统的瞬态性能，减少了超调量和到达时间。本专利技术的技术构思为：针对四旋翼飞行器的动力学系统，设计一种基于对称时不变正切型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法。对称时不变正切型约束李雅普诺夫函数的设计是为了保证系统的输出能够限制在一定的范围内，避免过大的超调，同时还能减少到达时间。从而改善四旋翼飞行器系统的动态响应性能。本专利技术的有益效果为：降低超调量，减少到达时间，改善瞬态性能。附图说明图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：
【技术特征摘要】
2018.02.11 CN 20181014224561.一种四旋翼飞行器输出受限控制方法，其特征在于，包括以下步骤：步骤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设计约束李雅普诺夫函数并求解其一阶导数：其中，Kb1为e1的边界，满足Kb1＞|e1|max，|e1|max为|e1|的最大值，α1为虚拟控制量，其表达式为：其中，k11为正常数；将式(10)代入式(9)...
【专利技术属性】
技术研发人员：陈强，胡忠君，胡轶，吴春，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江,33
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。