CN102736631B - 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 - Google Patents
一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 Download PDFInfo
- Publication number
- CN102736631B CN102736631B CN201210191778.6A CN201210191778A CN102736631B CN 102736631 B CN102736631 B CN 102736631B CN 201210191778 A CN201210191778 A CN 201210191778A CN 102736631 B CN102736631 B CN 102736631B
- Authority
- CN
- China
- Prior art keywords
- mtd
- msub
- mrow
- mtr
- 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
- 230000001133 acceleration Effects 0.000 title claims abstract description 62
- 238000000034 method Methods 0.000 title claims abstract description 56
- 238000009826 distribution Methods 0.000 title claims abstract description 44
- 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 10
- 230000007246 mechanism Effects 0.000 claims description 23
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000005259 measurement Methods 0.000 claims description 3
- 238000012544 monitoring process Methods 0.000 claims description 3
- 238000005457 optimization Methods 0.000 claims description 2
- 229920006395 saturated elastomer Polymers 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 abstract description 5
- 230000000694 effects Effects 0.000 abstract description 5
- 238000005516 engineering process Methods 0.000 description 3
- 238000012938 design process Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于角加速度传感器的多操纵面无人机闭环控制分配方法,可应用于具有冗余多操纵面无人机的飞行控制。通过无人机角速度指令和测量到的角速度信息得到期望角加速度指令,通过角加速度传感器获得无人机的角加速度,得到期望力矩增量与实际力矩增量的误差,实时地对该力矩增量误差进行控制分配解算,得到各个操纵面的偏转角度。本发明提供的方法利用了无人机角加速度传感器得到角加速度反馈信息,从而构成了闭环控制分配结构,在操纵面正常工作和发生故障时,均能达到较好的控制分配效果,并且计算简单、实现方便。
Description
技术领域
本发明属于无人机飞行控制领域,具体地说是指一种基于角加速度传感器的多操纵面无人机闭环控制分配技术。
背景技术
现代无人机朝着高机动性、高可靠性的方向发展。具有多个操纵面,使其操纵灵活性增强,形成多操纵面布局的气动余度,从而提高了无人机的控制能力,增加了飞行控制***的控制冗余度。对于无人机每个通道的控制来说,都有多个操纵面可以同时利用。因此,通过多个操纵面的同时偏转,可以产生直接升力或侧力等非常规机动的控制效果,并且当一个操纵面发生故障时,有多个其它有效操纵面可供选择,这为高可靠飞行控制***的设计与实现提供了可能性。
多个冗余的操纵面在提高***可靠性的同时也带来了如何将控制指令分配到各个操纵面的问题。控制分配技术是解决此类问题的有效方法,它在满足无人机操纵面偏转位置和速率约束的前提下,将控制指令以某种最优指标分配到各个操纵面。控制分配技术将飞行控制***分为飞行控制律设计和控制分配两个环节,从而明确了整个***的物理概念,简化了其设计过程,提高了不同飞行控制方法和控制分配方法的可重用性。目前见诸文献的控制分配方法有:广义逆方法、链式递增方法、直接分配方法、线性规划法、二次规划法、动态控制分配方法等。这些控制分配方法均为开环结构,当各个操纵面处于正常工作状态时,它们可以达到较好的控制分配效果,但当某个操纵面发生故障时,它们往往无法取得理想的控制效果。
角加速度传感器是测量无人机角加速度的有效手段,具有体积小、重量轻、造价低廉等特点。角加速度传感器由三个安装于无人机机体轴上的角加速度计组成,它们分别感受三个轴线方向的角加速度并输出,则可以得到无人机的角加速度。
发明内容
本发明的目的是为了解决上述问题,提出一种基于角加速度传感器的多操纵面无人机闭环控制分配方法,在操纵面正常工作或发生故障的情况下,通过多操纵面无人机闭环控制分配方法将期望控制指令分配到各个操纵面。
本发明的基于角加速度传感器的多操纵面无人机闭环控制分配方法,首先得到角加速度指令,根据角加速度指令以及无人机的当前角加速度信息(可通过安装于无人机上的角加速度传感器测得)得到力矩增量误差,通过常用的控制分配方法对该力矩增量误差进行分配,从而得到各个操纵面的偏转角度,具体包括如下步骤:
步骤一:通过无人机上的角速度传感器测得当前的无人机角速度,根据期望的角速度指令,得到无人机的期望角加速度。
步骤二:通过无人机上的角加速度传感器测得当前的无人机角加速度,并与无人机的期望角加速度相减,再与转动惯量矩阵相乘,得到无人机的力矩增量误差。
步骤三:采用控制分配方法对力矩增量误差进行分配,得到不同执行机构的控制增量。
步骤四:将当前时刻计算得到的执行机构控制增量与存储的前一时刻执行机构控制输入相加,得到不同执行机构的控制输入。
步骤五:将不同执行机构的控制输入分别接入相应的执行机构,从而得到不同操纵面的偏转角度。
步骤六:在后续的飞行控制过程中,不断重复前述五个步骤,从而实时得到无人机不同操纵面的实际偏转角。
步骤四得到的不同执行机构控制输入,以及步骤五或者步骤六中得到的无人机操纵面偏转角(由相应的位置传感器获取),均通过测控链路下传显示,供操控人员监控参考。
本发明的优点在于:
(1)本发明提供的方法利用了无人机角加速度传感器得到角加速度反馈信息,从而构成了闭环控制分配结构,在操纵面正常工作和发生故障时,均能达到较好的控制分配效果;
(2)本发明提供的方法原理简单,实现方便。
附图说明
图1是本发明的原理结构图;
图2是本发明的方法流程图。
图中:
具体实施方式
下面将结合附图和实施例对本发明作进一步的详细说明。
本发明是一种基于角加速度传感器的多操纵面无人机闭环控制分配方法,原理结构如图1所示,期望的角加速度计算模块根据角速度传感器测量到的无人机角速度信息和角速度指令信息得到期望的角加速度指令,并与角加速度传感器测量到的无人机角加速度信息相减以得到角加速度误差,该误差与转动惯量矩阵相乘得到力矩增量误差,通过控制分配模块对该力矩增量误差进行分配得到当前时刻的执行机构控制增量,接着将当前时刻执行机构控制增量和存储的前一时刻执行机构控制量相加即得到当前时刻执行机构控制量,该控制量一方面经过延迟环节z-1转换并存储为前一时刻执行机构控制量以备下一时刻的计算使用,另一方面经过执行机构模块得到作用于无人机上的各个操纵面偏转角度,流程如图2所示,具体包括以下几个步骤:
步骤一:通过无人机上的角速度传感器测得当前的无人机角速度,根据期望的角速度指令,得到无人机的期望角加速度。
设无人机上如图1中所示的角速度传感器测得的角速度为[p,q,r]T,其中,p表示滚转角速度,q表示俯仰角速度,r表示偏航角速度,期望的角速度指令为[pc,qc,rc]T,其中,pc表示滚转角速度指令,qc表示俯仰角速度指令,rc表示偏航角速度指令,则无人机的期望角加速度为:
式中,ωp,ωq和ωr为滚转、俯仰和偏航通道的频带(或增益),这些频带值的选取主要受执行机构频带和飞机高频结构模态的限制。表示期望的滚转角加速度,表示期望的俯仰角加速度,表示期望的偏航角加速度。
步骤二:通过无人机上如图1中所示的角加速度传感器测得当前的无人机角加速度其中,表示当前的滚转角加速度,表示当前的俯仰角加速度,表示当前的偏航角加速度,并与无人机的期望角加速度相减,再与如图1中所示的转动惯量矩阵Jc相乘,得到无人机的力矩增量误差ΔMe(即期望力矩增量与实际力矩增量之差):
式中,转动惯量矩阵Jc为
式中,Jx表示绕机体轴x轴的转动惯量,Jy表示绕机体轴y轴的转动惯量,Jz表示绕机体轴z轴的转动惯量,Jxz为惯性积,
步骤三:采用控制分配方法对力矩增量误差ΔMe进行分配,得到不同执行机构k时刻的控制增量Uv(k)。
控制分配方法采用广义逆控制分配法时:
设无人机在某一平衡状态下的控制效率矩阵为B,采用广义逆控制分配方法,得到不同执行机构k时刻的控制增量Uv(k)为:
Uv(k)=BT(BBT)-1ΔMe
式中,m表示执行机构的数量,i=1,…,m表示第i个执行机构k时刻的控制增量。
控制分配方法采用链式递增分配法时:
将控制量分为若干组,为了简便分为两组,第一组中包含的控制量在任何时间都可以使用;另一组中的控制量只有在前一组控制量达不到所需力矩时才起作用,即控制效率矩阵B和不同执行机构的控制增量Uv(k)为:
其中,表示第一组控制量,表示第二组控制量,B1和B2为控制效率矩阵B的子矩阵,B1表示与第一组控制量对应的控制效率子矩阵,B2表示与第二组控制量对应的控制效率子矩阵。
当没有饱和时,Uv(k)为
当饱和时,设该饱和值为Uv(k)为
控制分配方法采用线性规划分配法时:
将控制分配问题转化为如下约束优化问题。
式中,c=[c1,…,cm]T,ci表示第i个执行机构的控制增量在目标函数中所占的比重,i=1,…,m,B为控制效率矩阵,U-和U+分别表示执行机构控制增量的上下限约束。在满足上式所示的等式约束和不等式约束的条件下,求解使得线性目标函数取最小值的Uv(k)。
步骤四:将当前时刻计算得到的执行机构控制增量Uv(k)与存储的前一时刻执行机构控制输入Uv(k-1)相加,得到当前时刻不同执行机构的控制输入U(k)。
U(k)=U(k-1)+Uv(k)
式中,U(k)=[u1(k),…,um(k)]T,m表示执行机构的数量,ui(k)i=1,…,m表示第i个执行机构k时刻的控制输入。
步骤五:将不同执行机构的控制输入U(k)分别接入相应的执行机构,从而得到不同操纵面的偏转角度D(k)。
设有m个执行机构,则这些执行机构的模型为
式中,Ki表示第i个执行机构的频带特性,i=1,…,m,s表示Laplace算符,D(k)=[δ1(k),…,δm(k)]T,m表示执行机构的数量,δi(k)i=1,…,m表示第i个执行机构k时刻的输出,即第i个操纵面在k时刻的偏转角度。
步骤六:在后续的飞行控制过程中,不断重复前述五个步骤,从而实时得到无人机不同操纵面的偏转角角度D(k)。
步骤四得到的不同执行机构控制输入U(k),以及步骤五或者步骤六中得到的无人机操纵面偏转角度D(k)(由相应的位置传感器获取),均通过测控链路下传显示,供操控人员监控参考。
Claims (1)
1.一种基于角加速度传感器的多操纵面无人机闭环控制分配方法,其特征在于,具体包括以下几个步骤:
步骤一:通过无人机上的角速度传感器测得当前的无人机角速度,根据期望的角速度指令,得到无人机的期望角加速度;
角速度传感器测得的角速度为[p,q,r]T,其中,p表示滚转角速度,q表示俯仰角速度,r表示偏航角速度,期望的角速度指令为[pc,qc,rc]T,其中,pc表示滚转角速度指令,qc表示俯仰角速度指令,rc表示偏航角速度指令,则无人机的期望角加速度为:
式中,ωp,ωq和ωr为滚转、俯仰和偏航通道的频带或增益,表示期望的滚转角加速度,表示期望的俯仰角加速度,表示期望的偏航角加速度;
步骤二:通过无人机上的角加速度传感器测得当前的无人机角加速度其中,表示当前的滚转角加速度,表示当前的俯仰角加速度,表示当前的偏航角加速度,并与无人机的期望角加速度相减,再与转动惯量矩阵Jc相乘,得到无人机的力矩增量误差ΔMe,即期望力矩增量与实际力矩增量之差:
式中,转动惯量矩阵Jc为
式中,Jx表示绕机体轴x轴的转动惯量,Jy表示绕机体轴y轴的转动惯量,Jz表示绕机体轴z轴的转动惯量,Jxz为惯性积,
步骤三:采用控制分配方法对力矩增量误差ΔMe进行分配,得到不同执行机构k时刻的控制增量Uv(k);
步骤四:将当前时刻计算得到的执行机构控制增量Uv(k)与存储的前一时刻执行机构控制输入Uv(k-1)相加,得到当前时刻不同执行机构的控制输入U(k);
U(k)=U(k-1)+Uv(k)
式中,U(k)=[u1(k),…,um(k)]T,m表示执行机构的数量,ui(k)i=1,…,m表示第i个执行机构k时刻的控制输入;
步骤五:将不同执行机构的控制输入U(k)分别接入相应的执行机构,从而得到不同操纵面的偏转角度D(k);
设有m个执行机构,则这些执行机构的模型为:
式中,Ki表示第i个执行机构的频带特性,i=1,…,m,s表示Laplace算符,
D(k)=[δ1(k),…,δm(k)]T,m表示执行机构的数量,δi(k)i=1,…,m表示第i个执行机构k时刻的输出,即第i个操纵面在k时刻的偏转角度;
步骤六:在后续的飞行控制过程中,不断重复前述五个步骤,从而实时得到无人机不同操纵面的偏转角角度D(k);
将得到的不同执行机构控制输入U(k),以及不同操纵面的偏转角角度D(k),均通过测控链路下传显示,供操控人员监控参考;
所述的步骤三中,当控制分配方法采用广义逆控制分配法时,具体为:
设无人机在某一平衡状态下的控制效率矩阵为B,采用广义逆控制分配方法,得到不同执行机构k时刻的控制增量Uv(k)为:
Uv(k)=BT(BBT)-1ΔMe
式中,,m表示执行机构的数量,i=1,…,m表示第i个执行机构k时刻的控制增量;
所述的步骤三中,当控制分配方法采用链式递增分配法时,具体为:
将控制量分为若干组,为了简便分为两组,第一组中包含的控制量在任何时间都可以使用;另一组中的控制量只有在前一组控制量达不到所需力矩时才起作用,即控制效率矩阵B和不同执行机构的控制增量Uv(k)为:
其中,表示第一组控制量,表示第二组控制量,B1和B2为控制效率矩阵B的子矩阵,B1表示与第一组控制量对应的控制效率子矩阵,B2表示与第二组控制量对应的控制效率子矩阵;
当没有饱和时,Uv(k)为
当饱和时,设该饱和值为Uv(k)为
;
所述的步骤三中,当控制分配方法采用线性规划分配法时,具体为:
将控制分配问题转化为如下约束优化问题;
式中,c=[c1,…,cm]T,ci表示第i个执行机构的控制增量在目标函数中所占的比重,i=1,…,m,B为控制效率矩阵,U-和U+分别表示执行机构控制增量的上下限约束;在满足上式所示的等式约束和不等式约束的条件下,求解使得线性目标函数取最小值的Uv(k)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210191778.6A CN102736631B (zh) | 2012-06-11 | 2012-06-11 | 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210191778.6A CN102736631B (zh) | 2012-06-11 | 2012-06-11 | 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102736631A CN102736631A (zh) | 2012-10-17 |
CN102736631B true CN102736631B (zh) | 2015-01-07 |
Family
ID=46992288
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210191778.6A Active CN102736631B (zh) | 2012-06-11 | 2012-06-11 | 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102736631B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106462167B (zh) * | 2014-05-30 | 2019-12-13 | 深圳市大疆创新科技有限公司 | 飞行器姿态控制方法 |
CN104590557B (zh) * | 2015-02-05 | 2016-10-26 | 中电科(德阳广汉)特种飞机***工程有限公司 | 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置 |
CN104677662B (zh) * | 2015-02-10 | 2017-03-08 | 中国工程物理研究院总体工程研究所 | 非稳定弹体空投开伞模拟试验装置及试验方法 |
CN104765312B (zh) * | 2015-03-09 | 2017-04-19 | 上海交通大学 | 飞行器可重构控制***实现方法 |
CN105138003B (zh) * | 2015-09-18 | 2017-06-30 | 山东科技大学 | 多操纵面无人机直接升力控制方法 |
CN107992080B (zh) * | 2017-12-25 | 2020-12-15 | 成都纵横自动化技术股份有限公司 | 控制分配方法、装置及多旋翼飞行器 |
CN110207697B (zh) * | 2019-04-29 | 2023-03-21 | 南京航空航天大学 | 基于角加速度计/陀螺/加速度计的惯性导航解算方法 |
CN113625732B (zh) * | 2021-07-31 | 2024-07-05 | 西北工业大学 | 基于角加速度估计的增量反馈逆角速度控制律设计方法 |
CN113741549B (zh) * | 2021-11-04 | 2022-02-08 | 普宙科技(深圳)有限公司 | 一种多旋翼无人机控制量分配方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2202487A1 (en) * | 2008-12-11 | 2010-06-30 | Honeywell International Inc. | Apparatus and method for unmanned aerial vehicle ground proximity detection, landing and descent |
CN102183962A (zh) * | 2011-03-11 | 2011-09-14 | 中国气象局气象探测中心 | 无人机下投探空仪及其释放控制方法 |
-
2012
- 2012-06-11 CN CN201210191778.6A patent/CN102736631B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2202487A1 (en) * | 2008-12-11 | 2010-06-30 | Honeywell International Inc. | Apparatus and method for unmanned aerial vehicle ground proximity detection, landing and descent |
CN102183962A (zh) * | 2011-03-11 | 2011-09-14 | 中国气象局气象探测中心 | 无人机下投探空仪及其释放控制方法 |
Non-Patent Citations (3)
Title |
---|
基于控制分配方法的阵风减缓控制律设计;李卫琪, 张平, 陈宗基;《***仿真学报》;20090831;第20卷;247-251,256 * |
张艳,陈宗基,魏晨.一种基于广义逆的无人机鲁棒控制分配方法.《航空学报》.2008,第29卷5198-5203. * |
李春涛,胡盛华.基于动态逆的无人机飞行控制律设计.《兵工自动化》.2012,第31卷1-4,8. * |
Also Published As
Publication number | Publication date |
---|---|
CN102736631A (zh) | 2012-10-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102736631B (zh) | 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 | |
Crowther et al. | Kinematic analysis and control design for a nonplanar multirotor vehicle | |
US4725020A (en) | Control system incorporating structural feedback | |
CN106647781A (zh) | 基于重复控制补偿神经模糊pid四旋翼飞行器的控制方法 | |
CN113568419B (zh) | 一种变载四旋翼无人机容错控制方法 | |
CN104765312B (zh) | 飞行器可重构控制***实现方法 | |
CN106874617B (zh) | 一种高效的直升机机动飞行品质等级评估方法 | |
US8165729B2 (en) | Method and device for estimating the forces exerted on a control surface of an aircraft | |
CN102830622A (zh) | 一种四旋翼飞行器自抗扰自动飞行控制方法 | |
KR20170064491A (ko) | 항공기를 위한 작동 시스템 | |
CN105739513A (zh) | 一种四旋翼飞行机器人非线性轨迹跟踪控制器及其跟踪控制方法 | |
CN104699108A (zh) | 一种多旋翼飞行器的控制分配方法 | |
CN104504294A (zh) | 飞行仿真初始状态混合遗传配平方法 | |
CN106335633A (zh) | 用于飞行器起落架性能监测的数据处理单元 | |
CN104536448B (zh) | 一种基于Backstepping法的无人机姿态***控制方法 | |
CN107608368B (zh) | 一种无人机在极端初始状态的快速平衡控制方法 | |
CN111142550B (zh) | 民用飞机辅助驾驶控制方法、***及飞行品质评估方法 | |
CN102320378A (zh) | 多操纵面飞机的一种均衡操纵分配方法 | |
CN102360217B (zh) | 多旋翼无人机全局输入解耦装置及包含该装置的控制*** | |
Sodja et al. | Ground testing of the flexop demonstrator aircraft | |
CN1124532C (zh) | 以襟翼位置为函数的转弯协调增益的方法和装置 | |
Campa et al. | NLDI guidance control laws for close formation flight | |
Thanapalan | Modelling of a helicopter system | |
CN108930786A (zh) | 用于控制静压的驱动装置的方法 | |
CN102323758B (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 |