首页 / 专利库 / 飞机类型 / 飞行器 / 一种飞行器对数正切全状态受限控制方法

一种飞行器对数正切全状态受限控制方法

阅读:1发布:2023-01-29

专利汇可以提供一种飞行器对数正切全状态受限控制方法专利检索,专利查询,专利分析的服务。并且一种 飞行器 对数正切全状态受限控制方法,针对四旋翼飞行器的动 力 学系统,选择一种非对称时不变对数正切复合型约束李雅普诺夫函数,设计一种基于非对称时不变对数正切复合型约束李雅普诺夫函数的四旋翼飞行器全状态受限控制方法。非对称时不变对数正切复合型约束李雅普诺夫函数的设计是为了保证系统的状态和输出能够限制在一定的范围内,避免过大的超调,同时还能减少到达时间。从而改善四旋翼飞行器系统的动态响应性能。本 发明 提供一种飞行器对数正切全状态受限控制方法,使系统具有较好的动态响应过程。,下面是一种飞行器对数正切全状态受限控制方法专利的具体信息内容。

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)知四旋翼飞行器系统是稳定的。

说明书全文

一种飞行器对数正切全状态受限控制方法

技术领域

[0001] 本发明涉及一种飞行器对数正切全状态受限控制方法,使四旋翼飞行器系统有较好的动态响应过程。

背景技术

[0002] 四旋翼飞行器作为旋翼式飞行器的一种,以其体积小、机动性能好、设计简单、制造成本低廉等优点,吸引了国内外大学、研究机构、公司的广泛关注。然而,由于四旋翼飞行器体积小且重量轻,飞行中易受到外部干扰,如何实现对四旋翼飞行器的高性能运动控制已经成为一个热点问题。针对四旋翼飞行器的控制问题,存在很多控制方法,例如PID控制、自抗扰控制、滑模控制、反步控制等。
[0003] 其中反步控制已经广泛应用于非线性系统,其优点包括响应速度快、实施方便、对系统不确定和外部干扰的鲁棒性等。传统的反步控制,只是考虑了四旋翼飞行器的稳态性能,并没有过多地关注其瞬态响应性能。因此,传统的反步控制方法使得四旋翼飞行器系统在实际情况中的应用有很大阻碍。为解决这一问题,基于约束李雅普诺夫函数的反步控制方法被提出,这种方法在实际情况中能够有效地改善四旋翼飞行器系统的瞬态性能。

发明内容

