CN103901780B - 一种多旋翼飞行器控制能力评估指标的计算方法 - Google Patents
一种多旋翼飞行器控制能力评估指标的计算方法 Download PDFInfo
- Publication number
- CN103901780B CN103901780B CN201410129489.2A CN201410129489A CN103901780B CN 103901780 B CN103901780 B CN 103901780B CN 201410129489 A CN201410129489 A CN 201410129489A CN 103901780 B CN103901780 B CN 103901780B
- Authority
- CN
- China
- Prior art keywords
- rotor
- aircraft
- control ability
- evaluation index
- follows
- 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
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种多旋翼飞行器控制能力评估指标的计算方法,该指标的计算过程有三大步骤:步骤一:多旋翼飞行器基本物理参数确定;步骤二:中间变量的计算;步骤三:多旋翼飞行器控制能力评估指标计算。发明的多旋翼飞行器控制能力的评估指标为飞行器重力距离控制量可达集边界最小值,控制能力指标为0时,可以明确知道多旋翼飞行器已经没有控制能力,不能再正常飞行;控制能力指标越大,表明飞行器越容易控制。它在飞行控制技术领域里有较好的实用价值和应用前景。
Description
技术领域
本发明涉及一种多旋翼飞行器控制能力评估指标的计算方法,属于飞行控制技术领域。
背景技术
在飞行控制领域,确保飞行器的飞行安全是十分重要和必要的,尤其在飞行器发生故障时保证飞行器的安全飞行,这会降低由于飞机摔机带来的损失。能够实时评估多旋翼飞行器的控制能力是飞行器实现安全飞行的前提。多旋翼飞行器发生故障概率最大的部件就是其旋翼,所以设计一种多旋翼飞行器控制能力的评估指标的计算方法具有非常重要的意义。
发明内容
本发明提供了一种多旋翼飞行器控制能力评估指标的计算方法。它解决了多旋翼飞行器在旋翼故障或受损时控制能力的评估问题。本发明中采用的多旋翼飞行器模型如图1所示,悬停状态下的多旋翼无人机线性动态模型如下:
其中 h,vh分别为高度和垂直速度,φ,θ,ψ分别为飞行器滚转角、俯仰角和偏航角,p,q,r为飞行器围绕机体轴旋转的角速度,T为飞行器所有电机产生的总升力,L,M,N为电机产生的机体滚转、俯仰和偏航力矩,ma为飞行器质量,g为重力加速度,并且
其中为单位阵。为惯性常量矩阵,可表示为
Jf∈diag(-ma,Jx,Jy,Jz) (3)
其中Jx,Jy,Jz为飞行器围绕滚转、俯仰和偏航轴的转动惯量。
由于飞行器所能提供的控制力有限,控制向量F受到集合Ω约束。如图1所示,由于多旋翼无人机系统的几何结构,每个旋翼提供的升力fi与系统总推力/扭矩F的关系为:
F=Bff (4)
其中f=[f1 … fm]T。控制效率矩阵的参数化形式为
其中ri,i=1,…,m为旋翼中心到飞行器重心的距离,ti的定义为
参数ηi∈[0,1],ηi=0,i=1,…,m表示第i个旋翼停机。由于每个电机只能提供向上的升力,每个电机升力受到约束fi∈[0,K],i=1,…,m。因此,我们有
因此,Ω定义如下
Ω={F|F=Bff,f∈Uf}. (8)
本发明提出的多旋翼飞行器控制能力评估指标定义如下
其中Ω由公式(8)定义,ΩC为Ω的补集,为Ω的边界。对于图1和模型(1)所描述的多旋翼飞行器,其控制能力评估指标的具体计算步骤如下:
步骤一:多旋翼飞行器基本物理参数确定
确定飞行器旋翼个数m,飞行器重量ma,重力加速度g,每个旋翼在飞行器上所处的位置参数(见图1),设定每个旋翼的效率参数ηi,i=1,…,m,确定每个旋翼所能提供的最大升力K,确定旋翼升力和反扭矩系数kμ;根据图1得到飞行器控制效率矩阵Bf
其中ti的定义为
令Bf=[b1 … bm],bi,i=1,…,m的值可由公式(10)得到。令M=[1 … m],定义两个矩阵S1和S2,S1的所有行由M的m个数中任取出3个的所有组合组成,S2的每一行为M中除去S1相应行的元素后,剩余的(m-3)个元素,所有组合的个数设为sm。比如,当m=5时,sm=10,则
在实际工程中,有很多种方法可以很快得出S1。如果使用MATLAB,则可利用函数nchoosek计算得到S1=nchoosek(M,3),本发明已验证MATLAB2011b可行。
步骤二:中间变量的计算
对所有的j=1,…,sm,计算中间变量B1,j,B2,j,计算公式如下
其中为Bf的S1(j,i)列,S1(j,i),i=1,2,3表示取S1中位于第j行和第i列的数,同理,为Bf的S2(j,i)列S2(j,i),i=1,…,m-3表示取S2中位于第j行和第i列的数。
对所有的j=1,…,sm,计算中间变量ξj,计算公式如下
在实际工程中,有很多种方法可以计算ξj。如果使用MATLAB,则可利用函数null计算得到,比如ξ=null(B1,j),ξj=ξ(:,1)。本发明已验证MATLAB2011b可行。
对所有的j=1,…,sm,计算中间变量dj,计算公式如下:
其中sign(·)为符号函数,定义为:对于n维向量
sign(a)=[c1 … cn] (15)
其中
步骤三:多旋翼飞行器控制能力评估指标计算
多旋翼飞行器控制能力评估指标计算公式如下
其中min(·)为取最小值函数。
优点及功效:本发明一种多旋翼飞行器控制能力评估指标的计算方法,该方法的优点是成功解决了多旋翼飞行器的控制能力评估问题。控制能力指标为0时,我们可以明确知道多旋翼飞行器已经没有控制能力,不能再正常飞行;控制能力指标越大,表明飞行器越容易控制。
附图说明
图1:多旋翼飞行器几何结构示意图
图2:四旋翼飞行器模型示意图
图3:本发明流程框图
图中符号说明如下:
图1中符号说明:e1,e2,e3为机体坐标系的坐标轴,分别为旋翼1,旋翼2和旋翼m中心与机体坐标系中心O的连线顺时针偏离机体轴e1的角度,r1,r2,rm分别为旋翼1,旋翼2和旋翼m中心到机体坐标系中心O的距离。
图2中符号说明:ex,ey,ez为惯性坐标系的坐标轴。O表示四旋翼飞行器机体坐标系的原点,e1,e2,e3为机体坐标系的坐标轴。φ,θ,ψ为四旋翼飞行器的滚转角、俯仰角和偏航角。fi,i={1,2,3,4}表示每个电机产生的升力。l为每个电机中心到机体坐标系中心O的距离,四旋翼飞行器四个电机中心到机体坐标系中心O的距离相等。为相邻两个电机轴间的夹角,对于四旋翼飞行器来说
具体实施方式
见图1—图3,本发明提供一种常见的四旋翼飞行器的控制能力评估指标的计算过程,其具体步骤如下:
步骤一:多旋翼飞行器基本物理参数确定
四旋翼飞行器旋翼个数为m=4,质量ma=1.535kg,重力加速度g=9.8m/s2,每个旋翼在飞行器上所处的位置参数以及每个旋翼的效率参数
每个旋翼所能提供的最大升力K=6.125N,系数kμ=0.1;根据图1和图2得到飞行器控制效率矩阵Bf
令M=[1 2 3 4],则从4个数中任取3个的组合的个数为sm=4,矩阵S1和S2如下
其中S1可以使用MATLAB中的nchoosek函数计算得到S1=nchoosek(M,3),本发明所使用的MATLAB版本为MATLAB2011b。
步骤二:中间变量的计算
对所有的j,j∈{1,2,3,4},计算中间变量B1,j,B2,j。根据公式(12)和公式(20),计算结果如下
对所有的j,j∈{1,2,3,4},计算中间变量ξj。根据公式(13)和公式(21),计算结果如下
其中ξ1,ξ2,ξ3,ξ4可以用MATLAB中的null函数计算得到,比如ξ=null(B1,1),ξ1=ξ(:,1)。本发明所使用的MATLAB版本为MATLAB2011b。
对所有的j,j∈{1,2,3,4},计算中间变量dj。根据公式(14)和公式(22),计算结果如下
d1=0.9229,d2=0.9229,d3=0.9229,d4=0.9229. (23)
步骤三:四旋翼飞行器控制能力评估指标计算
计算飞行器控制能力评估指标根据公式(17)和公式(23),计算结果如下
Claims (1)
1.一种多旋翼飞行器控制能力评估指标的计算方法,其特征在于:悬停状态下的多旋翼无人机线性动态模型如下:
其中
h,vh分别为高度和垂直速度,φ,θ,ψ分别为飞行器滚转角、俯仰角和偏航角,p,q,r为飞行器围绕机体轴旋转的角速度,T为飞行器所有电机产生的总升力,L,M,N为电机产生的机体滚转、俯仰和偏航力矩,ma为飞行器质量,g为重力加速度,并且
其中为单位阵;为惯性常量矩阵,表示为
Jf∈diag(-ma,Jx,Jy,Jz) (3)
其中Jx,Jy,Jz为飞行器围绕滚转、俯仰和偏航轴的转动惯量;
由于飞行器所能提供的控制力有限,控制向量F受到集合Ω约束;由于多旋翼无人机系统的几何结构,每个旋翼提供的升力fi与系统总推力/扭矩F的关系为:
F=Bff (4)
其中f=[f1 … fm]T;控制效率矩阵的参数化形式为
其中ri,i=1,…,m为旋翼中心到飞行器重心的距离,ti的定义为
参数ηi∈[0,1],ηi=0,i=1,…,m表示第i个旋翼停机;由于每个电机只能提供向上的升力,每个电机升力受到约束fi∈[0,K],i=1,…,m;因此:
因此,Ω定义如下
Ω={F|F=Bff,f∈Uf}. (8)
多旋翼飞行器控制能力评估指标定义如下
其中Ω由公式(8)定义,ΩC为Ω的补集,为Ω的边界;对于公式(1)所描述的多旋翼飞行器,其控制能力评估指标的具体计算步骤如下:
步骤一:多旋翼飞行器基本物理参数确定
确定飞行器旋翼个数m,飞行器重量ma,重力加速度g,每个旋翼在飞行器上所处的位置参数ri,i=1,…,m,设定每个旋翼的效率参数ηi,i=1,…,m,确定每个旋翼所能提供的最大升力K,确定旋翼升力和反扭矩系数kμ;得到飞行器控制效率矩阵Bf
其中ti的定义为
令Bf=[b1 … bm],bi,i=1,…,m的值由公式(10)得到,令M=[1 … m],定义两个矩阵S1和S2,S1的所有行由M的m个数中任取出3个的所有组合组成,S2的每一行为M中除去S1相应行的元素后,剩余的m-3个元素,所有组合的个数设为sm;
步骤二:中间变量的计算
对所有的j=1,…,sm,计算中间变量B1,j,B2,j,计算公式如下
其中为Bf的S1(j,i)列,S1(j,i),i=1,2,3表示取S1中位于第j行和第i列的数,同理,为Bf的S2(j,i)列S2(j,i),i=1,…,m-3表示取S2中位于第j行和第i列的数;
对所有的j=1,…,sm,计算中间变量ξj,计算公式如下
对所有的j=1,…,sm,计算中间变量dj,计算公式如下:
其中sign(·)为符号函数,定义为:对于n维向量
sign(a)=[c1 … cn] (15)
其中
步骤三:多旋翼飞行器控制能力评估指标计算
多旋翼飞行器控制能力评估指标计算公式如下:
其中min(·)为取最小值函数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410129489.2A CN103901780B (zh) | 2014-04-02 | 2014-04-02 | 一种多旋翼飞行器控制能力评估指标的计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410129489.2A CN103901780B (zh) | 2014-04-02 | 2014-04-02 | 一种多旋翼飞行器控制能力评估指标的计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103901780A CN103901780A (zh) | 2014-07-02 |
CN103901780B true CN103901780B (zh) | 2016-08-17 |
Family
ID=50993173
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410129489.2A Active CN103901780B (zh) | 2014-04-02 | 2014-04-02 | 一种多旋翼飞行器控制能力评估指标的计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103901780B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105868459A (zh) * | 2016-03-24 | 2016-08-17 | 四川汉科计算机信息技术有限公司 | 固定翼无人机纵向动稳定性飞行品质评估系统 |
CN108536879B (zh) * | 2017-03-03 | 2021-09-07 | 中国科学院沈阳自动化研究所 | 基于模型参考自适应的多旋翼无人机参数辨识方法 |
CN111045420B (zh) * | 2019-12-31 | 2022-01-18 | 山东交通学院 | 一对线性约束控制分量下过驱动系统控制可达集确定方法 |
CN111880410B (zh) * | 2020-08-11 | 2021-12-28 | 北京航空航天大学 | 一种针对电机故障的四旋翼无人机容错控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102298329A (zh) * | 2011-08-19 | 2011-12-28 | 北京航空航天大学 | 一种基于自适应遗传算法的小型无人旋翼机动力学模型辨识方法 |
DE102010054074A1 (de) * | 2010-12-03 | 2012-06-06 | Sven Rupprecht | Ein optisch, akustisch sowie mit einem Geruch aussondernden Modul bestücktes RC Fluggerät als Jagdhilfsmittel für das Auffinden und/ oder Treiben bzw. Vergrämen von Vertretern verschiedenster Tiergattungen |
CN102508692A (zh) * | 2011-09-28 | 2012-06-20 | 天津大学 | 临近空间飞行器控制方法仿真与验证方法 |
CN203047531U (zh) * | 2012-11-15 | 2013-07-10 | 深圳市大疆创新科技有限公司 | 多旋翼无人飞行器 |
DE102013206478A1 (de) * | 2012-04-11 | 2013-10-17 | Singapore Technologies Aerospace Ltd. | Eine rotorarmanordnung und ein mehrfachdrehflügler |
-
2014
- 2014-04-02 CN CN201410129489.2A patent/CN103901780B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102010054074A1 (de) * | 2010-12-03 | 2012-06-06 | Sven Rupprecht | Ein optisch, akustisch sowie mit einem Geruch aussondernden Modul bestücktes RC Fluggerät als Jagdhilfsmittel für das Auffinden und/ oder Treiben bzw. Vergrämen von Vertretern verschiedenster Tiergattungen |
CN102298329A (zh) * | 2011-08-19 | 2011-12-28 | 北京航空航天大学 | 一种基于自适应遗传算法的小型无人旋翼机动力学模型辨识方法 |
CN102508692A (zh) * | 2011-09-28 | 2012-06-20 | 天津大学 | 临近空间飞行器控制方法仿真与验证方法 |
DE102013206478A1 (de) * | 2012-04-11 | 2013-10-17 | Singapore Technologies Aerospace Ltd. | Eine rotorarmanordnung und ein mehrfachdrehflügler |
CN203047531U (zh) * | 2012-11-15 | 2013-07-10 | 深圳市大疆创新科技有限公司 | 多旋翼无人飞行器 |
Also Published As
Publication number | Publication date |
---|---|
CN103901780A (zh) | 2014-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102902277B (zh) | 一种六旋翼飞行器有一个电机停机时的安全着陆方法 | |
CN102880182B (zh) | 一种存在网络随机延迟的微小型无人飞行器控制方法 | |
US11721219B2 (en) | Method for controlling steady flight of unmanned aircraft | |
CN108958289B (zh) | 基于相对速度障碍的集群无人机避碰方法 | |
CN103777638B (zh) | 多无人机网络编队的一致性控制方法 | |
CN103901780B (zh) | 一种多旋翼飞行器控制能力评估指标的计算方法 | |
CN102163059B (zh) | 推力变向无人机的姿态控制系统及控制方法 | |
Kreciglowa et al. | Energy efficiency of trajectory generation methods for stop-and-go aerial robot navigation | |
CN101625571B (zh) | 一种模拟自旋式飞行器六自由度运动的方法 | |
CN105182989B (zh) | 一种风场影响下的飞机姿态控制方法 | |
CN106842952B (zh) | 针对三旋翼无人机舵机堵塞故障的容错控制方法 | |
CN110531778A (zh) | 一种多旋翼无人机自驾仪桨叶损伤的估计与自愈控制方法 | |
CN108090302B (zh) | 一种直升机飞行力学模拟方法及系统 | |
CN106325291A (zh) | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及系统 | |
CN102830622A (zh) | 一种四旋翼飞行器自抗扰自动飞行控制方法 | |
CN104571120A (zh) | 四旋翼无人机的姿态非线性自适应控制方法 | |
CN110058600B (zh) | 三旋翼无人机舵机堵塞故障下位姿系统的容错控制方法 | |
CN106647584A (zh) | 一种基于最优滑模的四旋翼飞行器的容错控制方法 | |
CN105488295A (zh) | 一种考虑风场扰动的无人机建模系统 | |
CN106406340A (zh) | 四旋翼无人飞行器及其控制方法 | |
CN104007663A (zh) | 一种含参数不确定性的四旋翼姿态自适应容错控制方法 | |
CN103869817A (zh) | 一种倾转四旋翼无人机垂直起降控制方法 | |
CN107563044A (zh) | 基于在线安全学习的四旋翼无人机路径跟踪控制方法 | |
CN102789527A (zh) | 一种用于飞机配平的粒子群优化方法 | |
CN115657730B (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 |