CN102902277B - 一种六旋翼飞行器有一个电机停机时的安全着陆方法 - Google Patents
一种六旋翼飞行器有一个电机停机时的安全着陆方法 Download PDFInfo
- Publication number
- CN102902277B CN102902277B CN201210398628.2A CN201210398628A CN102902277B CN 102902277 B CN102902277 B CN 102902277B CN 201210398628 A CN201210398628 A CN 201210398628A CN 102902277 B CN102902277 B CN 102902277B
- Authority
- CN
- China
- Prior art keywords
- rotorcraft
- cos
- sin
- motor
- 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.)
- Active
Links
Landscapes
- Toys (AREA)
Abstract
一种六旋翼飞行器有一个电机停机时的安全着陆方法,该方法有三大步骤:步骤一:六旋翼飞行器姿态和高度控制器设计;步骤二:六旋翼飞行器所有电机正常工作时控制分配器设计;步骤三:当六旋翼飞行器有一个电机停机时的控制重分配。六旋翼飞行器有一个电机停机后其全状态是不可控的,但是当放弃偏航通道后,其俯仰和滚转通道依然可控。本发明即在此基础上采用控制重分配的方式设计六旋翼飞行器有一个电机停机的安全着陆控制器。通过Matlab仿真和真实的实验可以验证本发明是可行的。它在飞行控制技术领域里有较好的实用价值和应用前景。
Description
技术领域
本发明涉及一种六旋翼飞行器有一个电机停机时的安全着陆方法,该发明属于飞行控制技术领域。
背景技术
在飞行控制领域,确保飞行器的飞行安全是十分重要和必要的,尤其在飞行器发生故障时保证飞行器的安全降落,这会最大限度的降低损失。六旋翼飞行器发生故障概率最大的部件就是其旋翼,所以设计一种在六旋翼飞行器有一个电机停机时的安全着陆控制器是非常有意义的。
六旋翼飞行器在一个旋翼停机后是全状态不可控的。但是当放弃偏航通道的控制时,其俯仰和滚转通道依然可控,从而可以控制其安全的着陆。
发明内容
本发明提供了一种六旋翼飞行器有一个电机停机时的安全着陆方法。它解决了当六旋翼飞行器有一个电机停机时的安全着陆问题。
本发明中采用的六旋翼飞行器模型如下:
如图1所示,该六旋翼飞行器的六个旋翼绕质心对称分布,其旋翼的旋转方向如图。SI={ex,ey,ez}表示惯性坐标系,Sb={e1,e2,e3}表示机体坐标系。可以导出六旋翼的姿态线性动态模型可表示为:
其中x=(φ,θ,ψ)T为滚转-俯仰-偏航角。Ω=(p,q,r)T为飞行器绕机体轴的角速度。Jf∈R3×3为惯性矩阵,可表示为 Jx,Jy,Jz分别表示六旋翼飞行器绕对应机体轴的转动惯量。τa=(L,M,N)T为电机产生的绕机体轴的转动力矩,分别可表示为 其中d>0为电机到质心的距离,而f=(f1,f2…f6)表示电机产生的旋翼升力。ku为一个与空气密度、旋翼的尺寸、形状、扭转角以及一些其他因素有关的参数,在此假设为常值。bl∈R6×1,bm∈R6×1,bn∈R6×1为系数矩阵,按该模型其值为
bn=(-1,1,-1,1,-1,1)T
六旋翼飞行器的高度动态模型可由下面的微分方程给出:
其中m为六旋翼质量,Vh为六旋翼的垂直速度。g为重力加速度。F为电机产生的总推力,可表示为其中系数矩阵bf=(1,1,1,1,1,1)T∈R6×1。
当六旋翼飞行器有一个电机停机时,设该电机为第i个电机i∈{1,2,3,4,5,6}。定义bf[i],bl[i],bm[i],bn[i]和f[i]分别为从bf,bl,bm,bn和f中去除第i个元素后的向量。则总推力F[i]和转动力矩τa[i]=(L[i],M[i],N[i])T可以表示为
由于六旋翼飞行器是通过六个控制输入来控制四个状态,所以它是过驱动的。通常并不直接设计关于每个电机控需要产生的旋翼升力f的控制律。而是先根据控制目标r设计关于虚拟控制量的控制律,其中Fv,τav=(Lv,Mv,Nv)T分别为六旋翼期望的总推力和转动力矩。再通过控制分配器得到每个电机的需要产生的旋翼升力f,控制器框架如附图2所示。本发明提出的当六旋翼有一个电机停机时的安全着陆控制器,并不改变虚拟控制量的控制律,而是通过控制重分配的方式来解决这一问题。在本发明中控制分配器采用经典的伪逆法来实现。
本发明一种六旋翼飞行器有一个电机停机时的安全着陆方法,该方法具体步骤如下:
步骤一:六旋翼飞行器姿态和高度控制器设计
六旋翼飞行器姿态控制器可采用如下控制器:
τa=-KΩΩ-Kqq (5)
其中KΩ∈R3×3为对称正定阵,Ω为六旋翼飞行器绕机体轴的角速度。Kq∈R是正系数。四元数(q0,qT)T,其中q0∈R,q∈R3表示六旋翼的方向。用欧拉角表示的姿态角x=(ψ,θ,φ)T与四元数的对应关系如下:
q0=cos(φ/2)cos(θ/2)cos(ψ/2)+sin(φ/2)sin(θ/2)sin(ψ/2)
q1=sin(φ/2)cos(θ/2)cos(ψ/2)-cos(φ/2)sin(θ/2)sin(ψ/2) (6)
q2=cos(φ/2)sin(θ/2)cos(ψ/2)+sin(φ/2)cos(θ/2)sin(ψ/2)
q3=cos(φ/2)cos(θ/2)sin(ψ/2)+sin(φ/2)sin(θ/2)cos(ψ/2)
六旋翼飞行器的高度控制采用的控制器为:
其中m为飞行器质量,KP,KD为正系数,h为飞行器高度,h0为期望的高度,Vh为垂直速度,g为重力加速度。
步骤二:六旋翼飞行器所有电机正常工作时控制分配器设计
虚拟控制量u和旋翼升力f之间的映射关系可由下列等式表示:
其中W称为控制效率矩阵。通过伪逆矩阵法可以得到期望的旋翼升力,其计算公式如下:
f=WT(WWT)-1u(9)
步骤三:当六旋翼飞行器有一个电机停机时的控制重分配
当六旋翼飞行器有一个电机i,i∈{1,2,3,4,5,6}停机后,由公式(8)可导出虚拟控制量u和电机升力f[i]的映射关系如下:
其中W[i]为当电机i停机时的控制效率矩阵。由伪逆矩阵法可得从虚拟控制量u到旋翼升力f[i]的分配关系如下:
然而,当六旋翼飞行器有一个电机停机时全状态是不可控的,但是当放弃偏航通道,并且满足总推力其中K为每个电机提供的最大升力,其俯仰和滚转通道依然可控,从而可以控制其安全着陆。所以由公式(11)可得控制重分配为
其中u*=(Fv,Lv,Mv,0)T,Lv,Mv和Fv分别由控制律(5)和(7)产生。
优点及功效:本发明一种六旋翼飞行器有一个电机停机时的安全着陆方法,该方法的优点是:成功解决了六旋翼飞行器有一个电机停机时的安全着陆问题。当六旋翼飞行器有一个电机停机时并不需要采用新的控制器,只是放弃偏航通道,即改变控制分配就可以实现六旋翼飞行器的安全着陆。
附图说明
图1:六旋翼飞行器模型示意图
图2:六旋翼飞行器控制器框架示意图
图3:六旋翼飞行器健康时控制仿真结果图
图4:六旋翼飞行器2号电机停机并采用原有控制器仿真结果图
图5:六旋翼飞行器2号电机停机放弃偏航通道控制仿真结果图
图6:本发明流程框图
图7:真实实验采用的六旋翼飞行器
图8:六旋翼飞行器真实实验数据图
图中符号说明如下:
图1中的符号说明:OI表示惯性坐标系原点,ex,ey,ez为惯性坐标系的坐标轴。Ob表示六旋翼飞行器机体坐标系的原点,e1,e2,e3为机体坐标系的坐标轴。Front、Right、Rear表示六旋翼飞行器的方向,分别为前、左、后。Roll、Pitch、Yaw表示六旋翼飞行器的三种姿态运动,分别为滚转、俯仰和偏航。φ,θ,ψ为六旋翼飞行器的姿态角,分别为滚转角、俯仰角和偏航角。fi,i={1,2,3,4,5,6}表示每个电机产生的升力。ωi,i={1,2,3,4,5,6}为每个电机的角速度,箭头表示旋转方向。Qi,i={1,2,3,4,5,6}表示每个电机上产生的阻尼力矩,箭头表示方向。
图2中的符号说明:r表示控制目标,u表示虚拟控制量,f表示电机需要产生的升力,ω表示电机需要的转动角速度。
具体实施方式
本发明提供了当六旋翼飞行器有一个电机停机时的安全着陆控制器设计方法。
仿真过程是在主频2.66Hz、内存2.00GB的计算机上,win7环境下的Matlab2010b上进行的。实验对象采用的是F550六旋翼机架,好赢28301000KV电机,好赢30A电调,APM自驾仪,3S 3300mAh锂电池.
首先介绍一下仿真中六旋翼飞行器的各个参数,这些参数根据真实六旋翼飞行器测量而得。M=1.535kg,g=9.8m/s2,d=0.275m,ku=1,K=6.125N,六旋翼飞行器的惯性矩阵为
(1)见图6,本发明一种六旋翼飞行器有一个电机停机时的安全着陆方法,该方法具体步骤如下:
步骤一:六旋翼飞行器姿态和高度控制器设计
六旋翼飞行器姿态控制器采用如下控制器:
τa=-KΩΩ-Kqq (14)
其中KΩ=diag{5.5,5.5,5.5},Kq=100。
六旋翼飞行器的高度控制采用控制器为:
其中m为飞行器质量,取Kp=15,KD=10,h为飞行器高度,h0为期望的高度,Vh为垂直速度,g为重力加速度。
步骤二:六旋翼飞行器控制分配器设计
虚拟控制量u和旋翼升力f之间的映射关系可由下列等式表示:
其中W称为控制效率矩阵。其中
bn=(-1,1,-1,1,-1,1)T
bf=(1,1,1,1,1,1)T
通过伪逆矩阵法可以得到期望的旋翼升力,其计算公式如下:
f=WT(WWT)-1u (18)
步骤三:当六旋翼飞行器有一个电机停机时的控制重分配设计
当六旋翼飞行器有一个电机i,i∈{1,2,3,4,5,6}停机后,虚拟控制量u和电机升力f[i]的映射
关系如下:
其中bf[i],bl[i],bm[i],bn[i]和f[i]分别为从bf,bl,bm,bn和f中去除第i个元素后的向量。由此可得六旋翼飞行器有一个电机停机后的控制重分配为
其中u*=(Fv,Lv,Mv,0)T,Lv,Mv和Fv分别由控制律(14)和(15)产生。
(2)仿真结果分析
通过该设计方法设计控制器在Matlab上的仿真结果如下。
首先将六旋翼飞行器保持在一定高度(h0=5),偏航角保持常值。然后再1秒钟时刻使2号电机停转并给出着陆指令。仿真结果如图3,图4和图5所示。图3为没有电机停转情况下的仿真结果,六旋翼飞行器的高度和姿态都可以很好的控制的期望值。图4为2号电机停机但不放弃偏航通道即不进行新的控制重分配的仿真结果,可以看到六旋翼飞行器的姿态偏离期望值,这样六旋翼飞行器在着陆时不能保持水平,这很可能导致事故发生。图5为2号电机停机并放弃偏航通道即采用本发明的控制方法得到的仿真结果,可以看到六旋翼飞行器的俯仰、滚转和高度都能很好的控制到期望值,这将保证六旋翼飞行器的安全着陆。由此可以得出本发明是可行的。
(3)实物实验验证
为了进一步验证本发明的可行性。我们在真实的六旋翼飞行器上进行了测试,采用的六旋翼飞行器如图7所示。六旋翼飞行器真实实验数据如图8。在前1秒钟六旋翼处于稳定模态,在1秒钟以后让2号电机停机,控制器控制六旋翼飞行器的俯仰和滚转通道,放弃偏航通道即本发明的控制方法。从图8中可以看到六旋翼飞行器的俯仰和滚转都可以控制到零附近。从而可以控制六旋翼飞行器安全的着陆。图1为六旋翼飞行器模型示意图,图2为六旋翼飞行器控制器框架示意图。
Claims (1)
1.一种六旋翼飞行器有一个电机停机时的安全着陆方法,其特征在于:该方法具体步骤如下:
步骤一:六旋翼飞行器姿态和高度控制器设计
六旋翼飞行器姿态控制器采用如下控制器:
τa=-KΩΩ-Kqq (5)
其中,KΩ∈R3×3为对称正定阵,Ω为六旋翼飞行器绕机体轴的角速度,Kq∈R是正系数,四元数(q0,qT)T,其中q0∈R,q∈R3表示六旋翼的方向,用欧拉角表示的姿态角x=(ψ,θ,φ)T与四元数的对应关系如下:
q0=cos(φ/2)cos(θ/2)cos(ψ/2)+sin(φ/2)sin(θ/2)sin(ψ/2)
q1=sin(φ/2)cos(θ/2)cos(ψ/2)-cos(φ/2)sin(θ/2)sin(ψ/2)
(6)
q2=cos(φ/2)sin(θ/2)cos(ψ/2)+sin(φ/2)cos(θ/2)sin(ψ/2)
q3=cos(φ/2)cos(θ/2)sin(ψ/2)+sin(φ/2)sin(θ/2)cos(ψ/2)
六旋翼飞行器的高度控制采用的控制器为:
其中,m为飞行器质量,KP,KD为正系数,h为飞行器高度,h0为期望的高度,Vh为垂直速度,g为重力加速度;
步骤二:六旋翼飞行器所有电机正常工作时控制分配器设计
虚拟控制量u和旋翼升力f之间的映射关系由下列等式表示:
其中,d>0为电机到质心的距离;ku为一个与空气密度、旋翼的尺寸、形状、扭转角以及一些其他因素有关的参数,在此设为常值;其中W称为控制效率矩阵,表示如下:
bn=(-1,1,-1,1,-1,1)T
bf=(1,1,1,1,1,1)T
其中,W称为控制效率矩阵,通过伪逆矩阵法得到期望的旋翼升力,其计算公式如下:
f=WT(WWT)-1u (9)
步骤三:当六旋翼飞行器有一个电机停机时的控制重分配
当六旋翼飞行器有一个电机i,i∈{1,2,3,4,5,6}停机后,由公式(8)导出虚拟控制量u和电机升力f[i]的映射关系如下:
其中,bf[i],bl[i],bm[i],bn[i]和f[i]分别为从bf,bl,bm,bn和f中去除第i个元素后的向量;
其中,W[i]为当电机i停机时的控制效率矩阵,由伪逆矩阵法可得从虚拟控制量u到旋翼升力f[i]的分配关系如下:
然而,当六旋翼飞行器有一个电机停机时全状态是不可控的,但是当放弃偏航通道,并且满足总推力其中K为每个电机提供的最大升力,其俯仰和滚转通道依然可控,从而控制其安全着陆;所以由公式(11)得控制重分配为
其中,u*=(Fv,Lv,Mv,0)T;Lv,Mv和Fv分别由公式(5)和(7)产生;
其中Fv和τav=(Lv,Mv,Nv)T分别为六旋翼期望的总推力和转动力矩。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210398628.2A CN102902277B (zh) | 2012-10-19 | 2012-10-19 | 一种六旋翼飞行器有一个电机停机时的安全着陆方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210398628.2A CN102902277B (zh) | 2012-10-19 | 2012-10-19 | 一种六旋翼飞行器有一个电机停机时的安全着陆方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102902277A CN102902277A (zh) | 2013-01-30 |
CN102902277B true CN102902277B (zh) | 2015-09-30 |
Family
ID=47574572
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210398628.2A Active CN102902277B (zh) | 2012-10-19 | 2012-10-19 | 一种六旋翼飞行器有一个电机停机时的安全着陆方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102902277B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108516082B (zh) * | 2013-06-09 | 2021-06-18 | 瑞士苏黎世联邦理工学院 | 遭遇影响效应器的故障的多旋翼器的受控飞行 |
CN103963963B (zh) * | 2014-04-22 | 2016-01-13 | 深圳市大疆创新科技有限公司 | 多旋翼飞行器的飞行控制方法及*** |
CN104216417B (zh) * | 2014-09-22 | 2017-09-12 | 北京航空航天大学 | 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法 |
CN105253301B (zh) * | 2015-09-28 | 2017-12-05 | 深圳一电航空技术有限公司 | 多轴飞行器的飞行控制方法及装置 |
CN107992080B (zh) * | 2017-12-25 | 2020-12-15 | 成都纵横自动化技术股份有限公司 | 控制分配方法、装置及多旋翼飞行器 |
CN108614573B (zh) * | 2018-05-15 | 2021-08-20 | 上海扩博智能技术有限公司 | 六旋翼无人机的自动容错姿态控制方法 |
CN110888451B (zh) * | 2019-12-20 | 2022-12-06 | 国网山西省电力公司电力科学研究院 | 一种多旋翼无人机容错控制方法及*** |
CN111142372B (zh) * | 2019-12-31 | 2022-03-01 | 山东交通学院 | 效率矩阵行向量成比例下过驱动***控制可达集确定方法 |
CN112373677B (zh) * | 2020-11-18 | 2021-06-22 | 三生万物(北京)人工智能技术有限公司 | 一种六旋翼无人机动力缺失保护***、保护方法 |
CN113625763A (zh) * | 2021-08-30 | 2021-11-09 | 北京三快在线科技有限公司 | 无人机的控制方法、装置、介质、电子设备和无人机 |
CN113741549B (zh) * | 2021-11-04 | 2022-02-08 | 普宙科技(深圳)有限公司 | 一种多旋翼无人机控制量分配方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5337982A (en) * | 1991-10-10 | 1994-08-16 | Honeywell Inc. | Apparatus and method for controlling the vertical profile of an aircraft |
CN101830286A (zh) * | 2010-05-11 | 2010-09-15 | 航天科工深圳(集团)有限公司 | 无人旋翼飞行器发动机空中停车保护装置及其飞行器 |
CN202071985U (zh) * | 2011-03-09 | 2011-12-14 | 南京航空航天大学 | 新型面对称布局的多旋翼无人飞行器 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2961601B1 (fr) * | 2010-06-22 | 2012-07-27 | Parrot | Procede d'evaluation de la vitesse horizontale d'un drone, notamment d'un drone apte au vol stationnaire autopilote |
-
2012
- 2012-10-19 CN CN201210398628.2A patent/CN102902277B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5337982A (en) * | 1991-10-10 | 1994-08-16 | Honeywell Inc. | Apparatus and method for controlling the vertical profile of an aircraft |
CN101830286A (zh) * | 2010-05-11 | 2010-09-15 | 航天科工深圳(集团)有限公司 | 无人旋翼飞行器发动机空中停车保护装置及其飞行器 |
CN202071985U (zh) * | 2011-03-09 | 2011-12-14 | 南京航空航天大学 | 新型面对称布局的多旋翼无人飞行器 |
Non-Patent Citations (1)
Title |
---|
《可垂直起降和高速前飞飞行器模态转换控制律设计》;张晨曦等;《Proceedings of the 29th Chinese Control Conference July 29-31,2010,Beijing,China》;20100731;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN102902277A (zh) | 2013-01-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102902277B (zh) | 一种六旋翼飞行器有一个电机停机时的安全着陆方法 | |
CN109614633B (zh) | 一种复合式旋翼飞行器非线性建模及线性化配平方法 | |
CN106094860B (zh) | 四旋翼飞行器及其控制方法 | |
CN106647783B (zh) | 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 | |
CN105759613B (zh) | 倾转旋翼机的控制方法和控制装置 | |
CN104965414B (zh) | 针对四旋翼无人机执行器部分失效的容错控制方法 | |
CN109062042B (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
CN107688295A (zh) | 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 | |
CN106527137A (zh) | 基于观测器的四旋翼无人机容错控制方法 | |
CN107272408B (zh) | 一种小型无人直升机飞行控制中的动力规划方法 | |
CN105759832A (zh) | 一种基于反演法的四旋翼飞行器滑模变结构控制方法 | |
CN109283932B (zh) | 一种基于积分反步滑模的四旋翼飞行器姿态控制方法 | |
CN109597303A (zh) | 一种复合式旋翼飞行器全模式飞行控制方法 | |
Lu et al. | Real-time simulation system for UAV based on Matlab/Simulink | |
CN105676672B (zh) | 扑翼飞行器复合飞行策略仿真建模方法 | |
CN106842952A (zh) | 针对三旋翼无人机舵机堵塞故障的容错控制方法 | |
CN105159305A (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN105488296A (zh) | 一种考虑风场扰动的无人机建模方法 | |
Kou et al. | Powered yaw control for distributed electric propulsion aircraft: A model predictive control approach | |
CN103901780B (zh) | 一种多旋翼飞行器控制能力评估指标的计算方法 | |
Gardecki et al. | An adequate mathematical model of four-rotor flying robot in the context of control simulations | |
CN107247464A (zh) | 一种四旋翼无人飞行器的状态受限控制方法和*** | |
Abbas et al. | Tuning of PID controllers for quadcopter system using cultural exchange imperialist competitive algorithm | |
CN109086487A (zh) | 持续激励型共形傅里叶变换的无人机微小故障检测方法 | |
CN106777438A (zh) | 直升机典型旋转部件的空间多体运动仿真分析方法 |
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 |