[0004] 为了克服现有四旋翼飞行器系统的瞬态性能较差的不足,本发明提供了一种飞行器对数正切全状态受限控制方法,减少了超调量和超调时间,使四旋翼飞行器系统具有一个良好的动态响应性能。
[0005] 为了解决上述技术问题提出的技术方案如下:
[0006] 一种飞行器对数正切全状态受限控制方法,包括以下步骤:
[0007] 步骤1,建立四旋翼飞行器系统的动态模型,设定系统的初始值、采样时间以及控制参数,过程如下:
[0008] 1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵T:
[0009]
[0010] 其中,φ,θ,ψ分别是四旋翼飞行器的翻滚俯仰角、偏航角,表示飞行器依次绕惯性坐标系的各坐标轴旋转的角度;
[0011] 1.2四旋翼飞行器平动过程中的动态模型如下:
[0012]
[0013] 其中,x,y,z分别表示四旋翼飞行器在惯性坐标系下的三个位置,Uf表示四旋翼飞行器的输入矩,m为四旋翼飞行器的质量,g表示重力加速度;
[0014] 将式(1)代入式(2)得:
[0015]
[0016] 1.3四旋翼飞行器转动过程中的动态模型为:
[0017]
[0018] 其中,τx,τy,τz分别代表机体坐标系上各个轴的力矩分量,Ixx,Iyy,Izz分别表示机体坐标系下的各个轴的转动惯量的分量,×表示叉乘,ωp表示翻滚角速度,ωq表示俯仰角速度,ωr表示偏航角速度, 表示翻滚角加速度, 表示俯仰角加速度, 表示偏航角加速度;
[0019] 考虑到飞行器处于低速飞行或者悬停状态,认为因此式(4)改写为:
[0020]
[0021] 联立式(3)和式(5),得到四旋翼飞行器的动力学模型为:
[0022]
[0023] 其中,ux=cosφsinθcosψ+sinφsinψ,uy=cosφsinθsinψ-sinφcosψ;
[0024] 1.4根据式(6),定义φ,θ的期望值分别为:
[0025]
[0026] 其中,φd为φ的期望信号值,θd为θ期望信号值,arcsin为反正弦函数;
[0027] 步骤2,在每一个采样时刻,计算位置跟踪误差及其一阶导数;计算姿态角跟踪误差及其一阶导数;设计位置和姿态角控制器,过程如下:
[0028] 2.1定义z跟踪误差及其一阶导数:
[0029]
[0030] 其中,zd表示z的期望信号;
[0031] 2.2定义q11:
[0032]
[0033] 2.3设计约束李雅普诺夫函数V11:
[0034]
[0035] 其中,Ka1,Kb1为正常数:
[0036]
[0037] 其中,|e1|max为|e1|的最大值;
[0038] 2.4求解式(10)一阶导数,得:
[0039]
[0040] 其中, α1为虚拟控制量,其表达式为:
[0041]
[0042] 其中,k11为正常数;
[0043] 将式(13)代入式(12),得:
[0044]
[0045] 2.5定义q12:
[0046]
[0047] 2.6设计约束李雅普诺夫函数V12:
[0048]
[0049] 其中,Kd1,Kc1为正常数:
[0050]
[0051] 其中,|e1|max为|e1|的最大值;
[0052] 求解式(16)一阶导数,得:
[0053]
[0054] 其中, 表达式为
[0055]
[0056] 将式(19)和式(6)代入式(18),得:
[0057]
[0058] 2.7设计Uf:
[0059]
[0060] 其中,k12为正常数;
[0061] 2.8定义x,y跟踪误差分别为e2,e3,则有:
[0062]
[0063] 其中,xd,yd分别表示x,y的期望信号;
[0064] 2.9定义q21,q31:
[0065]
[0066]
[0067] 2.10设计约束李雅普诺夫函数V21,V31:
[0068]
[0069] 其中,Ka2,Kb2,Ka3,Kb3为正常数:
[0070]
[0071] 其中,|e2|max为|e2|的最大值,|e3|max为|e3|的最大值;
[0072] 2.11求解式(25)一阶导数,得:
[0073]
[0074] 其中,α2,α3为虚拟控制量,其表达式为:
[0075]
[0076] 其中,k21,k31为正常数;
[0077] 将式(28)代入式(27),得:
[0078]
[0079] 2.12定义q22,q32:
[0080]
[0081]
[0082] 2.13设计李雅普诺夫函数V22,V32:
[0083]
[0084] 其中,Kc2,Kd2,Kc3,Kd3为正常数:
[0085]
[0086] 其中,|s2|max为|s2|的最大值,|s3|max为|s3|的最大值;
[0087] 求解式(32)一阶导数,得:
[0088]
[0089] 其 中 ,表达式如下
[0090]
[0091] 将式(35)和式(6)代入式(34),得:
[0092]
[0093] 2.14设计ux,uy:
[0094]
[0095] 其中,k22,k32为正常数;
[0096] 2.15定义姿态角跟踪误差及其一阶导数:
[0097]
[0098] 其中,j=4,5,6,x4=φ,x5=θ,x6=ψ,x4d表示φ的期望值,x5d表示θ的期望值,x6d表示ψ的期望值,e4表示φ的跟踪误差,e5表示θ的跟踪误差,e6表示ψ的跟踪误差;
[0099] 2.16定义qj1:
[0100]
[0101] 2.17设计约束李雅普诺夫函数Vj1:
[0102]
[0103] 其中,Kaj,Kbj为正常数:
[0104]
[0105] 其中,|ej|max为|ej|的最大值;
[0106] 2.18求解式(40)一阶导数,得:
[0107]
[0108] 其中, αj为虚拟控制量,其表达式为:
[0109]
[0110] 其中,kj1为正常数;
[0111] 将式(43)代入式(42),得:
[0112]
[0113] 2.19定义qj2:
[0114]
[0115] 2.20设计李雅普诺夫函数Vj2:
[0116]
[0117] 其中,Kdj,Kcj为正常数,满足Kdj
[0118] 求解式(46)一阶导数,得:
[0119]
[0120] 其中, 表达式为
[0121]
[0122] 将式(48)和式(6)代入式(47),得:
[0123]
[0124] 2.21通过式(49)设计τx,τy,τz:
[0125]
[0126] 其中,k42,k52,k62为正常数;
[0127] 步骤3,验证四旋翼飞行器系统的稳定性,过程如下:
[0128] 3.1将式(21)代入式(20),得:
[0129]
[0130] 3.2将式(37)代入式(36),得:
[0131]
[0132] 3.3将式(50)代入式(49),得
[0133]
[0134] 3.4通过(51),(52),(53)知四旋翼飞行器系统是稳定的。
[0135] 本发明提供一种飞行器对数正切全状态受限控制方法,改善了系统的瞬态性能,减少了超调量和到达时间。
[0136] 本发明的技术构思为:针对四旋翼飞行器的动力学系统,设计一种飞行器对数正切全状态受限控制方法。非对称时不变对数正切复合型约束李雅普诺夫函数的设计是为了保证系统的状态和输出能够限制在一定的范围内,避免过大的超调,同时还能减少到达时间。从而改善四旋翼飞行器系统的动态响应性能。
[0137] 本发明的有益效果为:全状态受限,降低超调量,减少到达时间,改善瞬态性能。附图说明
[0138] 图1为本发明的位置跟踪效果示意图。
[0139] 图2为本发明的姿态角跟踪效果示意图。
[0140] 图3为本发明的位置速度跟踪效果示意图。
[0141] 图4为本发明的姿态角速度跟踪效果示意图。
[0142] 图5为本发明的位置控制器输入示意图。
[0143] 图6为本发明的姿态角控制器输入示意图。
[0144] 图7为本发明的控制流程示意图。

