CN109062242B - 一种新的旋翼无人机控制方法 - Google Patents
一种新的旋翼无人机控制方法 Download PDFInfo
- Publication number
- CN109062242B CN109062242B CN201811246888.1A CN201811246888A CN109062242B CN 109062242 B CN109062242 B CN 109062242B CN 201811246888 A CN201811246888 A CN 201811246888A CN 109062242 B CN109062242 B CN 109062242B
- Authority
- CN
- China
- Prior art keywords
- control
- unmanned aerial
- aerial vehicle
- equation
- angle
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 239000011159 matrix material Substances 0.000 claims description 19
- 238000013461 design Methods 0.000 claims description 13
- 238000013178 mathematical model Methods 0.000 claims description 12
- 238000013016 damping Methods 0.000 abstract description 11
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 238000005312 nonlinear dynamic Methods 0.000 abstract description 2
- 238000004088 simulation Methods 0.000 description 29
- 230000003044 adaptive effect Effects 0.000 description 11
- 238000004422 calculation algorithm Methods 0.000 description 11
- 238000004364 calculation method Methods 0.000 description 10
- 230000004044 response Effects 0.000 description 10
- 230000008859 change Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 9
- 230000000694 effects Effects 0.000 description 6
- 238000011160 research Methods 0.000 description 6
- 238000004458 analytical method Methods 0.000 description 5
- 230000008878 coupling Effects 0.000 description 4
- 238000010168 coupling process Methods 0.000 description 4
- 238000005859 coupling reaction Methods 0.000 description 4
- 238000012360 testing method Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 3
- 238000001179 sorption measurement Methods 0.000 description 3
- 230000006641 stabilisation Effects 0.000 description 2
- 238000011105 stabilization Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009472 formulation Methods 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
Images
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
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Algebra (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明属于旋翼无人机控制方法。本发明的主要目的在,对旋翼无人机的控制中,提出了状态阻尼控制,用于控制RUAV的姿态。在充分考虑RUAV质量不对称性的基础上,建立了RUAV非线性动力学模型,结合状态阻尼控制得到控制律。本发明的有益效果为,为旋翼无人机的控制提出了一种新的控制方法,即在控制中引入了状态阻尼控制,从而实现控制精度高、鲁棒性好。
Description
技术领域
本发明属于旋翼无人机控制方法。
背景技术
无人机(UAV)已经成为一个热词,不仅是展现一个国家军事实力的方式,也逐渐成为人们记录生活、享受生活的载体。旋翼无人机由于其操作简单、可垂直起降、悬停性能好,在民用领域比固定翼无人机占据更加广阔的市场。PID控制器因其算法简单,不依赖于***模型,在旋翼无人机控制中应用最为成功且最为广泛。
旋翼无人机(RUAV)质量轻,搭载微控计算机计算能力有限,具有强耦合的非线性动力学学特性,精细建模困难。RUAV控制对于算法的要求主要包括三个方面:鲁棒性好、控制精度高、算法简单。PID算法简单,能够满足一般的RUAV控制要求,可是在复杂环境或者质量变化的情况下其鲁棒性有待提高。对于单个RUAV控制的研究,目前主要集中在控制精度和鲁棒性的提升上,而在致力于使算法简单,便于实现上研究甚少。
滑模控制在RUAV控制中的应用是一个研究热点,它用于控制非线性***具有极好的鲁棒性,能够适应RUAV本身和环境的不确定性。“DEFOORT M,FLOQUET T,KOKOSY A,etal.A novel higher order sliding mode control scheme[J].Systems&ControlLetters,2009,58(2):102-8”提出了一种高阶滑模控制方法,使用该方法***抵抗不确定性的鲁棒性能够被保证,参数设计也可以通过理论计算。然而如果将该方法用于RUAV控制面临两个困难:需要在确切数学模型已知的情况下进行参数公式化设计,而RUAV许多固定的参数通常是难以获得的;控制律计算涉及到众多复杂矩阵、分式幂、导数运算,计算量过大,难以在嵌入式***中实时实现。“PEROZZI G,EFIMOV D,BIANNIC J M,etal.Trajectory tracking for a quadrotor under wind perturbations:sliding modecontrol with state-dependent gains[J].Journal of the Franklin Institute-Engineering and Applied Mathematics,2018,355(12):4809-38”在考虑风场扰动和转子动态特性的基础上设计了四旋翼无人机一阶滑模控制和准连续高阶滑模控制器,并且通过***明了其有效性。然而该研究中没有考虑RUAV质量的不对称性,而且只是在悬停模式将模型大大简化来设计控制率,即便这样简化之后所设计的控制律依然很复杂。
“WANG R,LIU J.Adaptive formation control of quadrotor unmanned aerialvehicles with bounded control thrust[J].Chinese Journal of Aeronautics,2017,30(2):807-17”、“ALI Z A,WANG D B,AAMIR M.Fuzzy-Based Hybrid Control Algorithmfor the Stabilization of a Tri-Rotor UAV[J].Sensors,2016,16(5)”模型参考自适应控制利用参考模型和真实***状态误差或输出误差,通过自适应机构生成参数调节信号或者辅助控制信号,能够使***能够适应自身或者环境的变化。在RUAV的控制中,模型参考自适应极大的提高了RUAV的鲁棒性,特别是当***发生严重错误,如桨叶损坏、电机故障,还能够保证一定的飞行能力。“I.Sadeghzadeh,A.Mehta,and Y.Zhang,“Fault/damagetolerant control of a quadrotor helicopter UAV using model reference adaptivecontroland gain-scheduled PID,”in Proc.AIAA Guid.,Navigat.,Control Conf.,Portland,OR,2011,pp.1–20”使用MIT规则设计了高度通道模型参考自适应***,该设计只考虑高度通道的自适应,因而算法较为简单。MIT规则并不能保证所设计的***是稳定的,为从理论上说明***是稳定还需使用控制理论的稳定性判据分析。如果要在RUAV的姿态和高度都设计成自适应控制,那么MIT规则将不再适用。“DYDEK Z T,ANNASWAMY A M,LAVRETSKY E.Adaptive Control of Quadrotor UAVs:A Design Trade Study WithFlight Evaluations[J].Ieee Transactions on Control Systems Technology,2013,21(4):1400-6”使用李雅普诺夫稳定性理论设计了四旋翼无人机高度和姿态模型参考自适应控制***,实现了RUAV控制***强大的容错能力。该***的设计存在两个主要的局限性:假设了***处于悬停的小角度模式,适应的实际场合狭隘;使用了地面辅助计算机进行自适应控制的计算,不能实际野外飞行。“ZEGHLACHE S,MEKKI H,BOUGUERRA A,et al.Actuatorfault tolerant control using adaptive RBFNN fuzzy sliding mode controller forcoaxial octorotor UAV[J].ISA transactions,2018”使用人工神经网络,设计了模糊自适应滑模控制器用于控制八旋翼无人机,从仿真结果来看控制效果非常好。然而存在的局限性就是算法复杂,难以在嵌入式***上实现。
上述RUAV控制方法都存在计算复杂,难以在嵌入式***实现的问题。而且在理论分析过程中,使用的RUAV数学模型作了过强的假设,与实际情况有出入。
发明内容
本发明的目的在于针对上述问题,提出一种简单,鲁棒性优良的控制方法,并且充分从实际情况出发。
本发明的技术方案为:
一种新的旋翼无人机控制方法,其特征在于,包括以下步骤:
S1、建立旋翼无人机状态空间模型,具体包括:
S11、建立坐标系:
1)地心惯性系i系:原点与地球质心重合,x轴的方向从地球质心指向春分点,z轴指向协议地理北极,x、y、z轴构成右手螺旋关系;
2)导航坐标系n系:原点位于载体质心,x轴指向东向,y指向北向,z轴指向天向;
3)载体坐标系b系:原点位于载体质心,y指向前进方向,x轴指向前进方向右侧,x、y、z轴构成右手螺旋关系;
S12、采用欧拉角法对无人机姿态进行描述,即用三个欧拉角来描述:偏航角Y、俯仰角P、滚转角R;定义姿态微分方程为:
其中,[ωx ωy ωz]T为无人机在惯性空间转动的角速度在b系中的投影,角速度通过陀螺仪测量;
S13、根据动量定理和姿态微分方程,建立旋翼无人机状态空间模型为:
其中,
Fx,Fy,Fz,Mx,My,Mz为载体在惯性坐标系中所受到的合力在b系中各个轴向的投影,转动惯量矩阵J是一个常量,b系中的转动惯量矩阵为:
[vx vy vz ωx ωy ωz]T代表选取的状态变量,表示载体速度和角速度在b系中各个轴向的投影;
S2、设定只考虑姿态控制,即选取旋翼无人机状态空间模型中角速度方程为被控制对象的数学模型,记为S***,S的输出值为偏航角、俯仰角、滚转角:
S状态方程:
S输出方程:
将问题定义为如何设计控制律,即Mx,My,Mz,使得S***的输出角度值达到期望的值;
S3、设定由于空气阻力而产生的阻力矩为:
其中,Fa为空气阻力,C1、C2是正常数,R为目标长度,z1、z2是待调参数;
S4、根据空气阻力矩模型,建立控制律为:
通过设定参数z1、z2的值,实现对旋翼无人机的控制。
本发明的有益效果为,为旋翼无人机的控制提出了一种新的控制方法,即在控制中引入了状态阻尼控制(空气阻力),从而实现控制精度高、鲁棒性好。
附图说明
图1是坐标***示意图;
图2是空气阻力估计模型示意图;
图3是参数c对近似符号函数的影响示意图;
图4是不同k值***稳定性仿真示意图;
图5是不同z1,z2值***稳定性仿真示意图;
图6是跟踪方波仿真示意图;
图7是扰动抑制鲁棒性仿真示意图;
图8是z1过大时***鲁棒性降低仿真示意图;
图9是转动惯量矩阵变化仿真示意图。
具体实施方式
下面结合附图和实施例,对本发明进行详细的说明。
本发明的方案中,将RUAV视为一个质量近似对称但又不完全对称刚体,基于向量恒等式、动量定理、角动量定理推导RUAV动力学方程。在推导过程中***受到的力记为合外力的形式,空气阻力、推力都只是所受合外力的一部分。为了便于运用现代控制进行理论分析和仿真试验,将所推导的方程化为状态空间描述的形式,并给出基于泰勒级数的线性化方法。
如图1所示,建立状态空间描述数学模型,涉及到三个个坐标系,地心惯性系、导航坐标系和载体坐标系。
地心惯性系(i系):原点与地球质心重合x轴的方向从地球质心指向春分点,z轴指向协议地理北极,x、y、z轴构成右手螺旋关系。春分点不会因为地球自转而移动。
导航坐标系(n系):又称东北天坐标系,原点位于载体质心,x轴指向东向,y指向北向,z轴指向天向。
载体坐标系(b系):原点位于载体质心,y指向前进方向,x轴指向前进方向右侧,x、y、z轴构成右手螺旋关系。将y指向前进方向,是为了与航向的通常定义相吻合。载体轴指向真北时航向角为0°,若此时载体没有发生倾斜,则载体坐标系和当地导航坐标系重合。
本发明采用欧拉角法对无人机姿态进行描述,并设定RUAV的俯仰角和滚转角小于90°,根据该设定欧拉角法不会出现奇异的情况。
欧拉角描述是基于任何一个空间笛卡尔坐标系,可以经过绕其轴的三次旋转而与空间任意坐标系重合。RUAV的姿态可用三个欧拉角来描述,偏航角(Y)、俯仰角(P)、滚转角(R)。欧拉角是有顺序的,只有先进行偏航旋转,再进行俯仰旋转,最后进行滚转旋转,才能保证RUAV机体的轴线与水平面的夹角就是俯仰角。
RUAV是利用陀螺仪测得的角速度,通过求解姿态微分方程解算欧拉角的。
设定陀螺仪的测量值即是RUAV相对于惯性坐标系转动的角速度。
于是姿态微分方程可写为:
(2)式中[ωx ωy ωz]T为无人机在惯性空间转动的角速度在b系中的投影,可以通过陀螺仪测量。
建立数学模型:
引理1:向量恒等式,b系在i系中以角速度ω旋转,则对于任意向量A,满足式(3),式(3)中的等号是等价的意思而不是数值上相等。
引理2:动量定理,物体所受冲量等于其动量的变化量
Fdt=d(mv) (4)
引理3:角动量定理物体所受冲量矩等于其角动量的变化量,J表示转动惯量
Mdt=d(Jω) (5)
由式(1)、(3)可得:
(4)式表示将转动方程投影在b系中,这样使得转动惯量矩阵J是一个常量。b系中的转动惯量矩阵写成如下形式:
设定转动惯量矩阵J对角线以外的元素是小量,则当两个或两个以上J对角线以外的元素相乘时可以略去。
综合式(2)、(4)式可得:
其中,
Fx,Fy,Fz,Mx,My,Mz为载体在惯性坐标系中所受到的合力在b系中各个轴向的投影。
[vx vy vz ωx ωy ωz]T代表选取的状态变量,表示载体速度和角速度在b系中各个轴向的投影。
(8)式即是建立的RUAV数学模型,相对于当前研究中常使用的数学模型有如下几个特征:
1)合理考虑了RUAV质量的不对称性,更加符合实际情况;
2)写成状态空间描述的形式,便于使用现代控制理论进行分析,便于在仿真时实现矩阵化编程;
3)充分考虑了RUAV各个转动轴之间的耦合,为实现更高精度的控制提供模型基础。
在(8)式中建立方程为非线性微分方程组,在仿真和设置参考模型时难于使用。为此需要将(8)式线性化,并写成矩阵形式。
在点[vx0 vy0 vz0 ωx0 ωy0 ωz0]T处展开成一阶泰勒级数。得到***矩阵A和B。四旋翼无人机的数学模型可写为:
选取u=[Fx/m Fy/m Fz/m Mx My Mz]T,可得:
值得说明的是,在仿真或者设计参考模型时,点[vx0 vy0 vz0 ωx0 ωy0 ωz0]T是一个可以随时间变化的点。这样(8)式表示的非线性***就转化为了(9)式表示的线性时变***。在计算机中表示一个非线性***是困难的,而表示一个线性时变***是容易的,只需要按时更新参数即可。
通过(8)式可以看出,RUAV***耦合最强的是角速度。角速度通过(2)式决定RUAV的三个姿态角,所以姿态角的控制具有非线性和强耦合性,是RUAV控制的难点。姿态角又直接影响着RUAV前进的方向和前进的速度,是RUAV最核心的部分,因此本发明只关注姿态的控制。
由于只考虑姿态控制,所以(8)式第4、5、6个方程即为被控制对象的数学模型,记为S***。S的输出值为偏航角、俯仰角、滚转角,输出方程为式(2)。
S状态方程:
S输出方程:
需要解决的问题是如何设计控制律,即Mx,My,Mz,使得S***的输出角度值达到期望的值。
本发明中提出“空气阻力的存在有利于RUAV姿态***S的稳定”,因此额外的空气阻力,就等同于用于控制姿态的控制律的一部分。
为了获取空气阻力模型,使用一个非常简单的模型来估计空气阻力。如图2所示,一块长为R,高为l的平板以角速度ω作定轴转动。平板的前侧需排开空气,会受到一个反作用力记为Ff,平板的后侧由于空气的吸附作用会受到吸附力Fb。
吸附力Fb可以近似看成一个静摩檫力:
Fb=C2sign(ω)
C2是一个正常数,sign为符号函数。
不妨设空气的密度为ρ,则Ff可由动量定理估计
C1是一个正常数。
得空气阻力Fa
Fa=Fb+Ff=C1ω2sign(ω)+C2sign(ω)
在实际过程中,更加关心的是由于空气阻力而产生的阻力矩,下面将写成阻力矩的形式
为了将真实的空气阻力矩和为得到控制律而引入的虚加的空气阻力矩进行对比,现对估算Z1的值。
假设R=l=0.45m,ρ=1.2kg/m3
那么
Z1不带单位,使用时其它量应统一为国际单位制形式。
(11)式即为所得到的空气阻力矩模型,类比该模型引入如下控制律,来使***S状态方程稳定,z1、z2是待调参数。
(13)式中右边后一项形式可能不会出现在通常阻力模型中[9],然而对于控制律来说这一项是非常重要的。在S***的控制中当输出的角度值接近期望值时,角速度ω很小,那么us中前一项将几乎不起作用,这样***就要在平衡位置附近花费很长的时间振动才能达到期望的平衡点。而引入后一项之后,即便ω很小,仍有较大的控制来使S***快速达到平衡状态。
所引入的控制律中包含两个符号函数sign,当***的状态接***衡态时,符号函数的正负频繁切换,那么可以预见所设计的控制器会像滑模控制那样出现颤振。所以借鉴滑模控制消除颤振的方法,来解决状态阻尼控制中出现的类似的问题。引用文献“HallimAlwi,Christopher Edwards,Chee Pin Tan,Fault Detection and Fault tolerantControl Using Sliding Modes[M]National Defense Industry Press,2014.6”中的方法,即使用一个平滑函数来代替原本的符号函数,仍记为sign,如式(14)所示:
其中c为正的常数。由图3可以看出,当c=0.001时对符号函数的近似较好,且在x值在零附近较平滑,因此本发明所选的c=0.001。
状态阻尼控制即是形如(13)那样的方式引入控制律。(13)式中只引入了两个可调参数,并且角速度ω可以取陀螺仪的测量值,因此算法是非常简洁的。需要说明的是,当前引入的控制律只是为了使S***状态方程稳定,要使S***能够输出期望的角度值,还需做修正。
记俯仰角(P)、滚转角(R)、偏航角(Y)实际值与期望值的误差为[ex ey ez]T。
则用于控制整个S***的控制律为
考虑S状态方程的稳定性时,使用控制律us。进行整个S***仿真,看S***能否输出期望角度时,使用控制律u。
根据本发明的方案,需要确定的是如何选定z1、z2能使***渐进稳定。针对该问题本发明给出以下示意:
使用克拉索夫斯基定理来分析这个问题。
克拉索夫斯基定理表述:
定义:
对连续时间非线性时不变***和围绕原点平衡状态的一个区域Ω∈Rn,原点x=0为域Ω内唯一的平衡点,若FT(x)+F(x)<0即为负定,则***平衡态x=0为域Ω内渐近稳定的。
设定x=0是上述自治***唯一的零点,依据设定,只要z1、z2的选取能使FT(x)+F(x)负定,那么***状态方程是渐进稳定的。
由图1可知,sign函数的导数具有对称性,为了简化表达,在求取sign函数的导数时可以认为x>0。
记
令
由(10)、(13)、(14)、(16)式得
令W=FT(x)+F(x)
设定矩阵-W满足如下条件:
①主对角线的元素大于零;
②-W严格对角占优。
通过以上两条规则,限定角速度的取值范围,即可估计z1,z2的值。
本发明还给出如何仿真一个线性时变***的如下说明:
对于下式所表述的***,***矩阵A是一个时变矩阵,然而在仿真过程中总是一步一步计算的,在每一步中可以认为***参数是没有发生变化的。那么在一步计算中就可以当成线性***来处理。
x=[ωx ωy ωz]T,u=[Mx My Mz]T
根据线性***理论,***的解可以表示成如下形式:
转化为离散***形式,考虑时间t只能取为T的整数倍,取T为典型的RUAV主循环时间间隔,T=0.01s。
x(k+1)=eATx(k)+TeATBu(k) (20)
由于采样时间间隔T取得足够小,所以AT是一个小量,在本发明中将eAT展开成二阶泰勒级数,就具有很高的仿真精度了。即:
至此一步计算就可以完成,完成一步计算之后,利用式(9)刷新矩阵A即可进入下一步的计算。这就是本发明提出的对线性时变***的仿真方法。
实施例
本例中假设质量m=1.373kg
Jx=0.10125kg·m2,Jy=0.10203kg·m2,Jz=0.14374kg·m2
Jxy=0.00217kg·m2,Jyz=0.00153kg·m2,Jzx=0.00030kg·m2
可得参数为:
表1参数计算表(kg·m2)
根据(18)式和定理1,确定使S***状态方程稳定的参数z1,z2。
由于Jz在转动惯量各个元素中最大,所以在确定z1,z2时,-W33严格对角占优条件将起决定性作用。
设三个方向角速度的最大值为10rad/s。
记
式(22)条件满足即可保证S***状态方程稳定。
通过式(22)、(23)来估计z1,z2的范围。从(23)式可知当ωz值很小时,式(23)前两项很小可以忽略,当ωz很大时式(23)后两项可以忽略,这种忽略总是保守的。而且假设ωz>0不会影响结果的估计。
当ωz≥1rad/s
将|ωx|、|ωy|取为最大角速度值10rad/s
可以估计出z1>0.19。z1不宜取过大,否则(22)式将不满足,z1上界值难以估计,只能通过仿真去测试。
当ωz≤0.01rad/s
可以估计出z2>0.05,z2取大一些会利于式(22)满足。
因而通过z1,z2参数的估计,可以知道这两个参数对于***稳定性的影响:z1的值可由式(22)估计下界,z1不宜取过大,否则***会失去稳定性;z2的值可由式(22)估计下界,z2取大不会使***失去稳定性。
使用(13)式所确定的控制律,对S***能否输出期望角度进行仿真。首先随意选取几个比例参数k,看能否使得***稳定。然后调整k,z1,z2的值,优化***性能,根据对z1,z2参数的估计,取z1=0.2,z2=0.1。取参数k分别为0.1,1,5,20。S***0初始条件,输入信号为单位阶跃信号,单位阶跃信号(相当于53°)的输入通道为俯仰角通道,其余两个通道输入为0。仿真时间100s,即10000步。
从图4中俯仰角和滚转角的图可以看到不同比例k值对于S***角度响应影响的细节。偏航角图可以证明***在整个仿真过程中都是稳定的。因此通过***明了式(15)所提控制律的有效性,以及本发明对参数估计是可靠的。
为了优化S***的动态响应性能,需要进一步调整k,z1,z2值。从图4俯仰角图,可知道k值越大,S***响应速度越快,超调量也会增加。而且k值太小存在较大的稳态误差。不妨选定k=5,分别调整z1,z2的值观察S***俯仰角响应。
情况一:取定k=5,z2=0.1,变化z1分别取0.2、0.5、0.8、1.0;
情况二:取定k=5,z1=0.5,变化z2分别取0.1、0.5、1.0、5.0;
由图5可知,当k=5,z1=0.5,z2=0.5时,控制效果最佳。S***响应快,没有超调,控制精度极高。不论是增加z1、还是增加z2,都会使***的响应速度变慢。
为了体现k=5,z1=0.5,z2=0.5良好的控制效果,做一次方波测试,方波的周期为400步,也就是每隔200步跳变一次。仿真结果如图6所示。
根据上述内容,可以得出参数调整规律为:
1)估计出来的z1,z2是有效的,但不是最优的。
2)增大k值使***响应速度加快,但会增加超调量。
3)增大z1,z2会减小超调量,但是会减慢***响应。
总的来说参数的调整具有单调性,即将参数往一个方向调整时,***响应就往对应的方向变化。
鲁棒性检验
鲁棒性检验是指,所设计***干扰抑制性能和适应***参数变化的能力。这里假设两个仿真场景,一个是受到脉动风影响突然获得一个角速度,另一个是***转动惯量矩阵发生变化。
情况1:对受到脉动风影响获得的角速度分别为-15、-5、5、15rad/s。
仿真的方法是首先在俯仰角通道加一个单位阶跃信号,等仿真到300步,然后在俯仰、滚转、偏航三个通道都加上受脉动风影响的等效角速度。参数设置为k=5,z1=0.5,z2=0.5。
从图7可知,***具备抵抗较大扰动的能力。不过受到扰动之后,S***会产生一个较大的误动作。主要原因是,***抵抗这类扰动需要等误差形成后才做出反应,这也是算法需要改进的地方。
当z1过大时***鲁棒性降低。参数设置为k=5,z1=2,z2=0.5。在仿真到300步,施加15rad/s,这时***将失去稳定。
由图8可知,当z1过大时,S***不再能抵抗15rad/s以上的扰动。
情况2:转动惯量矩阵发生变化,Jx取0.050625、0.10125、0.151875、0.2025kg·m2。其它转动惯量矩阵元素不发生变化。参数设置为k=5,z1=0.5,z2=0.5。俯仰角通道输入单位阶跃信号,其它通道输入为0。
图9证明了算法对于转动惯量矩阵变化的鲁棒性。同时,可以看出当往一个方向调整转动惯量矩阵元素,***性能也往一个方向运动
同时上述实施例及仿真示意,验证了状态阻尼控制对于扰动和转动惯量变化的鲁棒性。
综上可得,本发明所提出的新的控制方法,叫做状态阻尼控制,用于控制RUAV的姿态。在充分考虑RUAV质量不对称性的基础上,建立了RUAV非线性动力学模型,并将其线性化用于理论分析和仿真。使用这个模型,运用克拉索夫斯基定理,分析了怎样选择状态阻尼控制的参数能够保证***的稳定,给出了参数对***性能影响规律的表述。最后通过仿真,验证了使用克拉索夫斯基定理估计的状态阻尼控制参数是有效的,状态阻尼控制能够使姿态***输出期望的角度值。进行参数调优后,可以实现无超调的快速响应,并且通过仿真验证了调优后的参数具有抵抗外部扰动,适应内部参数变化的鲁棒性。
Claims (1)
1.一种新的旋翼无人机控制方法,其特征在于,包括以下步骤:
S1、建立旋翼无人机状态空间模型,具体包括:
S11、建立坐标系:
1)地心惯性系i系:原点与地球质心重合,x轴的方向从地球质心指向春分点,z轴指向协议地理北极,x、y、z轴构成右手螺旋关系;
2)导航坐标系n系:原点位于载体质心,x轴指向东向,y指向北向,z轴指向天向;
3)载体坐标系b系:原点位于载体质心,y指向前进方向,x轴指向前进方向右侧,x、y、z轴构成右手螺旋关系;
S12、采用欧拉角法对无人机姿态进行描述,即用三个欧拉角来描述:偏航角Y、俯仰角P、滚转角R;定义姿态微分方程为:
其中,[ωx ωy ωz]T为无人机在惯性空间转动的角速度在b系中的投影,角速度通过陀螺仪测量;
S13、根据动量定理和姿态微分方程,建立旋翼无人机状态空间模型为:
其中,
Fx,Fy,Fz,Mx,My,Mz为载体在惯性坐标系中所受到的合力在b系中各个轴向的投影,转动惯量矩阵J是一个常量,b系中的转动惯量矩阵为:
[vx vy vz ωx ωy ωz]T代表选取的状态变量,表示载体速度和角速度在b系中各个轴向的投影;
S2、设定只考虑姿态控制,即选取旋翼无人机状态空间模型中角速度方程为被控制对象的数学模型,记为S***,S的输出值为偏航角、俯仰角、滚转角:
S状态方程:
S输出方程:
将问题定义为如何设计控制律,即Mx,My,Mz,使得S***的输出角度值达到期望的值;
S3、设定由于空气阻力而产生的阻力矩为:
其中,Fa为空气阻力,C1、C2是正常数,R为目标长度,z1、z2是待调参数;
S4、根据空气阻力矩模型,建立控制律为:
通过设定参数z1、z2的值,实现对旋翼无人机的控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811246888.1A CN109062242B (zh) | 2018-10-25 | 2018-10-25 | 一种新的旋翼无人机控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811246888.1A CN109062242B (zh) | 2018-10-25 | 2018-10-25 | 一种新的旋翼无人机控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109062242A CN109062242A (zh) | 2018-12-21 |
CN109062242B true CN109062242B (zh) | 2021-03-16 |
Family
ID=64765426
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811246888.1A Active CN109062242B (zh) | 2018-10-25 | 2018-10-25 | 一种新的旋翼无人机控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109062242B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109839942A (zh) * | 2019-03-05 | 2019-06-04 | 济南门达航空科技有限公司 | 一种四旋翼无人机自适应姿态控制方法 |
DE102019206074A1 (de) * | 2019-04-29 | 2020-10-29 | Robert Bosch Gmbh | Verfahren zum Betreiben einer elektrischen Maschine, Vorrichtung |
CN111263178A (zh) * | 2020-02-20 | 2020-06-09 | 广州虎牙科技有限公司 | 直播方法、装置、用户端及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104932512A (zh) * | 2015-06-24 | 2015-09-23 | 北京科技大学 | 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法 |
CN105700537A (zh) * | 2016-01-22 | 2016-06-22 | 高卫东 | 无人机姿态控制滤波单元和方法 |
CN105912011A (zh) * | 2016-06-24 | 2016-08-31 | 天津理工大学 | 一种四旋翼飞行器姿态的线性自抗扰控制方法 |
CN108647442A (zh) * | 2018-05-11 | 2018-10-12 | 北京航空航天大学 | 一种基于辅助输出的六旋翼无人机故障估计方法 |
-
2018
- 2018-10-25 CN CN201811246888.1A patent/CN109062242B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104932512A (zh) * | 2015-06-24 | 2015-09-23 | 北京科技大学 | 一种基于mimo非线性不确定反步法的四旋翼位姿控制方法 |
CN105700537A (zh) * | 2016-01-22 | 2016-06-22 | 高卫东 | 无人机姿态控制滤波单元和方法 |
CN105912011A (zh) * | 2016-06-24 | 2016-08-31 | 天津理工大学 | 一种四旋翼飞行器姿态的线性自抗扰控制方法 |
CN108647442A (zh) * | 2018-05-11 | 2018-10-12 | 北京航空航天大学 | 一种基于辅助输出的六旋翼无人机故障估计方法 |
Non-Patent Citations (1)
Title |
---|
UAV Gesture Interaction Design for Volumetric Surveillance;Chen Xiaogang;《Procedia Manufacturing》;20150331;第03卷;第6639-6643页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109062242A (zh) | 2018-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Jia et al. | Integral backstepping sliding mode control for quadrotor helicopter under external uncertain disturbances | |
Cabecinhas et al. | A nonlinear quadrotor trajectory tracking controller with disturbance rejection | |
CN109062242B (zh) | 一种新的旋翼无人机控制方法 | |
Yu et al. | Attitude tracking control of a quadrotor UAV in the exponential coordinates | |
CN106802570B (zh) | 一种无人直升机位置跟踪的方法与装置 | |
Wang et al. | Nonlinear augmented observer design and application to quadrotor aircraft | |
CN109507890A (zh) | 一种基于eso的无人机动态逆广义预测控制器 | |
Kovach et al. | A bank-to-turn autopilot design for an advanced air-to-air interceptor | |
Cheng et al. | Neural-networks control for hover to high-speed-level-flight transition of ducted fan uav with provable stability | |
Xu et al. | Fault tolerant control of a quadrotor using C 1 adaptive control | |
Kriel et al. | Receptacle normal position control for automated aerial refueling | |
Wang et al. | Path following of the autonomous airship with compensation of unknown wind and modeling uncertainties | |
CN113625730B (zh) | 一种基于超扭滑模的四旋翼自适应容错控制方法 | |
Cao et al. | Robust flight control design using sensor-based backstepping control for unmanned aerial vehicles | |
CN105116905A (zh) | 一种飞行器姿态控制方法 | |
CN110275542A (zh) | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 | |
Jothiraj et al. | Enabling bidirectional thrust for aggressive and inverted quadrotor flight | |
Pérez et al. | Attitude control of a quadcopter using adaptive control technique | |
CN116149193B (zh) | 一种基于视觉的旋翼无人机抗扰动控制方法及*** | |
Astudillo et al. | Optimal and robust controllers design for a smartphone-based quadrotor | |
CN114137999A (zh) | 固定翼飞行器横侧向通道控制方法及装置 | |
Shen et al. | Backstepping sliding mode RBF network adaptive control for quadrotor UAV | |
Afhami et al. | Updating LQR control for full dynamic of a quadrotor | |
Liu et al. | Case studies on U state space control system design for quadrotor model | |
Chachou et al. | Modeling and control of a simulated flight of a mini helicopter using matlab/simulink |
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 |