亚星游戏官网-www.yaxin868.com

专利名称：一种基于角加速度传感器的多操纵面无人机闭环控制分配方法
技术领域：
本发明属于无人机飞行控制领域，具体地说是指一种基于角加速度传感器的多操纵面无人机闭环控制分配技木。
背景技术：
现代无人机朝着高机动性、高可靠性的方向发展。具有多个操纵面，使其操纵灵活性增强，形成多操纵面布局的气动余度，从而提高了无人机的控制能力，増加了飞行控制系统的控制冗余度。对于无人机每个通道的控制来说，都有多个操纵面可以同时利用。因此，通过多个操纵面的同时偏转，可以产生直接升力或侧カ等非常规机动的控制效果，并且当一个操纵面发生故障时，有多个其它有效操纵面可供选择，这为高可靠飞行控制系统的设计与实现提供了可能性。多个冗余的操纵面在提高系统可靠性的同时也带来了如何将控制指令分配到各个操纵面的问题。控制分配技术是解决此类问题的有效方法，它在满足无人机操纵面偏转位置和速率约束的前提下，将控制指令以某种最优指标分配到各个操纵面。控制分配技术将飞行控制系统分为飞行控制律设计和控制分配两个环节，从而明确了整个系统的物理概念，简化了其设计过程，提高了不同飞行控制方法和控制分配方法的可重用性。目前见诸文献的控制分配方法有广义逆方法、链式递增方法、直接分配方法、线性规划法、二次规划法、动态控制分配方法等。这些控制分配方法均为开环结构，当各个操纵面处于正常工作状态时，它们可以达到较好的控制分配效果，但当某个操纵面发生故障吋，它们往往无法取得理想的控制效果。角加速度传感器是测量无人机角加速度的有效手段，具有体积小、重量轻、造价低廉等特点。角加速度传感器由三个安装于无人机机体轴上的角加速度计组成，它们分别感受三个轴线方向的角加速度并输出，则可以得到无人机的角加速度。

发明内容
本发明的目的是为了解决上述问题，提出一种基于角加速度传感器的多操纵面无人机闭环控制分配方法，在操纵面正常工作或发生故障的情况下，通过多操纵面无人机闭环控制分配方法将期望控制指令分配到各个操纵面。本发明的基于角加速度传感器的多操纵面无人机闭环控制分配方法，首先得到角加速度指令，根据角加速度指令以及无人机的当前角加速度信息(可通过安装于无人机上的角加速度传感器测得)得到カ矩增量误差，通过常用的控制分配方法对该カ矩增量误差进行分配，从而得到各个操纵面的偏转角度，具体包括如下步骤步骤一通过无人机上的角速度传感器测得当前的无人机角速度，根据期望的角速度指令，得到无人机的期望角加速度。步骤ニ 通过无人机上的角加速度传感器测得当前的无人机角加速度，并与无人机的期望角加速度相减，再与转动惯量矩阵相乘，得到无人机的カ矩增量误差。步骤三采用控制分配方法对カ矩増量误差进行分配，得到不同执行机构的控制増量。步骤四将当前时刻计算得到的执行机构控制增量与存储的前一时刻执行机构控制输入相加，得到不同执行机构的控制输入。步骤五将不同执行机构的控制输入分别接入相应的执行机构，从而得到不同操纵面的偏转角度。步骤六在后续的飞行控制过程中，不断重复前述五个步骤，从而实时得到无人机不同操纵面的实际偏转角。
步骤四得到的不同执行机构控制输入，以及步骤五或者步骤六中得到的无人机操纵面偏转角(由相应的位置传感器获取)，均通过测控链路下传显示，供操控人员监控參考。本发明的优点在于(I)本发明提供的方法利用了无人机角加速度传感器得到角加速度反馈信息，从而构成了闭环控制分配结构，在操纵面正常工作和发生故障时，均能达到较好的控制分配效果；(2)本发明提供的方法原理简单，实现方便。