具体实施方式

[0145] 下面结合附图对本发明做进一步说明。
[0146] 参照图1-图7,一种飞行器对数正切全状态受限控制方法,包括以下步骤:
[0147] 步骤1,建立四旋翼飞行器系统的动态模型,设定系统的初始值、采样时间以及控制参数,过程如下:
[0148] 1.1确定从基于四旋翼飞行器系统的机体坐标系到基于地球的惯性坐标的转移矩阵T:
[0149]
[0150] 其中,φ,θ,ψ分别是四旋翼飞行器的翻滚角、俯仰角、偏航角,表示飞行器依次绕惯性坐标系的各坐标轴旋转的角度;
[0151] 1.2四旋翼飞行器平动过程中的动态模型如下:
[0152]
[0153] 其中,x,y,z分别表示四旋翼飞行器在惯性坐标系下的三个位置,Uf表示四旋翼飞行器的输入力矩,m为四旋翼飞行器的质量,g表示重力加速度
[0154] 将式(1)代入式(2)得:
[0155]
[0156] 1.3四旋翼飞行器转动过程中的动态模型为:
[0157]
[0158] 其中,τx,τy,τz分别代表机体坐标系上各个轴的力矩分量,Ixx,Iyy,Izz分别表示机体坐标系下的各个轴的转动惯量的分量,×表示叉乘,ωp表示翻滚角速度,ωq表示俯仰角速度,ωr表示偏航角速度, 表示翻滚角加速度, 表示俯仰角加速度, 表示偏航角加速度;
[0159] 考虑到飞行器处于低速飞行或者悬停状态,姿态角变化较小,认为因此式(4)改写为:
[0160]
[0161] 联立式(3)和式(5),得到四旋翼飞行器的动力学模型为:
[0162]
[0163] 其中,ux=cosφsinθcosψ+sinφsinψ,uy=cosφsinθsinψ-sinφcosψ;
[0164] 1.4根据式(6),定义φ,θ的期望值分别为:
[0165]
[0166] 其中,φd为φ的期望信号值,θd为θ期望信号值,arcsin为反正弦函数;
[0167] 步骤2,在每一个采样时刻,计算位置跟踪误差及其一阶导数;计算姿态角跟踪误差及其一阶导数;设计位置和姿态角控制器,过程如下:
[0168] 2.1定义z跟踪误差及其一阶导数:
[0169]
[0170] 其中,zd表示z的期望信号;
[0171] 2.2定义q11:
[0172]
[0173] 2.3设计约束李雅普诺夫函数V11:
[0174]
[0175] 其中,Ka1,Kb1为正常数:
[0176]
[0177] 其中,|e1|max为|e1|的最大值;
[0178] 2.4求解式(10)一阶导数,得:
[0179]
[0180] 其中, α1为虚拟控制量,其表达式为:
[0181]
[0182] 其中,k11为正常数;
[0183] 将式(13)代入式(12),得:
[0184]
[0185] 2.5定义q12:
[0186]
[0187] 2.6设计约束李雅普诺夫函数V12:
[0188]
[0189] 其中,Kd1,Kc1为正常数:
[0190]
[0191] 其中,|e1|max为|e1|的最大值;
[0192] 求解式(16)一阶导数,得:
[0193]
[0194] 其中, 表达式为
[0195]
[0196] 将式(19)和式(6)代入式(18),得:
[0197]
[0198] 2.7设计Uf:
[0199]
[0200] 其中,k12为正常数;
[0201] 2.8定义x,y跟踪误差分别为e2,e3,则有:
[0202]
[0203] 其中,xd,yd分别表示x,y的期望信号;
[0204] 2.9定义q21,q31:
[0205]
[0206]
[0207] 2.10设计约束李雅普诺夫函数V21,V31:
[0208]
[0209] 其中,Ka2,Kb2,Ka3,Kb3为正常数:
[0210]
[0211] 其中,|e2|max为|e2|的最大值,|e3|max为|e3|的最大值;
[0212] 2.11求解式(25)一阶导数,得:
[0213]
[0214] 其中,α2,α3为虚拟控制量,其表达式为:
[0215]
[0216] 其中,k21,k31为正常数;
[0217] 将式(28)代入式(27),得:
[0218]
[0219] 2.12定义q22,q32:
[0220]
[0221]
[0222] 2.13设计李雅普诺夫函数V22,V32:
[0223]
[0224] 其中,Kc2,Kd2,Kc3,Kd3为正常数:
[0225]
[0226] 其中,|s2|max为|s2|的最大值,|s3|max为|s3|的最大值;
[0227] 求解式(32)一阶导数,得:
[0228]
[0229] 其 中 ,表达式如下
[0230]
[0231] 将式(35)和式(6)代入式(34),得:
[0232]
[0233] 2.14设计ux,uy:
[0234]
[0235] 其中,k22,k32为正常数;
[0236] 2.15定义姿态角跟踪误差及其一阶导数:
[0237]
[0238] 其中,j=4,5,6,x4=φ,x5=θ,x6=ψ,x4d表示φ的期望值,x5d表示θ的期望值,x6d表示ψ的期望值,e4表示φ的跟踪误差,e5表示θ的跟踪误差,e6表示ψ的跟踪误差;
[0239] 2.16定义qj1:
[0240]
[0241] 2.17设计约束李雅普诺夫函数Vj1:
[0242]
[0243] 其中,Kaj,Kbj为正常数:
[0244]
[0245] 其中,|ej|max为|ej|的最大值;
[0246] 2.18求解式(40)一阶导数,得:
[0247]
[0248] 其中, αj为虚拟控制量,其表达式为:
[0249]
[0250] 其中,kj1为正常数;
[0251] 将式(43)代入式(42),得:
[0252]
[0253] 2.19定义qj2:
[0254]
[0255] 2.20设计李雅普诺夫函数Vj2:
[0256]
[0257] 其中,Kdj,Kcj为正常数,满足Kdj
[0258] 求解式(46)一阶导数,得:
[0259]
[0260] 其中, 表达式为
[0261]
[0262] 将式(48)和式(6)代入式(47),得:
[0263]
[0264] 2.21通过式(49)设计τx,τy,τz:
[0265]
[0266] 其中,k42,k52,k62为正常数;
[0267] 步骤3,验证四旋翼飞行器系统的稳定性,过程如下:
[0268] 3.1将式(21)代入式(20),得:
[0269]
[0270] 3.2将式(37)代入式(36),得:
[0271]
[0272] 3.3将式(50)代入式(49),得
[0273]
[0274] 3.4通过(51),(52),(53)知四旋翼飞行器系统是稳定的。
[0275] 为了验证所提方法的可行性,本发明给出了该控制方法在MATLAB平台上的仿真结果:
[0276] 参数给定如下:式(2)中m=1.1kg,g=9.81N/kg;式(4)中,Ixx=1.22kg·m2,Iyy=1.22kg·m2,Izz=2.2kg·m2;式(8),式(22)和式(38)中zd=1,xd=1,yd=1,ψd=0.5;式(13),式(29)和式(43)中k11=2,k21=2,k31=2,k41=2,k51=2,k61=2;式(21),式(37)和式(50)中k12=2,k22=2,k32=2,k42=2,k52=2,k62=2;式(10),式(26)和式(41)kb1=kb2=kb3=kb4=kb5=kb6=2,ka1=ka2=ka3=ka4=ka5=ka6=2.5;式(17),式(33)和式(45)kd1=kd2=kd3=kd4=kd5=kd6=3.5,kc1=kc2=kc3=kc4=kc5=kc6=4;
[0277] 从图1和图2可知,系统输出具有良好的瞬态特性,到达时间为5.11秒,超调量为0.0013。
[0278] 从图3和图4可知,系统状态具有良好的瞬态特性,到达时间为5.53秒,超调量为0。
[0279] 综上所述,飞行器对数正切全状态受限控制方法能有效地改善四旋翼飞行器系统全状态的瞬态性能。
[0280] 以上阐述的是本发明给出的一个实施例表现出的优良优化效果,显然本发明不只是限于上述实施例,在不偏离本发明基本精神及不超出本发明实质内容所涉及范围的前提下对其可作种种变形加以实施。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