专利汇可以提供一种飞行器对数正切全状态受限控制方法专利检索,专利查询,专利分析的服务。并且一种 飞行器 对数正切全状态受限控制方法,针对四旋翼飞行器的动 力 学系统,选择一种非对称时不变对数正切复合型约束李雅普诺夫函数,设计一种基于非对称时不变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器全状态受限控制方法。非对称时不变对数正切复合型约束李雅普诺夫函数的设计是为了保证系统的状态和输出能够限制在一定的范围内,避免过大的超调,同时还能减少到达时间。从而改善四旋翼飞行器系统的动态响应性能。本 发明 提供一种飞行器对数正切全状态受限控制方法,使系统具有较好的动态响应过程。,下面是一种飞行器对数正切全状态受限控制方法专利的具体信息内容。
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定义q11:
2.3设计约束李雅普诺夫函数V11:
其中,Ka1,Kb1为正常数:
其中,|e1|max为|e1|的最大值;
2.4求解式(10)一阶导数,得:
其中, α1为虚拟控制量,
其表达式为:
其中,k11为正常数;
将式(13)代入式(12),得:
2.5定义q12:
2.6设计约束李雅普诺夫函数V12:
其中,Kd1,Kc1为正常数:
其中,|e1|max为|e1|的最大值;
求解式(16)一阶导数,得:
其中, 表达式为
将式(19)和式(6)代入式(18),得:
2.7设计Uf:
其中,k12为正常数;
2.8定义x,y跟踪误差分别为e2,e3,则有:
其中,xd,yd分别表示x,y的期望信号;
2.9定义q21,q31:
2.10设计约束李雅普诺夫函数V21,V31:
其中,Ka2,Kb2,Ka3,Kb3为正常数:
其中,|e2|max为|e2|的最大值,|e3|max为|e3|的最大值;
2.11求解式(25)一阶导数,得:
其中,
α2,α3为虚拟控制量,其表达式为:
其中,k21,k31为正常数;
将式(28)代入式(27),得:
2.12定义q22,q32:
2.13设计李雅普诺夫函数V22,V32:
其中,Kc2,Kd2,Kc3,Kd3为正常数:
其中,|s2|max为|s2|的最大值,|s3|max为|s3|的最大值;
求解式(32)一阶导数,得:
其中,
表达式如下
将式(35)和式(6)代入式(34),得:
2.14设计ux,uy∶
其中,k22,k32为正常数;
2.15定义姿态角跟踪误差及其一阶导数:
其中,j=4,5,6,x4=φ,x5=θ,x6=ψ,x4d表示φ的期望值,x5d表示θ的期望值,x6d表示ψ的期望值,e4表示φ的跟踪误差,e5表示θ的跟踪误差,e6表示ψ的跟踪误差;
2.16定义qj1:
2.17设计约束李雅普诺夫函数Vj1:
其中,Kaj,Kbj为正常数:
其中,|ej|max为|ej|的最大值;
2.18求解式(40)一阶导数,得:
其中, αj为虚拟控制量,其
表达式为:
其中,kj1为正常数;
将式(43)代入式(42),得:
2.19定义qj2:
2.20设计李雅普诺夫函数Vj2:
其中,Kdj,Kcj为正常数,满足Kdj<sj<-Kcj;
求解式(46)一阶导数,得:
其中, 表达式为
将式(48)和式(6)代入式(47),得:
2.21通过式(49)设计τx,τy,τz:
其中,k42,k52,k62为正常数;
步骤3,验证四旋翼飞行器系统的稳定性,过程如下:
3.1将式(21)代入式(20),得:
3.2将式(37)代入式(36),得:
3.3将式(50)代入式(49),得
3.4通过(51),(52),(53)知四旋翼飞行器系统是稳定的。
标题 | 发布/更新时间 | 阅读量 |
---|---|---|
一种舵翼可折叠的微型飞行器 | 2021-02-27 | 1 |
一种飞行器对数正切全状态受限控制方法 | 2023-01-29 | 1 |
多涵道飞行器 | 2020-06-28 | 2 |
一种盒式垂起固定翼飞行器 | 2021-07-20 | 4 |
一种飞行器孤岛降落复飞决策方法 | 2021-09-11 | 1 |
一种螺旋桨装置及无人飞行器 | 2022-02-03 | 3 |
一种飞行器的控制方法及控制终端 | 2021-09-03 | 4 |
多旋翼飞行器及多旋翼飞行器的控制方法 | 2020-11-27 | 1 |
一种云台驱动模组及飞行器 | 2021-06-16 | 2 |
云台及飞行器 | 2020-12-16 | 3 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。