图I是本发明的原理结构图；图2是本发明的方法流程图。图中
具体实施例方式下面将结合附图和实施例对本发明作进ー步的详细说明。本发明是一种基于角加速度传感器的多操纵面无人机闭环控制分配方法，原理结构如图I所示，期望的角加速度计算�？楦�据角速度传感器測量到的无人机角速度信息和角速度指令信息得到期望的角加速度指令，并与角加速度传感器測量到的无人机角加速度信息相减以得到角加速度误差，该误差与转动惯量矩阵相乘得到カ矩增量误差，通过控制分配模块对该カ矩増量误差进行分配得到当前时刻的执行机构控制増量，接着将当前时刻执行机构控制増量和存储的前一时刻执行机构控制量相加即得到当前时刻执行机构控制量，该控制量一方面经过延迟环节Z-I转换并存储为前一时刻执行机构控制量以备下ー时刻的计算使用，另ー方面经过执行机构�？榈玫阶饔糜谖奕嘶�上的各个操纵面偏转角度，流程如图2所示，具体包括以下几个步骤步骤一通过无人机上的角速度传感器测得当前的无人机角速度，根据期望的角速度指令，得到无人机的期望角加速度。设无人机上如图I中所示的角速度传感器测得的角速度为[P，q，r]T，其中，P表示滚转角速度，q表示俯仰角速度，!■表示偏航角速度，期望的角速度指令为[P。，q。，r。]τ，其中，P。表示滚转角速度指令，qc表示俯仰角速度指令，rc表示偏航角速度指令，则无人机的期望角加速度为
权利要求
1.一种基于角加速度传感器的多操纵面无人机闭环控制分配方法，其特征在于，具体包括以下几个步骤 步骤一通过无人机上的角速度传感器测得当前的无人机角速度，根据期望的角速度指令，得到无人机的期望角加速度； 角速度传感器测得的角速度为[P，q, r]T，其中，P表示滚转角速度，q表示俯仰角速度，r表示偏航角速度，期望的角速度指令为[P。，q。，r Jt，其中，p。表示滚转角速度指令，q。表示俯仰角速度指令，rc表示偏航角速度指令，则无人机的期望角加速度为 Pd ωρ 0 0 Pc~P Gd = 0 0}q 0 Λ」[O O WrJL rc -r _ 式中，ωρ，《^和为滚转、俯仰和偏航通道的频带或增益，&表示期望的滚转角加速度，6表示期望的俯仰角加速度Λ表示期望的偏航角加速度； 步骤二 通过无人机上的角加速度传感器测得当前的无人机角加速度丨#，么<，其中，表示当前的滚转角加速度，纟表示当前的俯仰角加速度4表示当前的偏航角加速度，并与无人机的期望角加速度相减，再与转动惯量矩阵J。相乘，得到无人机的力矩增量误差AMe，即期望力矩增量与实际力矩增量之差 [P1,-P" _rd~r _ 式中，转动惯量矩阵J。为 'Λ/Γ O JxJF Je= O IjJv O U/r JJT_ 式中，Jx表示绕机体轴X轴的转动惯量，Jy表示绕机体轴I轴的转动惯量，Jz表示绕机体轴Z轴的转动惯量，Jxz为惯性积，Γ = 4 ； 步骤三采用控制分配方法对力矩增量误差△ Me进行分配，得到不同执行机构k时刻的控制增量Uv (k)； 步骤四将当前时刻计算得到的执行机构控制增量Uv (k)与存储的前一时刻执行机构控制输Auv(k-i)相加，得到当前时刻不同执行机构的控制输入u(k)；U(k) = U(k-1)+Uv(k) 式中，U(k) = [U1GO, "WGO]'m表示执行机构的数量，UiGOi = 1，…，m表示第i个执行机构k时刻的控制输入； 步骤五将不同执行机构的控制输入U(k)分别接入相应的执行机构，从而得到不同操纵面的偏转角度D (k)； 设有m个执行机构，则这些执行机构的模型为 [i ... ο I s+ K1D(k)= \ ...U(k)O...丄_S+K,n_式中，Ki表示第i个执行机构的频带特性，i = l, s表示Laplace算符， D(k) = [ δ j (k),…，δ m(k)]T, m表示执行机构的数量，δ j(k) i = I,…，m表示第i个执行机构k时刻的输出，即第i个操纵面在k时刻的偏转角度； 步骤六在后续的飞行控制过程中，不断重复前述五个步骤，从而实时得到无人机不同操纵面的偏转角角度D (k)； 将得到的不同执行机构控制输入U(k)，以及不同操纵面的偏转角角度D(k)，均通过测控链路下传显示，供操控人员监控参考。
2.根据权利要求I所述的一种基于角加速度传感器的多操纵面无人机闭环控制分配方法，其特征在于，所述的步骤三中，当控制分配方法采用广义逆控制分配法时，具体为 设无人机在某一平衡状态下的控制效率矩阵为B，采用广义逆控制分配方法，得到不同执行机构k时刻的控制增量Uv (k)为Uv (k) = Bt(BBt)-1AM6 式中，= [ 丨⑷，···，<*⑷]表示执行机构的数量,《丨⑷i = I,…，m表示第i个执行机构k时刻的控制增量。
3.根据权利要求I所述的一种基于角加速度传感器的多操纵面无人机闭环控制分配方法，其特征在于，所述的步骤三中，当控制分配方法采用链式递增分配法时，具体为 将控制量分为若干组，为了简便分为两组，第一组中包含的控制量在任何时间都可以使用；另一组中的控制量只有在前一组控制量达不到所需力矩时才起作用，即控制效率矩阵B和不同执行机构的控制增量Uv(k)为 帥丨為]’ uv(k)= 其中,W P)表示第一组控制量，K P)表示第二组控制量，B1和B2为控制效率矩阵B的子矩阵，B1表示与第一组控制量对应的控制效率子矩阵，B2表示与第二组控制量对应的控制效率子矩阵； 当W (*)没有饱和时，Uv (k)为 c/,w=P,r(^rl^/； 当0⑷饱和时，设该饱和值为，Uv (k)为 t/m-[咖-_ A )(AMe-B1UlikX^O
4.根据权利要求I所述的一种基于角加速度传感器的多操纵面无人机闭环控制分配方法，其特征在于，所述的步骤三中，当控制分配方法采用线性规划分配法时，具体为 将控制分配问题转化为如下约束优化问题； 跑(六/#)) < s.t. BUv (k) = Mie Lr < Uv (k)< U+ 式中况⑷二卜丨⑷,…,^*)]7^= [C1,…，cm]'Ci表示第i个执行机构的控制增量4⑷在目标函数中所占的比重，i = 1，···，!!!，B为控制效率矩阵，U—和U+分别表示执行机构控制增量的上下限约束；在满足上式所示的等式约束和不等式约束的条 件下，求解使得线性目标函数取最小值的Uv (k)。
全文摘要
本发明公开了一种基于角加速度传感器的多操纵面无人机闭环控制分配方法，可应用于具有冗余多操纵面无人机的飞行控制。通过无人机角速度指令和测量到的角速度信息得到期望角加速度指令，通过角加速度传感器获得无人机的角加速度，得到期望力矩增量与实际力矩增量的误差，实时地对该力矩增量误差进行控制分配解算，得到各个操纵面的偏转角度。本发明提供的方法利用了无人机角加速度传感器得到角加速度反馈信息，从而构成了闭环控制分配结构，在操纵面正常工作和发生故障时，均能达到较好的控制分配效果，并且计算简单、实现方便。
文档编号G01P15/08GK102736631SQ201210191778
公开日2012年10月17日 申请日期2012年6月11日 优先权日2012年6月11日
发明者樊国玮, 王宏伦, 盖文东 申请人:北京航空航天大学