CN106647783B - 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 - Google Patents
倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 Download PDFInfo
- Publication number
- CN106647783B CN106647783B CN201611032392.5A CN201611032392A CN106647783B CN 106647783 B CN106647783 B CN 106647783B CN 201611032392 A CN201611032392 A CN 201611032392A CN 106647783 B CN106647783 B CN 106647783B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- wing unmanned
- rotor wing
- tilting type
- 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.)
- Expired - Fee Related
Links
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 33
- 238000000034 method Methods 0.000 title claims abstract description 9
- 238000013461 design Methods 0.000 claims abstract description 28
- 239000011159 matrix material Substances 0.000 claims description 38
- 230000036544 posture Effects 0.000 claims description 36
- 238000005096 rolling process Methods 0.000 claims description 10
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000007704 transition Effects 0.000 claims description 4
- 238000004519 manufacturing process Methods 0.000 abstract 1
- 238000002474 experimental method Methods 0.000 description 5
- 238000011160 research Methods 0.000 description 4
- 230000005484 gravity Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000006641 stabilisation Effects 0.000 description 2
- 238000011105 stabilization Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 102000004310 Ion Channels Human genes 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000005065 mining Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及倾转式三旋翼无人机动力学模型建立与其姿态与高度控制,为针对尾舵倾角可独立控制的倾转式三旋翼无人机,设计一种鲁棒性较好,同时可以弥补动力学***不确定性的自适应律与非线性控制器。本发明采用的技术方案是,倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法,步骤如下:1)建立倾转式三旋翼无人机相关的坐标系:2)建立以旋翼电机转速与尾舵倾角的倾转式三旋翼无人机动力学模型:3)设计非线性控制器与自适应律。本发明主要应用于倾转式三旋翼无人机设计制造场合。
Description
技术领域
本发明涉及倾转式三旋翼无人机动力学模型建立与其姿态与高度控制。
背景技术
近年来,多旋翼飞行器的导航和控制得到了长足的发展,成为了相关研究的热点。多旋翼飞行器的续航时间与其自重和结构有着密切的关系,相比与市面上常见的四旋翼、六旋翼无人机等,同等级的倾转式三旋翼无人机具有较轻的起飞重量,较低的飞行功耗,结构更为紧凑等特点,可以进一步增加续航时间,提高悬停效率,增强飞行机动性能。
倾转式三旋翼无人飞行器融合了多旋翼直升机与倾转式飞行器二者的优势,在保持多旋翼直升机垂直起降,便于操作的特点的基础上,在尾舵增加了舵机,改善了动力机构,因而也具备倾转式飞行器机动性能强,有效载荷大等优点,具备一定的研究潜力和研究价值。
法国的贡比涅技术大学的研究人员在忽略尾舵产生的侧向力的情况下,建立了三旋翼无人机姿态与位置的力学模型,并结合了饱和函数和比例微分控制器,设计关于三旋翼无人机的姿态和位置控制器,其位置的控制精度在0.1m以内,滚转角和俯仰角的控制精度在2°以内,偏航角的控制精度在5°以内(期刊:Control Engineering Practice;著者:Salazar-Cruz S,Lozano R,J,出版年月:2009年;文章题目:Stabilization andnonlinear control for a novel trirotor mini-aircraft,页码:886-894)(期刊:IEEETransactions on Aerospace&Electronic Systems;著者:Salazar-Cruz S,Kendoul F,Lozano R,出版年月:2008年;文章题目:Real-time stabilization of a small three-rotor aircraft,页码:783-794)。
印度理工大学(Indian Institute of Technology,Madras)的研究人员在倾转式双轴无人飞行器研究基础上,将其与倾转式三旋翼无人机的研究相结合[13][14]。通过对三旋翼无人机的受力分析与能量分析,建立了欧拉-拉格朗日形式(Euler-LagrangeFormalism)的倾转式三旋翼无人机的动力学模型。并在此基础上结合反馈线性化,应用反步法(Back stepping)设计出了针对三旋翼无人机位置以及姿态的比例微分(PD)控制器,该控制器也可应用到倾转式双轴无人机的飞行控制中。(会议:Chinese Control andDecision Conference;著者:Kulhare A,Chowdhury A B,Raina G;出版年月:2012年;文章题目:A Back-stepping Control Strategy for the Tri-rotor UAV;页码:3481-3486)。
法国国立巴黎高等矿业学校在三旋翼无人机各轴的直流无刷电机下方均安装舵机,使每个电机旋转轴的倾角可独立调节,因此这种三旋翼无人机具备了较强的机动性能。研究人员分析了此类无人机的受力情况,推导出了姿态与位置的动力学模型,并在此基础上,针对三旋翼无人机的轨迹跟踪问题设计了一种基于平面度的控制方案,并完成了圆形轨迹跟踪飞行实验,参考轨迹的直径约为2m,控制精度在0.2m以内(会议:theInternational Conference on Unmanned Aircraft Systems;著者:Servais E,D'Andrea-Novel B,Mounier H;出版年月:2015年;文章题目:Ground control of a hybridtricopter;页码:945-950)(会议:International Conference on Methods and MODELSin Automation and Robotics;著者:Servais E,D'Andrea-Novel B,Mounier H;出版年月:2015年;文章题目:Trajectory tracking of trirotor UAV with pendulum load;页码:517-522)。
发明内容
为克服现有技术的不足,本发明旨在针对尾舵倾角可独立控制的倾转式三旋翼无人机,设计一种鲁棒性较好,同时可以弥补动力学***不确定性的自适应律与非线性控制器。本发明采用的技术方案是,倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法,步骤如下:
1)建立倾转式三旋翼无人机相关的坐标系:
为了便于非线性控制器与自适应律的设计,设定如下定义:
两个坐标系,分别为惯性坐标系{I}和体坐标系{B},二者均满足右手定则,惯性坐标系{I}原点位于地面,体坐标系{B}原点位于三旋翼无人机的质心,{xI yI zI}和{xB yBzB}分别表示惯性坐标系{I}和体坐标系{B}对应的三个主轴;
2)建立以旋翼电机转速与尾舵倾角的倾转式三旋翼无人机动力学模型:
倾转式旋翼无人机的飞行的执行单元,即是其各旋翼电机与尾舵舵机,以各旋翼电机转速与尾舵倾角作为控制输入,使控制方案更为直接简洁,避免了选择控制输入时,其他因素的影响,倾转式三旋翼无人机动力学模型表示为下式:
其中d=[dφ dθ dψ dh]T,q=diag{M-1ΨT,cosφcosθ},g表示重力加速度,u为该动力学模型的控制输入向量,式中dφ、dθ、dψ、dh分别表示各通道受到的外界扰动,Ψ表示角速度转换矩阵,M表示惯性矩阵,C表示向心力与科里奥利力矩阵,η1=[φ θ ψ]T表示无人机姿态向量,其中φ、θ、ψ分别表示该无人机的滚转角,偏航角和俯仰角,η2=[φ θ ψ h]T表示该三旋翼无人机的状态变量向量,h表示该三旋翼无人机的飞行高度;
3)设计非线性控制器与自适应律
采用前述动力学模型时,在模型中存在未知常参数升力系数b与反力矩系数c,同时在倾转式三旋翼无人机的飞行过程中,会受到各姿态通道与高度方向的扰动力矩和力,为实现倾转式三旋翼无人机姿态与高度的控制目标,定义跟踪误差为:
e=η2-ηd
其中e=[eφ eθ eψ eh]T,eφ、eθ、eψ、eh分别表示滚转角、俯仰角、偏航角和高度的跟踪误差。对e求关于时间的一阶导数和二阶导数,可得:
此处可构造一种滑模面s为:
其中ηd=[φd θd ψd hd]T表示该倾转式三旋翼无人机目标轨迹,其中φd、θd、ψd、hd分别表示目标滚转角、俯仰角、偏航角和高度,s=[sφ sθ sψ sh]T,sφ、sθ、sψ、sh分别为 该三旋翼无人机滚转、俯仰、偏航和高度通道的滑模面,Λ为一正对角常系数矩阵,表示为Λ=diag{λ1,λ2,λ3,λ4}
设计控制输入设计u为:
其中,sign为符号函数,将升力系数b和反扭矩系数c之积表示为一未知参数r,Φ为一参数矩阵,l1、l2、l3来表示各旋翼到该无人机质心的力臂,m表示倾转式三旋翼无人机的质量,则:
为未知参数矩阵Φ的估计,与分别为未知参数b和r的估计,表示为:
Ki,i=1,2,3,4为对角正系数矩阵,表示为:
Ki,i=1,2,3,4=diag{ki1,ki2,ki3,ki4}
v为控制器中所设计的一中间向量,定义v=[vφ vθ vψ vh]T且满足关系:
当该无人机姿态与高度通道的不可测扰动有界时,各姿态通道的扰动力矩τd和高度通道的绕动力fd满足关系τd<|δ1|,δ1为一未知正常数,表示各姿态通道扰动扭矩的上界;δ2为一未知正常数,表示各姿态通道扰动扭矩导数的上界;fd<|δ3|,δ3也为一未知正常数,表示高度通道扰动力的上界;
其中Ρ为一正实对角矩阵,定义为Ρ=diag{ρ1,ρ2,ρ3,ρ4},定义一正实对角矩阵表示为为便于参数估计值与的设计,定义中间变量N和L,并定义该三旋翼无人机的转动惯量为J=diag{j1,j2,j3},j1、j2、j3分别为无人机在滚转、俯仰和偏航通道的转动惯量,则有以下关系成立:
易知参数矩阵非奇异时,所设计的控制器u有界,因此在自适应律的设计中引入投影算子,确保升力系数估计值有界,故模型参数估计值的相应自适应律和设计为:
上式中Γ1、Γ2、bd、bu和ε均为正实系数,且满足bd≤b≤bu,
本发明的特点及有益效果是:
本发明针对倾转式三旋翼无人机姿态及高度控制,建立了一种以电机转速与尾舵倾角为输入的动力学模型,设计了一种非线性控制器与自适应律,能够有效弥补模型参数不确定性,抵抗飞行过程中的外界不可测扰动。
附图说明:
图1是本发明采用倾转式三旋翼无人机的示意图;
图2采用控制方案后无人机镇定飞行过程的曲线示意图。
a是采用该控制方案后无人机镇定飞行过程的滚转角曲线;
b是采用该控制方案后无人机镇定飞行过程的俯仰角曲线;
c是采用该控制方案后无人机镇定飞行过程的偏航角曲线;
d是采用该控制方案后无人机镇定飞行过程的高度曲线。
具体实施方式
本发明所要解决的技术问题是,针对尾舵倾角可独立控制的倾转式三旋翼无人机,设计一种鲁棒性较好,同时可以弥补动力学***不确定性的自适应律与非线性控制器。
本发明采用的技术方案是:建立一种以电机转速与尾舵倾角为控制输入的动力学模型,并设计相应的自适应律和非线性控制器,包括如下步骤:
首先完成如下定义:定义两个坐标系,分别为惯性坐标系{I}和体坐标系{B}。惯性坐标系{I}原点位于地面,体坐标系{B}原点位于三旋翼无人机的质心,二者均满足右手定则。定义在惯性坐标系下,倾转式三旋翼无人机的姿态角表示为η1=[φ θ ψ]T,其中φ、θ、ψ分别表示该无人机的滚转角,偏航角和俯仰角。在惯性坐标系{I}下,倾转式三旋翼无人机的状态变量向量表示为η2=[φ θ ψ h]T,其中h表示该三旋翼无人机的飞行高度。在惯性坐标系{I}下,倾转式三旋翼无人机目标轨迹定义为ηd=[φd θd ψd hd]T,其中φd、θd、ψd、hd分别表示目标滚转角、俯仰角、偏航角和高度。且该目标轨迹及其关于时间的导数有界。在体坐标系{B}下,倾转式三旋翼无人机,该无人机各姿态通道的角速度表示为Ω。
同时J表示该三旋翼无人机的转动惯量矩阵,j1、j2、j3分别为无人机在滚转、俯仰和偏航通道的转动惯量,表示为:J=diag{j1,j2,j3},Ψ为角速度转换矩阵,其表达式为:
对倾转式三旋翼无人机进行相应的手里分析,利用整体力矩分析的方法建立起以无人机动力矩为控制输入的动力学模型:
其中,τ=[τφ τθ τψ]表示倾转式三旋翼无人机的动力矩,τφ,τφ,τφ分别为无人机滚转、俯仰、偏航通道的动力矩。M表示惯性矩阵,其定义为M=ΨTJΨ为一正定对称矩阵,C表示科里奥利力与向心力矩阵,其定义τd=[τdφ τdθ τdψ]T表示该三旋翼无人机滚转、俯仰、偏航通道上的未知外部扰动力矩。以l1、l2、l3来表示各旋翼到该无人机质心的力臂,c表示反力矩系数,此时倾转式三旋翼无人机的各姿态通道动力矩可以表示为:
另外,以m表示倾转式三旋翼无人机的质量,以g表示重力加速度,通过对倾转式三旋翼无人机在竖直方向上的受力分析,可得以总升力为输入的该无人机高度动力学模型:
上述倾转式三旋翼无人机的动力学模型是以各姿态通道的扭矩以及竖直方向的总升力作为模型的控制输入,为了进一步简化倾转式三旋翼无人机的控制流程,改善控制效果,实现控制该三旋翼无人机电机与尾舵舵机进而直接控制姿态与高度的目的。定义倾转式三旋翼无人机直流无刷电机的转速为ωi,i=1,2,3,4,且电机转速与各旋翼的升力满足关系fi=bω2 i,i=1,2,3,4,其中b表示升力系数。定义控制输入向量u,表示为:
因此,在惯性坐标系{I}下,以u作为控制输入时,倾转式三旋翼无人机姿态与高度通道动力学模型可以表示为:
其中d=[dφ dθ dψ dh]T,dφ、dθ、dψ、dh分别表示各通道受到的外界扰动,q=diag{M-1ΨT,cosφcosθ}。同时为了方便设计自适应律,将升力系数b和反扭矩系数c之积表示为一未知参数r,Φ为一参数矩阵,可以写作:
通常无人机旋翼的升力系数b与反力矩系数c难以测量,在大量的多旋翼无人机研究中将其作为未知常量。本发明通过设计的非线性鲁棒控制器与自适应律,在b和c未知的情况下,通过控制输入u使倾转式三旋翼无人机的姿态与高度收敛于给定的参考轨迹。
为实现倾转式三旋翼无人机姿态与高度的控制目标,定义跟踪误差为:
e=η2-ηd
其中e=[eφ eθ eψ eh]T,eφ、eθ、eψ、eh分别表示滚转角、俯仰角、偏航角和高度的跟踪误差。对e求关于时间的一阶导数和二阶导数,可得:
此处可构造一种滑模面s为:
其中s=[sφ sθ sψ sh]T,sφ、sθ、sψ、sh分别为该三旋翼无人机滚转、俯仰、偏航和高度通道的滑模面,Λ为一正对角常系数矩阵,表示为Λ=diag{λ1,λ2,λ3,λ4},因此可得***动态特性如下式所示:
针对上式得倾转式三旋翼无人机动力学特性,设计控制输入设计u为:
其中,sign为符号函数,为未知参数矩阵Φ的估计,与分别为未知参数b和r的估计,可表示为:
Ki,i=1,2,3,4为对角正系数矩阵,可表示为:
Ki,i=1,2,3,4=diag{ki1,ki2,ki3,ki4}
v为控制器中所设计的一中间向量,定义为v=[vφ vθ vψ vh]T且其一阶导数满足:
当该无人机姿态与高度通道的不可测扰动有界时,扰动力矩和力满足关系τd<|δ1|,δ1为一未知正常数,表示各姿态通道扰动扭矩的上界;δ2为一未知正常数,表示各姿态通道扰动扭矩导数的上界;fd<|δ3|,δ3也为一未知正常数,表示高度通道扰动力的上界,因此上式中的d可表示为:
其中Ρ为一正实对角矩阵,定义为Ρ=diag{ρ1,ρ2,ρ3,ρ4},为后文表述方便,定义一正实对角矩阵表示为为便于参数估计值与的设计,定义中间变量N和L,分别为:
易知参数矩阵非奇异时,所设计的控制器u有界,因此在自适应律的设计中引入投影算子,确保升力系数估计值有界。故模型参数估计值的相应自适应律和可设计为:
上式中Γ1、Γ2、bd、bu和ε均为正实系数,且满足bd≤b≤bu,
针对倾转式三旋翼无人机的鲁棒非线性控制器与自适应律设计完毕。
下面结合实推导和附图对本发明的动力学模型的建立以及非线性控制器与自适应律的设计做以叙述。
本发明综合针对倾转式三旋翼无人机飞行姿态和高度控制问题,为了简化其控制流程,实现对该无人机的直接控制,对传统的多旋翼无人机的动力学模型进行了改造,设计出一种非线性鲁棒控制器与自适应律,可以有效的弥补模型中的参数不确定性,同时又有较强的鲁棒性。
本发明设计了一种倾转式三旋翼无人机的姿态与高度非线性控制器,包括以下步骤:
1)建立倾转式三旋翼无人机相关的坐标系:
为了便于非线性控制器与自适应律的设计,本发明定义了如图1所示的定义
两个坐标系,分别为惯性坐标系{I}和体坐标系{B},二者均满足右手定则。惯性坐标系{I}原点位于地面,体坐标系{B}原点位于三旋翼无人机的质心,{xI yI zI}和{xB yBzB}分别表示惯性坐标系{I}和体坐标系{B}对应的三个主轴。
2)建立以旋翼电机转速与尾舵倾角的倾转式三旋翼无人机动力学模型:
倾转式旋翼无人机的飞行的执行单元,即是其各旋翼电机与尾舵舵机,以各旋翼电机转速与尾舵倾角作为控制输入,使控制方案更为直接简洁,避免了选择控制输入时,其他因素的影响,倾转式三旋翼无人机动力学模型可表示为下式:
其中d=[dφ dθ dψ dh]T,q=diag{M-1ΨT,cosφcosθ},g表示重力加速度,u为该动力学模型的控制输入向量,式中dφ、dθ、dψ、dh分别表示各通道受到的外界扰动,Ψ表示角速度转换矩阵,M表示惯性矩阵,C表示向心力与科里奥利力矩阵。η1=[φ θ ψ]T表示无人机姿态向量,其中φ、θ、ψ分别表示该无人机的滚转角,偏航角和俯仰角,η2=[φ θ ψ h]T表示该三旋翼无人机的状态变量向量,除上述定义的姿态角φ、θ、ψ外,h表示该三旋翼无人机的飞行高度。
3)设计非线性控制器与自适应律
采用上文所述的姿态与高度的动力学模型,设计如图2所设的闭环控制***,且在模型中存在未知常参数升力系数b与反力矩系数c,同时在倾转式三旋翼无人机的飞行过程中,会受到各姿态通道与高度方向的扰动力矩和力,因此所设计的控制器应具有一定的鲁棒性。
可设计控制输入设计u为:
其中,sign为符号函数,为未知参数矩阵Φ的估计,与分别为未知参数b和r的估计,可表示为:
Ki,i=1,2,3,4为对角正系数矩阵,可表示为:
Ki,i=1,2,3,4=diag{ki1,ki2,ki3,ki4}
v为控制器中所设计的一中间向量,可定义v=[vφ vθ vψ vh]T且其关于时间的一阶导数满足关系:
当该无人机姿态与高度通道的不可测扰动有界时,扰动力矩和力满足关系τd<|δ1|,δ1为一未知正常数,表示各姿态通道扰动扭矩的上界;δ2为一未知正常数,表示各姿态通道扰动扭矩导数的上界;fd<|δ3|,δ3也为一未知正常数,表示高度通道扰动力的上界,因此上式中的d可表示为:
其中Ρ为一正实对角矩阵,定义为Ρ=diag{ρ1,ρ2,ρ3,ρ4},可定义一正实对角矩阵表示为为便于参数估计值与的设计,定义中间变量N和L,分别为:
易知参数估计矩阵非奇异时,所设计的控制器u有界,因此在自适应律的设计中引入投影算子,确保升力系数估计值有界。故模型参数估计值的相应自适应律和可设计为:
上式中Γ1、Γ2、bd、bu和ε均为正实系数,且满足bd≤b≤bu,上文中所设计的控制器与自适应律,可使闭环动力学***的误差e及其导数渐进收敛于0。
下面给出具体的实例:
一、半实物仿真平台介绍
本文利用课题组自主搭建的倾转式三旋翼无人机半实物仿真平台验证文中所设计的非线性控制器与自适应律的效果。该平台采用PC/104嵌入式计算机作为处理器,基于MATLABRTW工具箱的xPC***作为半实物仿真的环境,采用自主设计的电路板及惯性测量传感器通过滤波环节获取倾转式三旋翼无人机的姿态角与相应各通道的角加速度,结合无人机的动力学模型及姿态信息,计算出了虚拟的高度信息。实验平台的俯仰角与滚转角测量精度为约为1°,偏航角测量精度约为2°。实验平台***控制频率500Hz。
二、飞行实验结果
为了验证文中所提非线性控制算法与自适应律的有效性与可实现性,在上文所述的半实物实验平台上进行了约120秒倾转式三旋翼无人机的姿态与高度镇定飞行实验。
通过图2a-图2d可知,该三旋翼无人机在实验开始后约17秒实现镇定飞行,滚转角和俯仰角的控制精度在±1°以内,偏航角控制精度在以±2°内;在约后12秒收敛于0附近,镇定飞行后,该三旋翼无人机高度方向上升力维持在4.8N附近。
Claims (1)
1.一种倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法,其特征是,步骤如下:
1)建立倾转式三旋翼无人机相关的坐标系:
为了便于非线性控制器与自适应律的设计,设定如下定义:
两个坐标系,分别为惯性坐标系{I}和体坐标系{B},二者均满足右手定则,惯性坐标系{I}原点位于地面,体坐标系{B}原点位于三旋翼无人机的质心,{xI yI zI}和{xB yB zB}分别表示惯性坐标系{I}和体坐标系{B}对应的三个主轴;
2)建立以旋翼电机转速与尾舵倾角的倾转式三旋翼无人机动力学模型:
倾转式旋翼无人机的飞行的执行单元,即是其各旋翼电机与尾舵舵机,以各旋翼电机转速与尾舵倾角作为控制输入,倾转式三旋翼无人机动力学模型表示为下式:
其中d=[dφ dθ dψ dh]T,q=diag{M-1ΨT,cosφcosθ},g表示重力加速度,u为该动力学模型的控制输入向量,式中dφ、dθ、dψ、dh分别表示各姿态通道受到的外界扰动,Ψ表示角速度转换矩阵,M表示惯性矩阵,C表示向心力与科里奥利力矩阵,η1=[φ θ ψ]T表示无人机姿态向量,其中φ、θ、ψ分别表示该无人机的滚转角,偏航角和俯仰角,η2=[φ θ ψ h]T表示该三旋翼无人机的状态变量向量,h表示该三旋翼无人机的飞行高度;
3)设计非线性控制器与自适应律
采用前述动力学模型时,在模型中存在未知常参数升力系数b与反力矩系数c,同时在倾转式三旋翼无人机的飞行过程中,会受到各姿态通道与高度方向的扰动力矩和力,为实现倾转式三旋翼无人机姿态与高度的控制目标,定义跟踪误差为:
e=η2-ηd
其中e=[eφ eθ eψ eh]T,eφ、eθ、eψ、eh分别表示滚转角、俯仰角、偏航角和高度的跟踪误差,对e求关于时间的一阶导数和二阶导数,可得:
此处可构造一种滑模面s为:
其中ηd=[φd θd ψd hd]T表示该倾转式三旋翼无人机目标轨迹,其中φd、θd、ψd、hd分别表示目标滚转角、俯仰角、偏航角和高度,s=[sφ sθ sψ sh]T,sφ、sθ、sψ、sh分别为该三旋翼无人机滚转、俯仰、偏航和高度通道的滑模面,Λ为一正对角常系数矩阵,表示为Λ=diag{λ1,λ2,λ3,λ4}
设计控制输入向量u为:
其中,sign为符号函数,将升力系数b和反扭矩系数c之积表示为一未知参数r,Φ为一参数矩阵,l1、l2、l3来表示各旋翼到该无人机质心的力臂,m表示倾转式三旋翼无人机的质量,则:
为未知参数矩阵Φ的估计,与分别为未知参数b和r的估计,表示为:
Ki,i=1,2,3,4为对角正系数矩阵,表示为:
Ki,i=1,2,3,4=diag{ki1,ki2,ki3,ki4}
v为控制器中所设计的一中间向量,定义v=[vφ vθ vψ vh]T且满足关系:
当该无人机姿态与高度通道的不可测扰动有界时,各姿态通道的扰动力矩τd和高度通道的绕动力fd满足关系τd<|δ1|,δ1为一未知正常数,表示各姿态通道扰动扭矩的上界;δ2为一未知正常数,表示各姿态通道扰动扭矩导数的上界;fd<|δ3|,δ3也为一未知正常数,表示高度通道扰动力的上界;
d=|Ρ|s,Ρ≤δ1,
其中Ρ为一正实对角矩阵,定义为Ρ=diag{ρ1,ρ2,ρ3,ρ4},定义一正实对角矩阵表示为为便于参数估计值与的设计,定义中间变量N和L,并定义该三旋翼无人机的转动惯量为J=diag{j1,j2,j3},j1、j2、j3分别为无人机在滚转、俯仰和偏航通道的转动惯量,则有以下关系成立:
参数矩阵非奇异时,所设计的控制器u有界,因此在自适应律的设计中引入投影算子,确保升力系数估计值有界,故模型参数估计值的相应自适应律和设计为:
上式中Γ1、Γ2、bd、bu和ε均为正实系数,且满足bd≤b≤bu,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611032392.5A CN106647783B (zh) | 2016-11-22 | 2016-11-22 | 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611032392.5A CN106647783B (zh) | 2016-11-22 | 2016-11-22 | 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106647783A CN106647783A (zh) | 2017-05-10 |
CN106647783B true CN106647783B (zh) | 2019-07-16 |
Family
ID=58808729
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611032392.5A Expired - Fee Related CN106647783B (zh) | 2016-11-22 | 2016-11-22 | 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106647783B (zh) |
Families Citing this family (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109407692A (zh) * | 2017-08-17 | 2019-03-01 | 西安羚控电子科技有限公司 | 倾转垂直起降固定翼无人机旋翼模式下偏航控制方法 |
CN107479567B (zh) * | 2017-09-13 | 2018-10-30 | 山东大学 | 动态特性未知的四旋翼无人机姿态控制器及方法 |
CN107992069B (zh) * | 2017-11-29 | 2021-01-19 | 上海无线电设备研究所 | 一种无人机路径跟踪控制的制导律设计方法 |
CN108020226B (zh) * | 2017-12-11 | 2021-05-18 | 中国科学院长春光学精密机械与物理研究所 | 一种固定翼无人机自主避障的航迹规划方法 |
CN107977011B (zh) * | 2017-12-26 | 2020-03-24 | 电子科技大学 | 基于分数阶控制算法的四旋翼无人机飞行控制方法 |
CN108445895B (zh) * | 2018-02-05 | 2021-01-29 | 天津大学 | 用于倾转式三旋翼无人机位置控制的鲁棒控制方法 |
CN108427432B (zh) * | 2018-05-25 | 2023-06-23 | 福州大学 | 一种非平面式三旋翼飞行器及控制方法 |
CN109116860B (zh) * | 2018-08-29 | 2022-05-03 | 天津大学 | 三旋翼无人机的非线性鲁棒控制方法 |
CN109542110B (zh) * | 2018-09-10 | 2021-04-02 | 哈尔滨工业大学 | 涵道式多旋翼系留无人机的控制器设计方法 |
CN109358645B (zh) * | 2018-11-19 | 2021-07-06 | 南京航空航天大学 | 一种小型舰载无人机自适应绳钩回收制导航路及制导方法 |
CN110058600B (zh) * | 2019-02-26 | 2022-01-14 | 天津大学 | 三旋翼无人机舵机堵塞故障下位姿***的容错控制方法 |
CN109976367A (zh) * | 2019-03-27 | 2019-07-05 | 天津大学 | 针对倾转式三旋翼无人机的姿态***控制方法 |
CN110244754B (zh) * | 2019-06-28 | 2021-12-10 | 上海工程技术大学 | 一种用于平流层浮空器定点驻空的控制***及方法 |
CN112650270A (zh) * | 2019-10-11 | 2021-04-13 | 天津工业大学 | 一种应用在无人机上的运动模型与模型辨识技术 |
CN110989640B (zh) * | 2019-10-24 | 2022-07-08 | 深圳市道通智能航空技术股份有限公司 | 一种飞行控制方法、飞行器及飞行*** |
CN110824925A (zh) * | 2019-11-29 | 2020-02-21 | 天津大学 | 倾转式三旋翼无人机的自适应鲁棒容错控制方法 |
CN111319759B (zh) * | 2020-02-25 | 2023-09-22 | 江苏理工学院 | 一种空间六自由度独立可控多旋翼无人飞行控制方法 |
CN111522356B (zh) * | 2020-03-27 | 2021-06-04 | 北京航空航天大学 | 一种倾转旋翼无人机强鲁棒全包线一体化控制方法 |
WO2021223169A1 (zh) * | 2020-05-07 | 2021-11-11 | 深圳市大疆创新科技有限公司 | 无人机的动力输出检测方法和设备 |
CN111722634B (zh) * | 2020-05-28 | 2022-09-23 | 南京邮电大学 | 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 |
CN113955113B (zh) * | 2021-11-23 | 2022-12-13 | 福州大学 | 一种适合高速运行的微型飞行器及控制方法 |
CN114488816B (zh) * | 2022-01-27 | 2023-03-24 | 浙江蓝盒子航空科技有限公司 | 一种旋转翼-倾斜混合式无人机非线性模型预测控制方法 |
CN115840367B (zh) * | 2022-12-21 | 2024-04-09 | 南通大学 | 受扰四旋翼无人机姿态与高度***的非线性鲁棒控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103760905A (zh) * | 2014-01-29 | 2014-04-30 | 天津大学 | 基于模糊前馈单旋翼无人直升机姿态非线性鲁棒控制方法 |
CN104044734A (zh) * | 2014-06-20 | 2014-09-17 | 中国科学院合肥物质科学研究院 | 具有可倾斜机翼和旋翼的多旋翼无人机及控制***和方法 |
CN104898429A (zh) * | 2015-05-27 | 2015-09-09 | 北京工业大学 | 一种基于自抗扰控制的三旋翼姿态控制方法 |
CN104950901A (zh) * | 2015-07-03 | 2015-09-30 | 天津大学 | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 |
CN105353762A (zh) * | 2015-09-25 | 2016-02-24 | 南京航空航天大学 | 基于双余度姿态传感器的六旋翼无人机及其控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9625913B2 (en) * | 2014-12-09 | 2017-04-18 | Embry-Riddle Aeronautical University, Inc. | System and method for robust nonlinear regulation control of unmanned aerial vehicles synthetic jet actuators |
-
2016
- 2016-11-22 CN CN201611032392.5A patent/CN106647783B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103760905A (zh) * | 2014-01-29 | 2014-04-30 | 天津大学 | 基于模糊前馈单旋翼无人直升机姿态非线性鲁棒控制方法 |
CN104044734A (zh) * | 2014-06-20 | 2014-09-17 | 中国科学院合肥物质科学研究院 | 具有可倾斜机翼和旋翼的多旋翼无人机及控制***和方法 |
CN104898429A (zh) * | 2015-05-27 | 2015-09-09 | 北京工业大学 | 一种基于自抗扰控制的三旋翼姿态控制方法 |
CN104950901A (zh) * | 2015-07-03 | 2015-09-30 | 天津大学 | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 |
CN105353762A (zh) * | 2015-09-25 | 2016-02-24 | 南京航空航天大学 | 基于双余度姿态传感器的六旋翼无人机及其控制方法 |
Non-Patent Citations (1)
Title |
---|
三旋翼构型倾转旋翼无人机建模与悬停控制研究;王海洋 等;《电光与控制》;20151031;第22卷(第10期);第51-55页 |
Also Published As
Publication number | Publication date |
---|---|
CN106647783A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106647783B (zh) | 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 | |
Bapst et al. | Design and implementation of an unmanned tail-sitter | |
CN108445895A (zh) | 用于倾转式三旋翼无人机位置控制的鲁棒控制方法 | |
CN104460681B (zh) | 倾转旋翼无人直升机过渡段的飞行控制方法 | |
Lozano | Unmanned aerial vehicles: Embedded control | |
CN106155076B (zh) | 一种多旋翼无人飞行器的稳定飞行控制方法 | |
CN109614633A (zh) | 一种复合式旋翼飞行器非线性建模方法及配平方法 | |
CN109116860A (zh) | 三旋翼无人机的非线性鲁棒控制方法 | |
Lu et al. | Real-time simulation system for UAV based on Matlab/Simulink | |
CN107479567A (zh) | 动态特性未知的四旋翼无人机姿态控制器及方法 | |
CN108803639A (zh) | 一种基于反步法的四旋翼飞行器飞行控制方法 | |
CN104932514B (zh) | 小型无人直升机的姿态非线性自适应控制方法 | |
CN103365296A (zh) | 一种四旋翼无人飞行器非线性输出反馈飞行控制方法 | |
CN103869817A (zh) | 一种倾转四旋翼无人机垂直起降控制方法 | |
CN104950901A (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
CN106406325A (zh) | 基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法 | |
CN105242679A (zh) | 一种四旋翼飞行器的控制***设计方法 | |
Jung et al. | A comprehensive flight control design and experiment of a tail-sitter UAV | |
Bulka et al. | Autonomous fixed-wing aerobatics: From theory to flight | |
Yu et al. | Design and Implementation of a Hardware‐in‐the‐Loop Simulation System for a Tilt Trirotor UAV | |
Cai et al. | Comprehensive nonlinear modeling of a miniature unmanned helicopter | |
Xia et al. | Transition flight control and simulation of a novel tail-sitter UAV with varying fuselage shape | |
Zawiski et al. | Modelling and optimal control system design for quadrotor platform–an extended approach | |
Derafa et al. | Non-linear control algorithm for the four rotors UAV attitude tracking problem | |
Xu et al. | Modelling and hovering control of a novel multi-tandem ducted fan vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
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: 20190716 |