CN103885450A - 无人直升机姿态非线性控制方法及验证平台 - Google Patents
无人直升机姿态非线性控制方法及验证平台 Download PDFInfo
- Publication number
- CN103885450A CN103885450A CN201410074443.5A CN201410074443A CN103885450A CN 103885450 A CN103885450 A CN 103885450A CN 201410074443 A CN201410074443 A CN 201410074443A CN 103885450 A CN103885450 A CN 103885450A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- tau
- lat
- lon
- control
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000012795 verification Methods 0.000 title claims abstract description 8
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 6
- 230000006870 function Effects 0.000 claims description 33
- 238000013341 scale-up Methods 0.000 claims description 33
- 238000013461 design Methods 0.000 claims description 31
- 238000002474 experimental method Methods 0.000 claims description 26
- 238000013528 artificial neural network Methods 0.000 claims description 24
- 230000001133 acceleration Effects 0.000 claims description 12
- 238000004891 communication Methods 0.000 claims description 10
- 230000005284 excitation Effects 0.000 claims description 10
- 230000008878 coupling Effects 0.000 claims description 8
- 238000010168 coupling process Methods 0.000 claims description 8
- 238000005859 coupling reaction Methods 0.000 claims description 8
- 238000009415 formwork Methods 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 claims description 8
- 238000001914 filtration Methods 0.000 claims description 6
- 238000007667 floating Methods 0.000 claims description 6
- 230000003247 decreasing effect Effects 0.000 claims description 4
- 210000002569 neuron Anatomy 0.000 claims description 4
- 101000802640 Homo sapiens Lactosylceramide 4-alpha-galactosyltransferase Proteins 0.000 claims description 3
- 102100035838 Lactosylceramide 4-alpha-galactosyltransferase Human genes 0.000 claims description 3
- 230000009471 action Effects 0.000 claims description 3
- 238000013459 approach Methods 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims description 3
- 230000003993 interaction Effects 0.000 claims description 3
- NSHPHXHGRHSMIK-JRIKCGFMSA-N latrunculin B Chemical compound C([C@H]1[C@@]2(O)C[C@H]3C[C@H](O2)CC[C@@H](\C=C/CC\C(C)=C/C(=O)O3)C)SC(=O)N1 NSHPHXHGRHSMIK-JRIKCGFMSA-N 0.000 claims description 3
- 238000012423 maintenance Methods 0.000 claims description 3
- 210000004218 nerve net Anatomy 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 239000004576 sand Substances 0.000 claims description 3
- 230000007306 turnover Effects 0.000 claims description 3
- 238000011160 research Methods 0.000 abstract description 8
- 238000005096 rolling process Methods 0.000 description 10
- 230000000694 effects Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 238000004088 simulation Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 206010044565 Tremor Diseases 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000001914 calming effect Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000011217 control strategy Methods 0.000 description 2
- 238000012850 discrimination method Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 239000003905 agrochemical Substances 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Landscapes
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明属于微小型旋翼式无人飞行器自主飞行控制研究领域,为使无人直升机实现快速、准确的镇定控制,并且该控制器对模型先验知识依赖较低,对系统的不确定性具有良好的鲁棒性。为此,本发明采用的技术方案是,无人直升机姿态非线性控制方法,包括如下步骤:一、首先,采用扫频的方法进行实验建模,给出如下的动力学模型:二、无人直升机系统辨识:三、无人直升机姿态控制。本发明主要应用于微小型旋翼式无人飞行器自主飞行控制。
Description
技术领域
本发明属于微小型旋翼式无人飞行器自主飞行控制研究领域,主要针对一种单旋翼无人飞行器的控制算法设计,包括无人直升机姿态动力学模型的获得,非线性鲁棒姿态控制律的设计,姿态飞行控制实验,具体讲,涉及无人直升机姿态非线性控制方法及验证平台。
背景技术
小型无人直升机是指不需要人驾驶或者操作的,能够自主飞行完成指定任务的特殊飞机。由于其具有垂直起降、安全性高、机动性好、空中悬停等优点,使得其在民用和军用上都有广泛的应用前景,例如低空海域的勘测、复杂地形的侦查、远距离航拍、农药的喷洒等。但由于无人直升机复杂的动力学特性,以及系统本身具有多变量、非线性、强耦合的特点,使得无人直升机的动态特性分析与控制设计较为困难。
目前国内已经有很多高校和科研机构都在进行无人直升机方面的研究。如针对小型无人直升机的非线性模型,应用反步法实现了无人直升机垂向和航向指令的相应跟踪。但值得指出的是,论文中仅仅进行了相应的数值仿真验证,并没有进行相应的实验验证(期刊:控制理论与应用;著者:于明清,徐锦法,刘建业;出版年月:2012年;文章题目:小型无人直升机控制率设计与仿真;页码:792-796)。又如考虑到直升机飞行过程可能遭受到的多种不确定因素的干扰,采用了一种滑模降阶的方法。并针对CE150型直升机模型给出了相应的数值仿真结果。然而文中为了消除滑模控制中可能产生的抖震现象,用饱和函数代替其符号函数,并且未进行相应的实验验证。(期刊:控制理论与应用;著者:蒋沅,曾令武,代冀阳;出版年月:2013年3月;文章题目:一类非线性直升机模型的滑模降阶控制器设计;页码:第30卷第3期330-338)
另一方面,国外研究人员在小型无人直升机的控制方面也取得了一定的成果。如叙利亚阿勒颇大学的直升机研究组利用基于近似反馈线性化的方法进行控制器设计,有效的抑制了外部扰动。但是反馈线性化的使用忽略了直升机特有的飞行动态,只能在特定的飞行状态下才能得到较好的控制效果(期刊:Control Systems Technology IEEE Transactions on;著者:Léonard F,Martini A,Abba G;出版年月:2012年;文章题目:Robust nonlinear controls of model-scale helicopter under latral and vertical wind gusts;页码:154-163)。美国南加利福尼亚大学的无人直升机科研组,通过使用旋转矩阵,结合反步法设计了无人直升机的姿态控制器,其数值仿真显示在姿态控制方面达到了较好的控制效果(期刊:Control Systems Technology IEEE Transactions on;著者:Raptis I A,Valavanis K P,Moreno W A;出版年月:2011年;文章题目:A novel nonlinearbackstepping controller design for helicopters using the rotation matrix;页码:465-473)。但由于反步法的使用引入了系统状态的多次微分,增大了系统的运算量,因此该论文只提供了其数值仿真结果。
从控制方法来讲,上述科研机构及高校都针对无人直升机提出了较好的解决方案。但是大多停留在仿真实验中,并且对系统模型的依赖程度较高,对于实际飞行是否可用仍然未知。 涉及到滑模控制器设计时,大多为了消除滑模控制中可能产生的抖震现象,用饱和函数代替符号函数。
发明内容
本发明旨在解决现有技术的不足,为使无人直升机实现快速、准确的镇定控制,并且该控制器对模型先验知识依赖较低,对系统的不确定性具有良好的鲁棒性。为此,本发明采用的技术方案是,无人直升机姿态非线性控制方法,包括如下步骤:
一、首先,采用扫频的方法进行实验建模,给出如下的动力学模型:
其中p为滚转角速度,q为俯仰角速度,为滚转角,θ为俯仰角,ψ为偏航角,as为横向挥舞角,bs为纵向挥舞角,r为偏航角速度,控制量输入u1定义为u1=[δlat δlon δped]T,其中δlat代表横滚舵机输入信号,δlon代表俯仰舵机输入信号,δped代表偏航角速率反馈控制器输入信号,公式(1)中的A1和B1分别定义为:
其中La表示横向挥舞角向滚转角加速度的比例系数,Lb表示纵向挥舞角向滚转角加速度的比例系数,Ma表示横向挥舞角向俯仰角加速度的比例系数,Mb表示纵向挥舞角向俯仰角加速度的比例系数,τ横向与纵向的挥舞迟滞常数,Nr表示尾舵控制状态反馈比例系数,Alat表示俯仰角速度到横滚舵机输入的比例系数,Alon表示俯仰角速度到俯仰舵机输入的比例系数,Blat表示滚转角速度到横滚舵机输入的比例系数,Blon表示滚转角速度到俯仰舵机输入的比例系数,Ab表示主旋翼纵向伺服输入比例系数,Ba表示主旋翼横向伺服输入比例系数,Nped表示尾舵控制输入与偏航角速度之间的比例系数;
分析(1)中的状态变量可知,偏航通道在悬停状态下相对独立,故可以单独考虑作以控制; 而其中的状态变量as和bs则不容易测量,故对于该状态量考虑用稳态挥舞角代数关系式代替微分方程式,其线性化后的微分方程式为:
在线性化后的方程中,和挥舞运动有关的状态变量的方程为:
q=-as/τ+Abbs+Alatδlat+Alonδlon, (8)
p=Baas-bs/τ+Blatδlat+Blonδlon (9)
通过分析(6)、(7)、(8)和(9)可以得到如下关系:
其中x2=[p q r]T,u2=[δlat δlon δped]T,
通过获取操控人员的控制输入量和姿态传感器提供的姿态信息,针对相对耦合程度较大的滚转通道和俯仰通道进行辨识实验,针对相对耦合程度较小的偏航通道进行辨识实验。飞行情况应尽量满足保持一个通道控制量输入不变的前提下,另一个通道的控制量输入设置为幅值和频率连续变化的正弦激励信号;
二、无人直升机系统辨识
采用递推最小二乘法进行辨识,其递推关系式为:
P(k)=[I-K(k)h′(k)]P(k-1),
三、无人直升机姿态控制
建立如下的三自由度无人直升机的模型:
其中u=[δlat δlon δped]T,A=A2,B=B2,ΔB为建模中忽略的系统非线性项,且满足ΔB∈L∞,||ΔBB-1||≤ξ<1,d(t)∈R3为实验平台中的各种扰动,且||d(t)||≤Ω,Ω为正常数;
e=xd-x (13)
为了方便后续控制器的设计,定义如下滤波误差信号:
(15)中辅助函数N(t)定义为:
为简化后续控制设计,定义辅助函数Nd(t)为:
其中z=[e r]T,且ρ(z)为正定非递减有界函数;
利用(16)、(17)和(18)可将(15)改写为:
基于(20)中滤波误差的开环动态方程,设计控制器为:
其中k,β为控制器增益,sign为标准的符号函数;
开环系统(20)中的未知函数Nd可用一个理想的三层神经网进行逼近,其表达式为:
Nd=WTσ(VTχ)+o(χ), (23)
将式(21),(22),(24)带入(20)中,即可得到如下闭环系统:
无人直升机姿态非线性控制验证平台,包括:小型电动遥控直升机;航姿参考系统;上位机主控制器;底层控制器;其中,主控制器选用PC/104,分为三个模块:数据采集模块,该模块负责惯性导航单元的数据采集与处理;飞行控制模块,该模块负责控制器算法的运行;数据通讯模块,该模块负责主控制器与底层控制器之间的数据传输;其中,选用DSP作为底层控制器,该底层控制器配有主控模块、数据采集模块、通讯模块及手自动切换模块,其中,主控模块负责控制算法的运算,数据采集模块负责传感器MTI的数据采集,通讯模块负责DSP与上位机信息交互,手自动切换模块负责接收机PPM信号捕捉和舵机PWM信号输出。
本发明针对小型单旋翼无人直升机的姿态控制问题,提出了一套可行的实施方案。其所具有的优点和有益效果如下:
1、根据无人直升机在平衡点的刚体特性,将不可测量的挥舞角状态量进行化简;
2、在传统的滑模控制算法基础上,设计了一种新的神经网络作为前馈对系统的不确定性进行补偿,从而也减轻了由滑模控制算法造成的抖震现象,避免了传统应用过程中使用饱和函数替代符号函数对稳定性分析的影响;
3、考虑到以往设计的控制算法往往局限于数值仿真,本实验组自主开发了三自由度飞行平台,设计了相应的硬件在环飞行实验,以及在阵风扰动下与LQR控制方法的对比实验。
附图说明
图1:本发明实物图。
图2:机载传感器实物图。
图3:遥控器实物图。
图4:硬件连接图。
图5:系统硬件连接整体效果图。
图6:小型无人直升机飞行控制系统控制器运行流程图。
具体实施方式
针对无人直升机的姿态控制问题,首先进行了俯仰、滚转和偏航通道的扫频辨识,获取了精度较高的姿态动力学模型。然后设计了基于神经网络前馈补偿的滑模控制算法,并进行了基于Lyapunov方法的稳定性分析,证明了设计的控制器能够实现无人直升机姿态的半全局指数收敛跟踪控制。姿态控制飞行实验结果表明,本发明可以使无人直升机实现快速、准确的镇定控制,并且该控制器对模型先验知识依赖较低,对系统的不确定性具有良好的鲁棒性。
本发明提出了一种新颖的基于神经网络前馈与滑模的小型无人直升机姿态控制方法。该方法对于系统模型的不确定性以及环境的干扰具有很强的适应性,可显著提高小型无人直升机的姿态控制精度,缩小误差范围。
一、小型无人直升机动力学模型建模
在进行无人直升机控制设计和仿真验证时,需要一个被控对象的动力学模型。常用的建模方法包括机理建模法和实验建模法。在利用机理建模方法时,无人直升机的各个参数值较难获得,因此在本文中主要采用扫频的方法进行实验建模工作。建立了无人直升机在悬停点附近的姿态动力学模型。首先给出如下的动力学模型(会议:Proceedings of the IEEE International Conference on Automation and Logistics;著者:Cai G,Cai A K,Chen B M;出版年月:2008年;文章题目:Construction,Modeling and Control of a Mini Autonomous UAV Helicopter;页码:449-454)(期刊:Control Systems Technology IEEE Transactions on;著者:Raptis I A,Valavanis K P,Vachtsevanos G J;出版年月:2012;文章题目:Linear tracking control for small-scale unmanned helicopters;页码:995-1010)。
其中p为滚转角速度,q为俯仰角速度,为滚转角,θ为俯仰角,as为横向挥舞角,bs为纵向挥舞角,r为偏航角速度。控制量输入u1定义为u1=[δlat δlon δped]T,其中δlat代表横滚舵机输入信号,δlon代表俯仰舵机输入信号,δped代 表偏航角速率反馈控制器输入信号。公式(1)中的A1和B1分别定义为:
其中La表示横向挥舞角向滚转角加速度的比例系数,Lb表示纵向挥舞角向滚转角加速度的比例系数,Ma表示横向挥舞角向俯仰角加速度的比例系数,Mb表示纵向挥舞角向俯仰角加速度的比例系数,τ横向与纵向的挥舞迟滞常数,Nr表示尾舵控制状态反馈比例系数,Alat表示俯仰角速度到横滚舵机输入的比例系数,Alon表示俯仰角速度到俯仰舵机输入的比例系数,Blat表示滚转角速度到横滚舵机输入的比例系数,Blon表示滚转角速度到俯仰舵机输入的比例系数,Ab表示主旋翼纵向伺服输入比例系数,Ba表示主旋翼横向伺服输入比例系数,Nped表示尾舵控制输入与偏航角速度之间的比例系数。
分析(1)中的状态变量可知,偏航通道在悬停状态下相对独立,故可以单独考虑作以控制;而其中的状态变量as和bs则不容易测量,故对于该状态量考虑用稳态挥舞角代数关系式代替微分方程式。其线性化后的微分方程式为:
在线性化后的方程中,和挥舞运动有关的状态变量的方程为:
q=-as/τ+Abbs+Alatδlat+Alonδlon, (8)
p=Baas-bs/τ+Blatδlat+Blonδlon. (9)
通过分析(6)、(7)、(8)和(9)可以得到如下关系:
其中x2=[p q r]T,u2=[δlat δlon δped]T,
由于小型无人直升机滚转和俯仰运动相对耦合程度较大,而偏航运动与滚转和俯仰运动耦合程度较小。因此,本文中通过获取操控人员的控制输入量和姿态传感器提供的姿态信息,分别针对滚转和俯仰通道进行辨识实验,偏航通道进行辨识实验。飞行情况应尽量满足保持一个通道控制量输入不变的前提下,另一个通道的控制量输入设置为幅值和频率连续变化的正弦激励信号。后续辨识结果表明,该方法获得了相对较好的辨识精度。
二、辨识流程与结果
针对本文中的研究对象,采用了基于最小二乘的参数辨识方法,得到了精度较高的动态模型。最小二乘法辨识是目前一个应用较为广泛的辨识方法,可用于静态、动态、线性、非线性系统,为了实现实时控制,这里采用递推最小二乘法进行辨识。其递推关系式为(期刊:Automatic Control.IEEE Transactions on;著者:Ljung L;出版年月:1978年;文章题目:Convergence analysis of parametric identification methods;页码:770-783):
P(k)=[I-K(k)h′(k)]P(k-1),
在本发明中,利用TREX-450型直升机作为研究对象,通过采集得到的操控人员控制输入量和单旋翼直升机姿态响应数据,将k时刻的控制输入信号作为最小二乘系统辨识算法中的z(k),将k时刻的单旋翼直升机姿态响应数据作为最小二乘系统辨识算法中的h(k),通过最小二乘辨识方法,可以得到如下的辨识结果:
为了验证辨识结果,利用辨识模型计算无人直升机的输出,并与实际测量值进行比较,可知辨识输出基本和实际输出相吻合,俯仰通道角度误差处于±0.2°以内;滚转通道角度误差大部分处于±0.5°以内;偏航通道角度误差处于±0.2°以内。这也为后续的无人直升机的姿态控制设计提供了较好的保证。
三、无人直升机姿态控制
考虑到线性化过程中被忽略的不确定项,以及实验平台中的各种扰动,结合系统辨识结果,得到如下的三自由度无人直升机的模型:
其中u=[δlat δlon δped]T,ψ为偏航角,A=A2,B=B2,ΔB为建模中忽略的系统非线性项,且满足ΔB∈L∞,||ΔBB-1||≤ξ<1。d(t)∈R3为实验平台中的各种扰动,且||d(t)||≤Ω,Ω为一未知正常数。
e=xd-x. (13)
为了方便后续控制器的设计,定义如下滤波误差信号:
(15)中辅助函数N(t)定义为:
为简化后续控制设计,定义辅助函数Nd(t)为:
由于连续可微,则的欧式范数满足以下不等式(期刊:Automatic Control.IEEE Transactions on;著者:Xian B,Dawson D M,De Queiroz M S.et all;出版年月:2004年;文章题目:A continuous asymptotic tracking control strategy for uncertain nonlinear systems;页码:1206-1211):
其中z=[e r]T,且ρ(z)为正定非递减有界函数(期刊:Automatic Control.IEEE Transactions on;著者:Xian B,Dawson D M,De Queiroz M S.et all;出版年月:2004年;文章题目:A continuous asymptotic tracking control strategy for uncertain nonlinear systems;页码:1206-1211):
利用(16)、(17)和(18)可将(15)改写为:
基于(20)中滤波误差的开环动态方程,设计控制器为:
其中u0(t)为基于滑模的非线性鲁棒控制,是基于神经网络的前馈部分,用于补偿系统的不确定性。这里u0(t)设计为:
其中k,β为控制器增益,sign为标准的符号函数。
开环系统(20)中的未知函数Nd可用一个理想的三层神经网进行逼近,其表达式为(专著:society for Industrial and Applied mathematics;著者:Lewis F L,Campos J,Selmic R;出版年月:1987年;文章题目:Neuro-fuzzy control of industrial systems with actuator nonlinearities),(期刊:Asian Journal of Control;著者:Lewis F L;出版年月:1999年;文章题目:Nonlinear network structures for feedback control;页码:205-228):
Nd=WTσ(VTχ)+o(χ), (23)
其中为神经网络的有界输入,W∈Rp×1为输出层理想权重,p为神经元个数,V∈R4×p为输入层理想权重,σ(X)为神经网络激励函数,o(χ)为估计值与真实值的偏差。而实际的基于神经网络的前馈可设计为(会议:Prof of the17th International Federation of Automatic Control World Congress;著者:Xian B,Cui C J,Huang M,et al.;出版年月:2008年;文章题目:Neural network based ontrol for a class of uncertain robot manipulator with exteranl disturbance;页码:12769-12775),(期刊:Automatic Control.IEEE Transactions on;著者:Patre P M,Mackunis W,Kaiser K,et al;出版年月:2008年;文章题目:Asymptotic tracking for uncertain dynamic systems via a multilayer neural network feedforward and RISEfeedback control structure.页码:2180-2185):
将式(21),(22),(24)带入(20)中,即可得到如下闭环系统:
四、本发明的理论支持
本文的稳定性分析主要结果可由下列定理给出。
证明:选取Lyapunov候选函数为
对(27)求一阶导数有:
因为||ΔBB-1||≤ξ<1。所以根据(28)可得:
将(19)代入(29)中,并且由rsign(r)=|r|可得
若选取增益k,使其满足
则有下列不等式成立
这里λ为一个正常数。根据(27)、(31)中k的充分条件可改写为:
或者
下面结合附图和具体实施例进一步详细说明本发明。
一、系统硬件连接及配置
为了验证控制算法的实用性,本研究组自主设计了相应的无人直升机硬件在环飞行实验平台。机身本体选用TREX-450小型电动遥控直升机,如图1所示。
该小型直升机机身长640mm,主桨长度为710mm,飞机总重约638g,有效负载约为500g。机载传感器选用Xsens公司生产的MTI姿态航向参考系统,如图2所示。
该传感器最高更新频率为120Hz,提供三轴角速度及三轴姿态角,其中俯仰角和滚转角精度为±0.5°,偏航角精度为±1°。该平台选用PC/104作为上位机主控制器,用于复杂控制算法的计算。其采样频率最高可达100kHZ,足以保证控制系统的实时性。主控制器PC/104主要分为三个模块:数据采集模块,该模块负责惯性导航单元的数据采集与处理;飞行控制模块,该模块负责控制器算法的运行;数据通讯模块,该模块负责主控制器与底层控制器之间的数据传输,如控制量等。
此外,本研究组自主设计开发了基于DSP(型号为TMS320F28335)处理器的底层控制器,该底层控制器配有主控模块、数据采集模块、通讯模块及手自动切换模块。其中,主控模块负责控制算法的运算,数据采集模块负责传感器MTI的数据采集,通讯模块负责DSP与上位机信息交互,手自动切换模块负责接收机PPM信号捕捉和舵机PWM信号输出。
将上述模块通过相应的数据接口连接起来,即可得到小型无人直升机姿态飞行平台。其硬件连接图如图4所示。
其系统硬件连接整体效果图如图5所示。
小型无人直升机飞行控制系统控制器运行流程图如图6所示。
二、硬件在环飞行实验
在设计硬件在环飞行实验时,选取神经网络层数为3,神经元个数p为10,激励函数为 给定角度初值为θd=-8°,ψd=-15°。其中控制器的主要参数设为: αθ=150,βθ=36.5,kθ=4,αψ=12,βψ=4,kψ=5.5。通过编写的通讯模块下载到PC/104控制器中,进行TREX-450型小型无人直升机实物飞行实验。在实验中,操控人员通过遥控器中的一路切换通道即可完成对手动飞行状态和自动飞行状态的转换。在飞行中,无人直升机仅受平台中球头的约束,使其在俯仰和滚转角度最大达到15°,偏航方向为360°,垂直方向无运动。飞行过程中,在俯仰和滚转方向,通过人为的切换完成对平衡状态的干扰,其效果相当于大幅度阶跃信号,偏航通道通过人为加入遥控器的控制量,达到加入扰动的效果。
从无人直升机硬件在环飞行实验可以看出:在起飞20秒时,操控人员通过切块手动/自动通道完成无人直升机悬停的状态转换。随即俯仰、滚转和偏航方向均在1秒到2秒内达到平衡。达到稳态后,俯仰方向控制精度保持在±1°以内,滚转方向控制精度保持在±1°以内,偏 航方向控制精度保持在±1.5°以内。而在70秒时,通过手/自动通道的切换,达到在三个方向上加入扰动的效果。如图所示,无人直升机均可以快速的镇定到平衡状态,且姿态精度不变,控制输入量保证在有效范围内。在125秒以及135秒左右,为操控人员通过遥控器人为改变偏航方向角后,无人直升机的姿态响应曲线。可以看到,大幅度改变尾舵方向后,无人直升机仍然能够快速镇定到给定状态。
三、抗风扰性能对比实验
根据辨识得到的系统模型,设计相应的LQR(线性二次型调节器)控制器。并且在有侧风的情况下,与本文中提出的基于神经网络前馈的滑模控制算法进行硬件在环对比实验。实验中,首先完成在无风的情况下,两种控制器的镇定实验。然后加入侧面阵风,达到加入某一方向持续阵风的效果。
从抗风对比实验中可以看出,在起初无风状态下,两种控制算法均可以使无人直升机达到镇定效果。其中LQR控制器的控制精度为±2°,明显低于基于神经网络前馈的滑模控制算法控制精度。在60秒左右,人为加入侧面阵风干扰,其风速大小为4m/s-6.5m/s。在此阵风的影响下,LQR与本文设计的控制器均可以使得无人直升机保持姿态的相对镇定。其中LQR仅仅达到滚转和俯仰角度±5°以内,偏航方向角度为±2°以内。而本文提出的基于神经网络前馈的滑模控制器可以达到滚转和俯仰角度±2°以内,偏航方向为±1°以内,其抗风控制效果远远好于LQR控制器。
Claims (3)
1.一种无人直升机姿态非线性控制方法,其特征是,包括下列步骤:
一、首先,采用扫频的方法进行实验建模,给出如下的动力学模型:
其中p为滚转角速度,q为俯仰角速度,为滚转角,θ为俯仰角,ψ为偏航角,as为横向挥舞角,bs为纵向挥舞角,r为偏航角速度,控制量输入u1定义为u1=[δlat δlon δped]T,其中δlat代表横滚舵机输入信号,δlon代表俯仰舵机输入信号,δped代表偏航角速率反馈控制器输入信号,公式(1)中的A1和B1分别定义为:
其中La表示横向挥舞角向滚转角加速度的比例系数,Lb表示纵向挥舞角向滚转角加速度的比例系数,Ma表示横向挥舞角向俯仰角加速度的比例系数,Mb表示纵向挥舞角向俯仰角加速度的比例系数,τ横向与纵向的挥舞迟滞常数,Nr表示尾舵控制状态反馈比例系数,Alat表示俯仰角速度到横滚舵机输入的比例系数,Alon表示俯仰角速度到俯仰舵机输入的比例系数,Blat表示滚转角速度到横滚舵机输入的比例系数,Blon表示滚转角速度到俯仰舵机输入的比例系数,Ab表示主旋翼纵向伺服输入比例系数,Ba表示主旋翼横向伺服输入比例系数,Nped表示尾舵控制输入与偏航角速度之间的比例系数;
分析(1)中的状态变量可知,偏航通道在悬停状态下相对独立,故可以单独考虑作以控制;而其中的状态变量as和bs则不容易测量,故对于该状态量考虑用稳态挥舞角代数关系式代替微分方程式,其线性化后的微分方程式为:
在线性化后的方程中,和挥舞运动有关的状态变量的方程为:
q=-as/τ+Abbs+Alatδlat+Alonδlon, (8)
p=Baas-bs/τ+Blatδlat+Blonδlon (9)
通过分析(6)、(7)、(8)和(9)可以得到如下关系:
其中x2=[p q r]T,u2=[δlat δlon δped]T,
通过获取操控人员的控制输入量和姿态传感器提供的姿态信息,针对相对耦合程度较大的滚转通道和俯仰通道进行辨识实验,针对相对耦合程度较小的偏航通道进行辨识实验。飞行情况应尽量满足保持一个通道控制量输入不变的前提下,另一个通道的控制量输入设置为幅值和频率连续变化的正弦激励信号;
二、无人直升机系统辨识
采用递推最小二乘法进行辨识,其递推关系式为:
P(k)=[I-K(h)h′(k)]P(k-1),
三、无人直升机姿态控制
建立如下的三自由度无人直升机的模型:
其中u=[δlat δlon δped]T,A=A2,B=B2,ΔB为建模中忽略的系统非线性项,且满足ΔB∈L∞,||ΔBB-1||≤ξ<1,d(t)∈R3为实验平台中的各种扰动,且||d(t)||≤Ω,Ω为正常数;
定义xd(t)为参考轨迹,且满足xd、则无人直升机的姿态跟踪误差定义为:
e=xd-x (13)
为了方便后续控制器的设计,定义如下滤波误差信号:
(15)中辅助函数N(t)定义为:
为简化后续控制设计,定义辅助函数Nd(t)为:
其中z=[e r]T,且ρ(z)为正定非递减有界函数;
利用(16)、(17)和(18)可将(15)改写为:
2.如权利要求1所述的无人直升机姿态非线性控制方法,其特征是,基于(20)中滤波误差的开环动态方程,设计控制器为:
其中k,β为控制器增益,sign为标准的符号函数;
开环系统(20)中的未知函数Nd可用一个理想的三层神经网进行逼近,其表达式为:
Nd=WTσ(VTχ)+o(χ), (23)
将式(21),(22),(24)带入(20)中,即可得到如下闭环系统:
3.一种无人直升机姿态非线性控制验证平台,其特征是,包括:小型电动遥控直升机;航姿参考系统;上位机主控制器;底层控制器;其中,主控制器选用PC/104,分为三个模块:数据采集模块,该模块负责惯性导航单元的数据采集与处理;飞行控制模块,该模块负责控制器算法的运行;数据通讯模块,该模块负责主控制器与底层控制器之间的数据传输;其中,选用DSP作为底层控制器,该底层控制器配有主控模块、数据采集模块、通讯模块及手自动切换模块,其中,主控模块负责控制算法的运算,数据采集模块负责传感器MTI的数据采集,通讯模块负责DSP与上位机信息交互,手自动切换模块负责接收机PPM信号捕捉和舵机PWM信号输出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410074443.5A CN103885450B (zh) | 2014-03-03 | 2014-03-03 | 无人直升机姿态非线性控制方法及验证平台 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410074443.5A CN103885450B (zh) | 2014-03-03 | 2014-03-03 | 无人直升机姿态非线性控制方法及验证平台 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103885450A true CN103885450A (zh) | 2014-06-25 |
CN103885450B CN103885450B (zh) | 2016-07-06 |
Family
ID=50954398
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410074443.5A Expired - Fee Related CN103885450B (zh) | 2014-03-03 | 2014-03-03 | 无人直升机姿态非线性控制方法及验证平台 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103885450B (zh) |
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104142631A (zh) * | 2014-08-01 | 2014-11-12 | 北京理工大学 | 飞行控制系统的快速原型设计与半物理仿真方法及系统 |
CN104391364A (zh) * | 2014-11-26 | 2015-03-04 | 深圳市鸣鑫航空科技有限公司 | 基于光缆敷设的共轴双旋翼无人直升机参数辨识试验系统 |
CN104503258A (zh) * | 2014-11-26 | 2015-04-08 | 深圳市鸣鑫航空科技有限公司 | 基于光缆敷设的共轴双旋翼无人直升机建模方法 |
CN104699082A (zh) * | 2015-04-01 | 2015-06-10 | 北京象限科技有限公司 | 无人机整机贯导测试台 |
CN104950901A (zh) * | 2015-07-03 | 2015-09-30 | 天津大学 | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 |
CN105843040A (zh) * | 2016-04-06 | 2016-08-10 | 沈阳上博智拓科技有限公司 | 无人直升机动力学参数的辨识方法和装置 |
CN106406092A (zh) * | 2016-09-28 | 2017-02-15 | 南京航空航天大学 | 一种适用于直升机自适应飞行控制的鲁棒辨识方法 |
CN106569502A (zh) * | 2016-05-20 | 2017-04-19 | 上海铸天智能科技有限公司 | 多旋翼飞行器抓捕目标后的复合体姿态自适应控制方法 |
CN107065912A (zh) * | 2017-05-04 | 2017-08-18 | 厦门衡空科技有限公司 | 检测飞行器落地的方法及装置 |
CN108196573A (zh) * | 2017-12-29 | 2018-06-22 | 南京奇蛙智能科技有限公司 | 一种无人机在线辨识与控制方法 |
CN108196561A (zh) * | 2018-01-18 | 2018-06-22 | 北京航空航天大学 | 一种无人飞行器的鲁棒抗风扰位置控制方法和装置 |
CN108319141A (zh) * | 2018-02-05 | 2018-07-24 | 西北工业大学 | 结合线性二次调节器与分数阶滑模控制的复合控制方法 |
CN108763772A (zh) * | 2018-05-30 | 2018-11-06 | 河北清华发展研究院 | 一种固定翼无人机纵向姿态控制器设计方法 |
CN109308074A (zh) * | 2017-07-28 | 2019-02-05 | 深圳禾苗通信科技有限公司 | 一种无人机重心偏移的补偿方法及系统 |
CN109597303A (zh) * | 2018-11-29 | 2019-04-09 | 南京航空航天大学 | 一种复合式旋翼飞行器全模式飞行控制方法 |
CN109991991A (zh) * | 2019-02-26 | 2019-07-09 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪方法 |
CN110007617A (zh) * | 2019-03-29 | 2019-07-12 | 北京航空航天大学 | 一种飞行器半实物仿真系统的不确定度传递分析方法 |
CN111413886A (zh) * | 2020-03-06 | 2020-07-14 | 浙江海洋大学 | 一种基于系统辨识的实船操纵性指数辨识方法及装置 |
CN111420326A (zh) * | 2020-03-27 | 2020-07-17 | 国网湖南省电力有限公司 | 航空灭火装置悬停喷射灭火的控制方法及系统 |
CN112486218A (zh) * | 2020-12-01 | 2021-03-12 | 深圳联合飞机科技有限公司 | 一种直升机的控制方法和系统 |
CN117110766A (zh) * | 2023-10-18 | 2023-11-24 | 沈阳圣飞航空科技有限公司 | 一种用于检测航空电子操纵装置的检测系统及方法 |
CN117991819A (zh) * | 2024-04-07 | 2024-05-07 | 中国人民解放军陆军指挥学院 | 一种无人机飞行控制方法 |
CN118011838A (zh) * | 2024-04-08 | 2024-05-10 | 北京航空航天大学 | 一种基于仿生激励干扰分离器的航天器误差标定方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103365214A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 一种单旋翼无人飞行器三自由度半实物仿真平台及实验方法 |
CN103365215A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 一种四旋翼无人飞行器半实物仿真实验系统及实验方法 |
CN103365295A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法 |
CN103592941A (zh) * | 2013-10-30 | 2014-02-19 | 天津大学 | 一种飞行速度限制下的无人飞行器航迹规划方法 |
-
2014
- 2014-03-03 CN CN201410074443.5A patent/CN103885450B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103365214A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 一种单旋翼无人飞行器三自由度半实物仿真平台及实验方法 |
CN103365215A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 一种四旋翼无人飞行器半实物仿真实验系统及实验方法 |
CN103365295A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法 |
CN103592941A (zh) * | 2013-10-30 | 2014-02-19 | 天津大学 | 一种飞行速度限制下的无人飞行器航迹规划方法 |
Non-Patent Citations (3)
Title |
---|
GUOWEI CAI等: "Construction, Modeling and Control of a Mini Autonomous UAV Helicopter", 《PROCEEDINGS OF THE IEEE INTERNATIONAL CONFERENCE ON AUTOMATION AND LOGISTICS》 * |
IOANNIS A. RAPTIS等: "Linear Tracking Control for Small-Scale Unmanned Helicopters", 《IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY》 * |
LENNART LJUNG: "Convergence Analysis of Parametric Identification Methods", 《IEEE TRANSACTIONS ON AUTOMATIC CONTROL》 * |
Cited By (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104142631A (zh) * | 2014-08-01 | 2014-11-12 | 北京理工大学 | 飞行控制系统的快速原型设计与半物理仿真方法及系统 |
CN104142631B (zh) * | 2014-08-01 | 2016-08-24 | 北京理工大学 | 飞行控制系统的快速原型设计与半物理仿真方法及系统 |
CN104391364B (zh) * | 2014-11-26 | 2017-06-09 | 深圳市鸣鑫航空科技有限公司 | 基于光缆敷设的共轴双旋翼无人直升机参数辨识试验系统 |
CN104391364A (zh) * | 2014-11-26 | 2015-03-04 | 深圳市鸣鑫航空科技有限公司 | 基于光缆敷设的共轴双旋翼无人直升机参数辨识试验系统 |
CN104503258A (zh) * | 2014-11-26 | 2015-04-08 | 深圳市鸣鑫航空科技有限公司 | 基于光缆敷设的共轴双旋翼无人直升机建模方法 |
CN104503258B (zh) * | 2014-11-26 | 2017-06-16 | 深圳市鸣鑫航空科技有限公司 | 基于光缆敷设的共轴双旋翼无人直升机建模方法 |
CN104699082A (zh) * | 2015-04-01 | 2015-06-10 | 北京象限科技有限公司 | 无人机整机贯导测试台 |
CN104950901A (zh) * | 2015-07-03 | 2015-09-30 | 天津大学 | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 |
CN105843040A (zh) * | 2016-04-06 | 2016-08-10 | 沈阳上博智拓科技有限公司 | 无人直升机动力学参数的辨识方法和装置 |
CN105843040B (zh) * | 2016-04-06 | 2018-09-21 | 沈阳上博智拓科技有限公司 | 无人直升机动力学参数的辨识方法和装置 |
CN106569502A (zh) * | 2016-05-20 | 2017-04-19 | 上海铸天智能科技有限公司 | 多旋翼飞行器抓捕目标后的复合体姿态自适应控制方法 |
CN106406092A (zh) * | 2016-09-28 | 2017-02-15 | 南京航空航天大学 | 一种适用于直升机自适应飞行控制的鲁棒辨识方法 |
CN106406092B (zh) * | 2016-09-28 | 2019-05-14 | 南京航空航天大学 | 一种适用于直升机自适应飞行控制的鲁棒辨识方法 |
CN107065912A (zh) * | 2017-05-04 | 2017-08-18 | 厦门衡空科技有限公司 | 检测飞行器落地的方法及装置 |
CN107065912B (zh) * | 2017-05-04 | 2020-08-11 | 厦门衡空科技有限公司 | 检测飞行器落地的方法及装置 |
CN109308074A (zh) * | 2017-07-28 | 2019-02-05 | 深圳禾苗通信科技有限公司 | 一种无人机重心偏移的补偿方法及系统 |
CN108196573A (zh) * | 2017-12-29 | 2018-06-22 | 南京奇蛙智能科技有限公司 | 一种无人机在线辨识与控制方法 |
CN108196561A (zh) * | 2018-01-18 | 2018-06-22 | 北京航空航天大学 | 一种无人飞行器的鲁棒抗风扰位置控制方法和装置 |
CN108319141A (zh) * | 2018-02-05 | 2018-07-24 | 西北工业大学 | 结合线性二次调节器与分数阶滑模控制的复合控制方法 |
CN108763772A (zh) * | 2018-05-30 | 2018-11-06 | 河北清华发展研究院 | 一种固定翼无人机纵向姿态控制器设计方法 |
CN108763772B (zh) * | 2018-05-30 | 2022-10-21 | 河北清华发展研究院 | 一种固定翼无人机纵向姿态控制器设计方法 |
CN109597303A (zh) * | 2018-11-29 | 2019-04-09 | 南京航空航天大学 | 一种复合式旋翼飞行器全模式飞行控制方法 |
CN109991991B (zh) * | 2019-02-26 | 2020-03-20 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪方法 |
CN109991991A (zh) * | 2019-02-26 | 2019-07-09 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪方法 |
CN110007617A (zh) * | 2019-03-29 | 2019-07-12 | 北京航空航天大学 | 一种飞行器半实物仿真系统的不确定度传递分析方法 |
CN111413886A (zh) * | 2020-03-06 | 2020-07-14 | 浙江海洋大学 | 一种基于系统辨识的实船操纵性指数辨识方法及装置 |
CN111413886B (zh) * | 2020-03-06 | 2023-07-04 | 浙江海洋大学 | 一种基于系统辨识的实船操纵性指数辨识方法及装置 |
CN111420326A (zh) * | 2020-03-27 | 2020-07-17 | 国网湖南省电力有限公司 | 航空灭火装置悬停喷射灭火的控制方法及系统 |
CN111420326B (zh) * | 2020-03-27 | 2021-04-23 | 国网湖南省电力有限公司 | 航空灭火装置悬停喷射灭火的控制方法及系统 |
CN112486218A (zh) * | 2020-12-01 | 2021-03-12 | 深圳联合飞机科技有限公司 | 一种直升机的控制方法和系统 |
CN117110766A (zh) * | 2023-10-18 | 2023-11-24 | 沈阳圣飞航空科技有限公司 | 一种用于检测航空电子操纵装置的检测系统及方法 |
CN117110766B (zh) * | 2023-10-18 | 2024-01-09 | 沈阳圣飞航空科技有限公司 | 一种用于检测航空电子操纵装置的检测系统及方法 |
CN117991819A (zh) * | 2024-04-07 | 2024-05-07 | 中国人民解放军陆军指挥学院 | 一种无人机飞行控制方法 |
CN117991819B (zh) * | 2024-04-07 | 2024-06-04 | 中国人民解放军陆军指挥学院 | 一种无人机飞行控制方法 |
CN118011838A (zh) * | 2024-04-08 | 2024-05-10 | 北京航空航天大学 | 一种基于仿生激励干扰分离器的航天器误差标定方法 |
CN118011838B (zh) * | 2024-04-08 | 2024-06-07 | 北京航空航天大学 | 一种基于仿生激励干扰分离器的航天器误差标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103885450B (zh) | 2016-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103885450A (zh) | 无人直升机姿态非线性控制方法及验证平台 | |
Shen et al. | Adaptive neural network-based active disturbance rejection flight control of an unmanned helicopter | |
CN109696830B (zh) | 小型无人直升机的强化学习自适应控制方法 | |
CN103760906B (zh) | 神经网络与非线性连续无人直升机姿态控制方法 | |
CN103760905B (zh) | 基于模糊前馈单旋翼无人直升机姿态非线性鲁棒控制方法 | |
Singh et al. | Automatic path planning and control design for autonomous landing of UAVs using dynamic inversion | |
Davoudi et al. | Quad-rotor flight simulation in realistic atmospheric conditions | |
CN108803639A (zh) | 一种基于反步法的四旋翼飞行器飞行控制方法 | |
Ambati et al. | Robust auto-landing of fixed-wing UAVs using neuro-adaptive design | |
Muniraj et al. | Path-following control of small fixed-wing unmanned aircraft systems with H∞ type performance | |
CN104331085A (zh) | 一种基于pid神经网络的无人机控制方法 | |
López-Gutiérrez et al. | Robust quadrotor control: attitude and altitude real-time results | |
Su et al. | Barrier Lyapunov function-based robust flight control for the ultra-low altitude airdrop under airflow disturbances | |
Brodecki et al. | Autonomous formation flight control system using in-flight sweet-spot estimation | |
Jiang et al. | Enhanced LQR control for unmanned helicopter in hover | |
Dillsaver et al. | Trajectory control of very flexible aircraft with gust disturbance | |
Grymin et al. | Two-step system identification and trajectory tracking control of a small fixed-wing UAV | |
CN109991992A (zh) | 基于浸入不变集的小型无人直升机无模型自适应控制方法 | |
Wu et al. | An improved online system identification method for tiltrotor aircraft | |
Suprijono et al. | Direct inverse control based on neural network for unmanned small helicopter attitude and altitude control | |
Yayla et al. | An adaptive flight controller design for a tilt-prop fixed wing UAV for all flight modes | |
Zhou et al. | System identification and control for a tail-sitter unmanned aerial vehicle in the cruise flight | |
Suresh et al. | An on-line learning neural controller for helicopters performing highly nonlinear maneuvers | |
Azid et al. | Precise trajectory tracking of multi-rotor UAVs using wind disturbance rejection approach | |
Sandino et al. | On the applicability of linear control techniques for autonomous landing of helicopters on the deck of a ship |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160706 |