CN104155988B - 飞行器的多通道姿态控制器 - Google Patents
飞行器的多通道姿态控制器 Download PDFInfo
- Publication number
- CN104155988B CN104155988B CN201410394876.9A CN201410394876A CN104155988B CN 104155988 B CN104155988 B CN 104155988B CN 201410394876 A CN201410394876 A CN 201410394876A CN 104155988 B CN104155988 B CN 104155988B
- Authority
- CN
- China
- Prior art keywords
- channel
- angular velocity
- pitch
- inner looping
- jaw
- 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.)
- Expired - Fee Related
Links
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明公开了一种飞行器的多通道姿态控制器,所述控制器包括执行机构和惯性平台,还包括:解算单元用于根据惯性平台的测量信息计算出飞行器滚动、偏航、俯仰三个通道的当前角速度、当前气流角后反馈输出;外回路控制单元用于根据三个通道的当前气流角、接收的气流角控制值,计算出三个通道的角速度调整值;对于偏航(俯仰)通道,将其角速度调整值与由交联支路引起的偏航(俯仰)角速度相加得其角速度控制值,并将滚动通道的角速度调整值作为该通道的角速度控制值;内回路控制单元用于根据三个通道的当前角速度和角速度控制值生成舵面偏转指令向执行机构输出。本发明通过补偿三个通道的角速度控制值使多通道姿态控制器获得更强的通道解耦效果。
Description
技术领域
本发明涉及航空航天领域,尤其涉及一种飞行器的多通道姿态控制器。
背景技术
飞行器通常由其内部的姿态控制器控制其飞行姿态,例如俯仰角、偏航角和滚动角。
飞行器在飞行过程中通常存在运动耦合的现象,例如,飞行器偏航会引起其滚动,飞行器的滚动也会引起其偏航;导致飞行器的改变飞行姿态时,飞行姿态的变化具有非线性和不确定性的特点,大大增加控制飞行器的飞行姿态的难度。
当飞行器的飞行姿态的变化较为缓慢并幅度较小(例如民航客机调整航向)时,可以将运动耦合对飞行器的飞行姿态的影响作为随机的小扰动,对飞行器的飞行姿态进行线性化处理,得到飞行器的小扰动气动力模型。目前,通常根据飞行器的小扰动气动力模型,在飞行器内设置三个独立的姿态控制器,分别用于控制飞行器俯仰通道、偏航通道和滚动通道的角速度。
随着对飞行器机动性能要求的提升,现有的姿态控制器通常通过增大飞行器的仰角以产生足够的气动升力,从而可以提高飞行器的机动性能。然而,飞行器在大仰角下,当改变俯仰通道、偏航通道或滚动通道的角速度时,三个通道之间出现严重的运动耦合的现象,并且三个通道的角速度的变化呈现明显的非线性。而现有的三个单通道姿态控制器仍分别独立、线性地对三个通道的角速度进行控制,导致控制与飞行器的实际飞行姿态失配,很容易导致飞行器飞行不稳定或者失控坠毁。
因此,有必要提供一种飞行器的多通道姿态控制器,以降低应用多个单通道姿态控制器的设计复杂度,并且获得更强的通道解耦效果而更稳定地控制飞行器的飞行姿态。
发明内容
针对上述现有技术存在的缺陷,本发明实施例提供了一种飞行器的多通道姿态控制器,以降低应用多个单通道姿态控制器的设计复杂度,并且获得更强的通道解耦效果而更稳定地控制飞行器的飞行姿态。
本发明实施例提供了一种飞行器的多通道姿态控制器,包括:执行机构和惯性平台,其还包括:
解算单元,用于根据所述飞行器的惯性平台的测量信息,计算出所述飞行器滚动通道、偏航通道、俯仰通道的当前角速度、当前气流角进行反馈输出;
外回路控制单元,用于根据所述解算单元反馈的滚动、偏航、俯仰通道的当前气流角,以及接收的所述滚动、偏航、俯仰通道的气流角控制值,计算出所述滚动、偏航、俯仰通道的角速度调整值,并将计算出的所述偏航通道的角速度调整值与偏航通道上由交联支路引起的偏航角速度相加得到所述偏航通道的角速度控制值;将计算出的所述俯仰通道的角速度调整值与俯仰通道上由交联支路引起的俯仰角速度相加得到所述俯仰通道的角速度控制值;之后,将所述滚动通道的角速度调整值作为计算出的滚动通道的角速度控制值、以及所述偏航、俯仰通道的角速度控制值进行输出;
内回路控制单元,用于根据所述解算单元反馈的所述三个通道的当前角速度,以及从所述外回路控制单元接收的三个通道的角速度控制值,生成舵面偏转指令向所述执行机构输出。
较佳地,所述内回路控制单元具体包括:
内回路滚动通道控制子单元,用于计算所述滚动通道的角速度控制值与所述滚动通道的当前角速度的偏差,将计算出的偏差经过预设的内回路滚动通道增益控制网络的运算后进行输出;
内回路偏航通道控制子单元,用于计算所述偏航通道的角速度控制值与所述偏航通道的当前角速度的偏差,将计算出的偏差经过预设的内回路偏航通道增益控制网络的运算后进行输出;
内回路俯仰通道控制子单元,用于计算所述俯仰通道的角速度控制值与所述俯仰通道的当前角速度的偏差,将计算出的偏差经过预设的内回路俯仰通道增益控制网络的运算后进行输出;
控制分配子单元,用于根据所述内回路滚动通道控制子单元、内回路偏航通道控制子单元,以及内回路俯仰通道控制子单元的输出进行控制分配,输出相应的舵面偏转指令。
较佳地,所述内回路滚动、偏航、俯仰通道增益控制网络是采用比例积分微分PID控制方法设计的;或者
所述内回路滚动、偏航、俯仰通道增益控制网络是采用频率域设计方法设计的。
较佳地,所述外回路控制单元具体包括:
外回路滚动通道控制子单元,用于计算所述滚动通道的气流角控制值与所述滚动通道的当前气流角的偏差,将计算出的偏差经过预设的外回路滚动通道增益控制网络的运算后,作为所述滚动通道的角速度控制值向所述内回路滚动通道控制子单元输出;
外回路偏航通道控制子单元,用于计算所述偏航通道的气流角控制值与所述偏航通道的当前气流角的偏差,将计算出的偏差经过预设的外回路偏航通道增益控制网络的运算、并与偏航通道上由交联支路引起的偏航角速度相加后,作为所述偏航通道的角速度控制值向所述内回路偏航通道控制子单元输出;
外回路俯仰通道控制子单元,用于计算所述俯仰通道的气流角控制值与所述俯仰通道的当前气流角的偏差,将计算出的偏差经过预设的外回路俯仰通道增益控制网络的运算、并与俯仰通道上由交联支路引起的俯仰角速度相加后,作为所述俯仰通道的角速度控制值向所述内回路俯仰通道控制子单元输出。
较佳地,所述外回路滚动、偏航、俯仰通道增益控制网络是采用PID控制方法设计的;或者
所述外回路滚动、偏航、俯仰通道增益控制网络是采用频率域设计方法设计的。
本发明实施例还提供了一种飞行器的多通道姿态控制器,包括:执行机构和惯性平台,其还包括:
解算单元,用于根据所述飞行器的惯性平台的测量信息,计算出所述飞行器滚动通道、偏航通道、俯仰通道的当前角速度、当前过载进行反馈输出;
外回路控制单元,用于根据所述解算单元反馈的滚动、偏航、俯仰通道的当前过载,以及接收的所述滚动、偏航、俯仰通道的过载控制值,计算出所述滚动、偏航、俯仰通道的角速度调整值,并将计算出的所述偏航通道的角速度调整值与偏航通道上由交联支路引起的偏航角速度相加得到所述偏航通道的角速度控制值;将计算出的所述俯仰通道的角速度调整值与俯仰通道上由交联支路引起的俯仰角速度相加得到所述俯仰通道的角速度控制值;之后,将所述滚动通道的角速度调整值,作为计算出的滚动通道的角速度控制值、以及所述偏航、俯仰通道的最终角速度控制值进行输出;
内回路控制单元,用于根据所述解算单元反馈的所述三个通道的当前角速度,以及从所述外回路控制单元接收的三个通道的角速度控制值,生成舵面偏转指令向所述执行机构输出。
较佳地,所述内回路控制单元具体包括:
内回路滚动通道控制子单元,用于计算所述滚动通道的角速度控制值与所述滚动通道的当前角速度的偏差,将计算出的偏差经过预设的内回路滚动通道增益控制网络的运算后进行输出;
内回路偏航通道控制子单元,用于计算所述偏航通道的角速度控制值与所述偏航通道的当前角速度的偏差,将计算出的偏差经过预设的内回路偏航通道增益控制网络的运算后进行输出;
内回路俯仰通道控制子单元,用于计算所述俯仰通道的角速度控制值与所述俯仰通道的当前角速度的偏差,将计算出的偏差经过预设的内回路俯仰通道增益控制网络的运算后进行输出;
控制分配子单元,用于根据所述内回路滚动通道控制子单元、内回路偏航通道控制子单元,以及内回路俯仰通道控制子单元的输出进行控制分配,输出相应的舵面偏转指令。
较佳地,所述内回路滚动、偏航、俯仰通道增益控制网络是采用PID控制方法设计的;或者
所述内回路滚动、偏航、俯仰通道增益控制网络是采用频率域设计方法设计的。
较佳地,所述外回路控制单元具体包括:
外回路滚动通道控制子单元,用于计算所述滚动通道的过载控制值与所述滚动通道的当前过载的偏差,将计算出的偏差经过预设的外回路滚动通道增益控制网络的运算后,作为所述滚动通道的角速度控制值向所述内回路滚动通道控制子单元输出;
外回路偏航通道控制子单元,用于计算所述偏航通道的过载控制值与所述偏航通道的当前过载的偏差,将计算出的偏差经过预设的外回路偏航通道增益控制网络的运算、并与偏航通道上由交联支路引起的偏航角速度相加后,作为所述偏航通道的角速度控制值向所述内回路偏航通道控制子单元输出;
外回路俯仰通道控制子单元,用于计算所述俯仰通道的过载控制值与所述俯仰通道的当前过载的偏差,将计算出的偏差经过预设的外回路俯仰通道增益控制网络的运算、并与俯仰通道上由交联支路引起的俯仰角速度相加后,作为所述俯仰通道的角速度控制值向所述内回路俯仰通道控制子单元输出。
较佳地,所述外回路滚动、偏航、俯仰通道增益控制网络是采用PID控制方法设计的;或者
所述外回路滚动、偏航、俯仰通道增益控制网络是采用频率域设计方法设计的。
本发明的技术方案中,解算单元输出的滚动、偏航、俯仰三个通道的反馈参数都包含了飞行器实际飞行姿态的运动耦合以及非线性等因素;偏航、俯仰通道上由交联支路引起的偏航、俯仰角速度都包含了通道之间的运动耦合因素;根据三个通道的反馈参数、由交联支路引起的偏航和俯仰角速度对三个通道的角速度控制值进行补偿,可以使得多通道姿态控制器获得更强的通道解耦效果而更加稳定地控制飞行器进行飞行。
而且,由内、外回路控制单元分担补偿任务;有利于简化多通道姿态控制器的结构,降低多通道姿态控制器的设计复杂度,便于对三个通道的角速度的控制。
进一步,控制分配子单元进行的控制分配,可以使得内回路三个通道增益控制网络根据近似线性、并解耦的飞行舵来设计;有利于增强内回路控制单元的性能而更稳定地控制飞行器进行飞行,并且进一步降低多通道姿态控制器的设计复杂度。
附图说明
图1为本发明实施例的飞行器的多通道姿态控制器的内部结构的框架示意图;
图2a为本发明实施例的内回路控制单元的内部结构的框架示意图;
图2b为本发明实施例的外回路控制单元的内部结构的框架示意图。
具体实施方式
为使本发明的目的、技术方案及优点更加清楚明白,以下参照附图并举出优选实施例,对本发明进一步详细说明。然而,需要说明的是,说明书中列出的许多细节仅仅是为了使读者对本发明的一个或多个方面有一个透彻的理解,即便没有这些特定的细节也可以实现本发明的这些方面。
本申请使用的“模块”、“系统”等术语旨在包括与计算机相关的实体,例如但不限于硬件、固件、软硬件组合、软件或者执行中的软件。例如,模块可以是,但并不仅限于:处理器上运行的进程、处理器、对象、可执行程序、执行的线程、程序和/或计算机。举例来说,计算设备上运行的应用程序和此计算设备都可以是模块。一个或多个模块可以位于执行中的一个进程和/或线程内。
本发明的发明人考虑到,可以由一个多通道姿态控制器一并控制飞行器的滚动通道、偏航通道、俯仰通道的角速度,可以保证三个通道的角速度受控的同步性;并且,可以从飞行器的包含运动耦合以及非线性等因素在内的实际飞行姿态的测量信息中,获取三个通道的反馈参数的数值;可以根据飞行器的运动学交联耦合机理引入通道之间的交联支路,确定出偏航、俯仰通道上各自由交联支路引起的偏航、俯仰角速度;根据获取的三个通道的反馈参数的数值,以及由交联支路引起的偏航、俯仰角速度,对由现有方法得到的三个通道的角速度的控制值进行补偿后,输出控制指令以控制飞行器的飞行姿态。对角速度的控制值的补偿,等效于在三个通道之间进行解耦,从而使得多通道姿态控制器获得更强的通道解耦效果,可以更加稳定地控制飞行器进行飞行。
而且,对角速度的控制值的补偿可以分步进行,有利于简化多通道姿态控制器对三个通道的角速度的控制,从而降低多通道姿态控制器的设计复杂度。
下面结合附图详细说明本发明的技术方案。
本发明实施例的安装于飞行器中的多通道姿态控制器,其内部结构的框架示意图,如图1所示,包括:执行机构101、惯性平台102、解算单元103、外回路控制单元104、回路控制单元105和飞行舵106。
其中执行机构101的电路与内回路控制单元105的输出端相连,执行机构101的机械与飞行舵106相连,具体用于根据内回路控制单元105输出的指令,控制飞行器的飞行舵106进行偏转。执行机构101采用与现有的执行机构相同的结构和功能,为本领域技术人员所熟知,此处不再赘述。
惯性平台102具体是利用陀螺仪在惯性空间使得平台的台体保持方位不变的装置,又称陀螺稳定平台,用于在飞行器上建立一个不受飞行器运动影响的参考坐标系,以对飞行器的实际的姿态角和加速度进行测量,从而得到测量信息。惯性平台102的具体结构和功能为本领域技术人员所熟知,此处不再赘述。
解算单元103具体可以是机载计算机,其输入端与惯性平台102的输出端相连,解算单元103的一组三通道输出端连接到外回路控制单元104,另一组三通道输出端连接到内回路控制单元105。解算单元103用于获取惯性平台102对该飞行器的测量信息;根据获取的测量信息,计算出该飞行器滚动通道(x通道)、偏航通道(y通道)俯仰通道(z通道)的当前角速度、当前气流角后,向外回路控制单元104反馈输出滚动通道的当前气流角偏航通道的当前气流角俯仰通道的当前气流角向内回路控制单元105反馈输出滚动通道的当前角速度偏航通道的当前角速度俯仰通道的当前角速度
外回路控制单元104的输出端与内回路控制单元105的输入端相连,用于根据解算单元103反馈的滚动、偏航、俯仰三个通道的当前气流角,以及本外回路控制单元104接收的滚动通道的气流角控制值(γvc)、偏航通道的气流角控制值(βc)、俯仰通道的气流角控制值(αc),计算出滚动、偏航、俯仰三个通道的角速度调整值;并将计算出的偏航通道的角速度调整值与偏航通道上由交联支路引起的偏航角速度相加,得到偏航通道的角速度控制值(ωyc);将计算出的俯仰通道的角速度调整值与俯仰通道上由交联支路引起的俯仰角速度相加得到俯仰通道的角速度控制值(ωzc);之后,将滚动通道的角速度调整值作为计算出的滚动通道的角速度控制值(ωxc)、以及偏航、俯仰通道的角速度控制值进行输出。偏航通道上由交联支路引起的偏航角速度,以及俯仰通道上由交联支路引起的俯仰角速度都可以根据转动方程推导计算得到。具体地,偏航角速度可以根据如下公式1计算得到:
公式1中,ωx1、ωz1分别表示飞行器的滚动、俯仰通道的角速度;Jx、Jy、Jz分别表示飞行器的滚动、偏航、俯仰三个通道的惯量;Jxy表示飞行器的滚动通道与偏航通道之间的惯性积。
俯仰角速度可以根据如下公式2计算得到:
公式2中,ωy1分别表示飞行器的偏航通道的角速度。
气流角控制值具体可以是解算单元103或者飞行器中其它计算装置,根据当前气流角、以及本飞行器的小扰动气动力模型计算出的,具体连接结构和计算方法为本领域技术人员所熟知,此处不再赘述。
内回路控制单元105用于根据解算单元103反馈的三个通道的当前角速度,以及从外回路控制单元104接收的三个通道的角速度控制值,生成舵面偏转指令向执行机构101输出。
本发明实施例的技术方案中,解算单元103反馈输出的滚动、偏航、俯仰三个通道的当前气动角、当前角速度都包含了飞行器实际飞行姿态的运动耦合以及非线性等因素;偏航、俯仰通道上各自由交联支路引起的偏航、俯仰角速度都包含了通道之间的运动耦合因素;因此,根据依次由三个通道的当前气动角、交联支路引起的偏航和俯仰角速度、以及三个通道的当前角速度分别对三个通道的角速度控制值的进行补偿,等效于在三个通道之间进行解耦,使得解耦之后的单个通道的角速度的变化呈现准线性或者线性;从而使得多通道姿态控制器获取更强的通道解耦效果,可以更加稳定地控制飞行器进行飞行。
而且,由外回路控制单元104分担三个通道的当前气动角,以及偏航、俯仰通道上由交联支路引起的偏航、俯仰角速度的补偿;由内回路控制单元105分担三个通道的当前角速度的补偿;有利于简化多通道姿态控制器的结构,降低多通道姿态控制器的设计复杂度,便于对三个通道的角速度的控制。
本发明实施例的飞行器的多通道姿态控制器中,内回路控制单元105的内部结构的框架示意图,如图2a所示,包括:内回路滚动通道控制子单元251、内回路偏航通道控制子单元252、内回路俯仰通道控制子单元253和控制分配子单元254。
内回路滚动通道控制子单元251、内回路偏航通道控制子单元252、内回路俯仰通道控制子单元253的输入端,分别与外回路控制单元104的三通道输出端相连,并且分别与解算单元103的一组三通道输出端相连;内回路滚动通道控制子单元251、内回路偏航通道控制子单元252、内回路俯仰通道控制子单元253的输出端分别连接到控制分配子单元254的三通道输入端;控制分配子单元254的输出端连接到执行机构101。
内回路滚动通道控制子单元251用于计算飞行器的滚动通道的角速度控制值与该滚动通道的当前角速度的偏差,将计算出的偏差经过本内回路滚动通道控制子单元内部预设的内回路滚动通道增益控制网络的运算后进行输出。内回路滚动通道增益控制网络具体可以是采用PID(Proportion IntegrationDifferentiation,比例积分微分)控制方法设计的,或者可以是采用频率域设计方法设计的。PID控制方法以及频率域设计方法都为本领域的常用技术手段,此处不再赘述。
内回路偏航通道控制子单元252用于计算飞行器的偏航通道的角速度控制值与该偏航通道的当前角速度的偏差,将计算出的偏差经过本内回路偏航通道控制子单元内部预设的内回路偏航通道增益控制网络的运算后进行输出。内回路偏航通道增益控制网络具体可以是采用PID控制方法设计的,或者可以是采用频率域设计方法设计的。
内回路俯仰通道控制子单元253用于计算飞行器的俯仰通道的角速度控制值与该俯仰通道的当前角速度的偏差,将计算出的偏差经过本内回路俯仰通道控制子单元内部预设的内回路俯仰通道增益控制网络的运算后进行输出。内回路俯仰通道增益控制网络具体可以是采用PID控制方法设计的,或者可以是采用频率域设计方法设计的。
控制分配子单元254用于根据内回路滚动通道控制子单元251、内回路偏航通道控制子单元252,以及内回路俯仰通道控制子单元253的输出进行控制分配,输出相应的舵面偏转指令。
控制分配子单元254进行的控制分配,可以将飞行舵的舵效应的非线性特性补偿为线性特性,将舵效应的耦合特性补偿为对角特性;相当于可以将控制分配子单元254与飞行舵的组合等效为近似线性、并解耦的飞行舵;并且,每个通道的增益控制网络可以通过调整增益,进行分段或者连续地对该通道的角速度的偏差进行调整,有利于改善内回路控制单元105的稳态和动态品质;从而使得多通道姿态控制器获得更强的通道解耦效果而有利于控制飞行器的飞行。
而且,可以根据近似线性、并解耦的飞行舵来设计内回路滚动通道增益控制网络、内回路偏航通道增益控制网络、内回路俯仰通道增益控制网络;从而内回路控制单元105可以镇定静不稳定的控制对象,并具有较大的稳定裕度;可以抑制内回路控制单元105的弹性振动;具有良好的动态品质,例如稳定性(即等效阻尼)、快速性;对参数偏差和飞行姿态具有性能鲁棒性,并且动态特性随飞行器的飞行状态的散步较小;达到更稳定地控制飞行器进行飞行的目的。飞行舵的线性化和解耦化,可以简化内回路滚动通道增益控制网络、内回路偏航通道增益控制网络、内回路俯仰通道增益控制网络的结构;从而降低多通道姿态控制器的设计复杂度。
外回路控制单元104的内部结构的框架示意图,如图2b所示,包括:外回路滚动通道控制子单元241、外回路偏航通道控制子单元242和外回路俯仰通道控制子单元243。
外回路滚动通道控制子单元241、外回路偏航通道控制子单元242和外回路俯仰通道控制子单元243的输出端组成外回路控制单元104的三通道输出端,分别与内回路滚动通道控制子单元251、内回路偏航通道控制子单元252、内回路俯仰通道控制子单元253的输入端相连;外回路滚动通道控制子单元241、外回路偏航通道控制子单元242和外回路俯仰通道控制子单元243的输入端分别与解算单元103的另一组三通道输出端相连。
外回路滚动通道控制子单元241用于计算飞行器的滚动通道的气流角控制值与该滚动通道的当前气流角的偏差,将计算出的偏差经过本外回路滚动通道控制子单元内部预设的外回路滚动通道增益控制网络的运算后,作为该滚动通道的角速度控制值向内回路滚动通道控制子单元251输出。外回路滚动通道增益控制网络具体可以是采用PID控制方法设计的,或者可以是采用频率域设计方法设计的。
外回路偏航通道控制子单元242用于计算飞行器的偏航通道的气流角控制值与该偏航通道的当前气流角的偏差,将计算出的偏差经过本外回路偏航通道控制子单元内部预设的外回路偏航通道增益控制网络的运算、并与偏航通道上由交联支路引起的偏航角速度相加后,作为该偏航通道的角速度控制值向内回路偏航通道控制子单元252输出。外回路偏航通道增益控制网络具体可以是采用PID控制方法设计的,或者可以是采用频率域设计方法设计的。
外回路俯仰通道控制子单元243用于计算飞行器的俯仰通道的气流角控制值与该俯仰通道的当前气流角的偏差,将计算出的偏差经过本外回路俯仰通道控制子单元内部预设的外回路俯仰通道增益控制网络的运算、并与俯仰通道上由交联支路引起的俯仰角速度相加后,作为该俯仰通道的角速度控制值向内回路俯仰通道控制子单元253输出。外回路俯仰通道增益控制网络具体可以是采用PID控制方法设计的,或者可以是采用频率域设计方法设计的。
外回路控制单元104中,偏航、俯仰通道上由交联支路引起的偏航、俯仰角速度对各自通道的角速度调整值进行补偿,相当于对飞行器的偏航通道与其它通道之间、俯仰通道与其它通道之间的运动耦合进行解耦,从而有利于控制飞行器进行转弯等飞行姿态的改变。
事实上,本发明实施例中,还可以过载的反馈方式代替上述的气流角的反馈方式,具体地:将当前过载、过载控制值分别代替本发明实施例中上述的当前气流角、气流角控制值,并且其他结构、连接关系和功能等都不变;也可以达到本发明的目的。更优的,可以根据飞行器的飞行状态选择不同的反馈方式:当飞行器飞行较为平缓、机动动作不剧烈时,可以选择气流角的反馈方式;当飞行器的机动动作较剧烈时,宜选择过载的反馈方式。
本发明的技术方案中,解算单元输出的滚动、偏航、俯仰三个通道的反馈参数都包含了飞行器实际飞行姿态的运动耦合以及非线性等因素;偏航、俯仰通道上由交联支路引起的偏航、俯仰角速度都包含了通道之间的运动耦合因素;根据三个通道的反馈参数、由交联支路引起的偏航和俯仰角速度对三个通道的角速度控制值进行补偿,可以使得多通道姿态控制器获得更强的通道解耦效果而更加稳定地控制飞行器进行飞行。
而且,由内、外回路控制单元分担补偿任务;有利于简化多通道姿态控制器的结构,降低多通道姿态控制器的设计复杂度,便于对三个通道的角速度的控制。
进一步,控制分配子单元进行的控制分配,可以使得内回路三个通道增益控制网络根据近似线性、并解耦的飞行舵来设计;有利于增强内回路控制单元的性能而更稳定地控制飞行器进行飞行,并且进一步降低多通道姿态控制器的设计复杂度。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,该程序可以存储于计算机可读取存储介质中,如:ROM/RAM、磁碟、光盘等。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以作出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种飞行器的多通道姿态控制器,包括:执行机构和惯性平台,其特征在于,还包括:
解算单元,用于根据所述飞行器的多通道姿态控制器的惯性平台的测量信息,计算出所述飞行器滚动通道、偏航通道、俯仰通道的当前角速度、当前气流角进行反馈输出;
外回路控制单元,用于根据所述解算单元反馈的滚动、偏航、俯仰通道的当前气流角,以及接收的所述滚动、偏航、俯仰通道的气流角控制值,计算出所述滚动、偏航、俯仰通道的角速度调整值,并将计算出的所述偏航通道的角速度调整值与偏航通道上由交联支路引起的偏航角速度相加得到所述偏航通道的角速度控制值;将计算出的所述俯仰通道的角速度调整值与俯仰通道上由交联支路引起的俯仰角速度相加得到所述俯仰通道的角速度控制值;之后,将所述滚动通道的角速度调整值作为计算出的滚动通道的角速度控制值、以及所述偏航、俯仰通道的角速度控制值进行输出;
内回路控制单元,用于根据所述解算单元反馈的所述三个通道的当前角速度,以及从所述外回路控制单元接收的三个通道的角速度控制值,生成舵面偏转指令向所述执行机构输出。
2.如权利要求1所述的控制器,其特征在于,所述内回路控制单元具体包括:
内回路滚动通道控制子单元,用于计算所述滚动通道的角速度控制值与所述滚动通道的当前角速度的偏差,将计算出的偏差经过预设的内回路滚动通道增益控制网络的运算后进行输出;
内回路偏航通道控制子单元,用于计算所述偏航通道的角速度控制值与所述偏航通道的当前角速度的偏差,将计算出的偏差经过预设的内回路偏航通道增益控制网络的运算后进行输出;
内回路俯仰通道控制子单元,用于计算所述俯仰通道的角速度控制值与所述俯仰通道的当前角速度的偏差,将计算出的偏差经过预设的内回路俯仰通道增益控制网络的运算后进行输出;
控制分配子单元,用于根据所述内回路滚动通道控制子单元、内回路偏航通道控制子单元,以及内回路俯仰通道控制子单元的输出进行控制分配,输出相应的舵面偏转指令。
3.如权利要求2所述的控制器,其特征在于,所述内回路滚动、偏航、俯仰通道增益控制网络是采用比例积分微分PID控制方法设计的;或者
所述内回路滚动、偏航、俯仰通道增益控制网络是采用频率域设计方法设计的。
4.如权利要求2所述的控制器,其特征在于,所述外回路控制单元具体包括:
外回路滚动通道控制子单元,用于计算所述滚动通道的气流角控制值与所述滚动通道的当前气流角的偏差,将计算出的偏差经过预设的外回路滚动通道增益控制网络的运算后,作为所述滚动通道的角速度控制值向所述内回路滚动通道控制子单元输出;
外回路偏航通道控制子单元,用于计算所述偏航通道的气流角控制值与所述偏航通道的当前气流角的偏差,将计算出的偏差经过预设的外回路偏航通道增益控制网络的运算、并与偏航通道上由交联支路引起的偏航角速度相加后,作为所述偏航通道的角速度控制值向所述内回路偏航通道控制子单元输出;
外回路俯仰通道控制子单元,用于计算所述俯仰通道的气流角控制值与所述俯仰通道的当前气流角的偏差,将计算出的偏差经过预设的外回路俯仰通道增益控制网络的运算、并与俯仰通道上由交联支路引起的俯仰角速度相加后,作为所述俯仰通道的角速度控制值向所述内回路俯仰通道控制子单元输出。
5.如权利要求4所述的控制器,其特征在于,所述外回路滚动、偏航、俯仰通道增益控制网络是采用PID控制方法设计的;或者
所述外回路滚动、偏航、俯仰通道增益控制网络是采用频率域设计方法设计的。
6.一种飞行器的多通道姿态控制器,包括:执行机构和惯性平台,其特征在于,还包括:
解算单元,用于根据所述飞行器的多通道姿态控制器的惯性平台的测量信息,计算出所述飞行器滚动通道、偏航通道、俯仰通道的当前角速度、当前过载进行反馈输出;
外回路控制单元,用于根据所述解算单元反馈的滚动、偏航、俯仰通道的当前过载,以及接收的所述滚动、偏航、俯仰通道的过载控制值,计算出所述滚动、偏航、俯仰通道的角速度调整值,并将计算出的所述偏航通道的角速度调整值与偏航通道上由交联支路引起的偏航角速度相加得到所述偏航通道的角速度控制值;将计算出的所述俯仰通道的角速度调整值与俯仰通道上由交联支路引起的俯仰角速度相加得到所述俯仰通道的角速度控制值;之后,将所述滚动通道的角速度调整值,作为计算出的滚动通道的角速度控制值、以及所述偏航、俯仰通道的角速度控制值进行输出;
内回路控制单元,用于根据所述解算单元反馈的所述三个通道的当前角速度,以及从所述外回路控制单元接收的三个通道的角速度控制值,生成舵面偏转指令向所述执行机构输出。
7.如权利要求6所述的控制器,其特征在于,所述内回路控制单元具体包括:
内回路滚动通道控制子单元,用于计算所述滚动通道的角速度控制值与所述滚动通道的当前角速度的偏差,将计算出的偏差经过预设的内回路滚动通道增益控制网络的运算后进行输出;
内回路偏航通道控制子单元,用于计算所述偏航通道的角速度控制值与所述偏航通道的当前角速度的偏差,将计算出的偏差经过预设的内回路偏航通道增益控制网络的运算后进行输出;
内回路俯仰通道控制子单元,用于计算所述俯仰通道的角速度控制值与所述俯仰通道的当前角速度的偏差,将计算出的偏差经过预设的内回路俯仰通道增益控制网络的运算后进行输出;
控制分配子单元,用于根据所述内回路滚动通道控制子单元、内回路偏航通道控制子单元,以及内回路俯仰通道控制子单元的输出进行控制分配,输出相应的舵面偏转指令。
8.如权利要求7所述的控制器,其特征在于,所述内回路滚动、偏航、俯仰通道增益控制网络是采用PID控制方法设计的;或者
所述内回路滚动、偏航、俯仰通道增益控制网络是采用频率域设计方法设计的。
9.如权利要求7所述的控制器,其特征在于,所述外回路控制单元具体包括:
外回路滚动通道控制子单元,用于计算所述滚动通道的过载控制值与所述滚动通道的当前过载的偏差,将计算出的偏差经过预设的外回路滚动通道增益控制网络的运算后,作为所述滚动通道的角速度控制值向所述内回路滚动通道控制子单元输出;
外回路偏航通道控制子单元,用于计算所述偏航通道的过载控制值与所述偏航通道的当前过载的偏差,将计算出的偏差经过预设的外回路偏航通道增益控制网络的运算、并与偏航通道上由交联支路引起的偏航角速度相加后,作为所述偏航通道的角速度控制值向所述内回路偏航通道控制子单元输出;
外回路俯仰通道控制子单元,用于计算所述俯仰通道的过载控制值与所述俯仰通道的当前过载的偏差,将计算出的偏差经过预设的外回路俯仰通道增益控制网络的运算、并与俯仰通道上由交联支路引起的俯仰角速度相加后,作为所述俯仰通道的角速度控制值向所述内回路俯仰通道控制子单元输出。
10.如权利要求9所述的控制器,其特征在于,所述外回路滚动、偏航、俯仰通道增益控制网络是采用PID控制方法设计的;或者
所述外回路滚动、偏航、俯仰通道增益控制网络是采用频率域设计方法设计的。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410394876.9A CN104155988B (zh) | 2014-08-12 | 2014-08-12 | 飞行器的多通道姿态控制器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410394876.9A CN104155988B (zh) | 2014-08-12 | 2014-08-12 | 飞行器的多通道姿态控制器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104155988A CN104155988A (zh) | 2014-11-19 |
CN104155988B true CN104155988B (zh) | 2015-05-20 |
Family
ID=51881512
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410394876.9A Expired - Fee Related CN104155988B (zh) | 2014-08-12 | 2014-08-12 | 飞行器的多通道姿态控制器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104155988B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104699110B (zh) * | 2015-02-05 | 2017-07-21 | 大连理工大学 | 可编程飞行器控制引擎ip核 |
CN105912008A (zh) * | 2016-06-13 | 2016-08-31 | 合肥赛为智能有限公司 | 一种电力铁塔巡检无人机飞控系统及其飞控方法 |
CN106200664B (zh) * | 2016-08-19 | 2017-04-19 | 北京航天自动控制研究所 | 一种适应长时间失控的姿态控制方法 |
US11067981B2 (en) | 2017-03-01 | 2021-07-20 | Textron Innovations, Inc. | Aircraft control mode transition smoothing |
US10481615B2 (en) * | 2017-03-01 | 2019-11-19 | Bell Textron Inc. | Rotorcraft control mode transition smoothing |
CN107703905B (zh) * | 2017-07-28 | 2020-02-14 | 北京宇航系统工程研究所 | 一种全闭环航天器姿控极性测试方法 |
CN108089593B (zh) * | 2017-12-03 | 2021-02-26 | 中国直升机设计研究所 | 一种无人直升机航向补偿航线过渡的方法 |
CN110069012A (zh) * | 2018-01-23 | 2019-07-30 | 北京京东尚科信息技术有限公司 | 用于抑制噪声的控制量确定方法和装置、姿态控制系统 |
CN109407690A (zh) * | 2018-12-27 | 2019-03-01 | 湖北航天飞行器研究所 | 一种飞行器稳定控制方法 |
CN110411289B (zh) * | 2019-06-13 | 2021-10-15 | 上海航天控制技术研究所 | 一种抑制强机弹干扰的分离稳定控制方法 |
CN110231831B (zh) * | 2019-07-23 | 2022-01-28 | 兰州理工大学 | 一种基于角度测量的航天器姿态解耦最优控制方法 |
CN111309042B (zh) * | 2020-03-06 | 2022-05-27 | 中国人民解放军海军航空大学 | 一种以过载与角速度为外回路的飞行器过载跟踪方法 |
CN111367319B (zh) * | 2020-05-06 | 2021-01-08 | 仿翼(北京)科技有限公司 | 飞行器、飞行器的控制方法及计算机可读存储介质 |
CN112129284B (zh) * | 2020-09-10 | 2022-09-30 | 中国人民解放军海军航空大学 | 一种仅测量角速率的简单过载控制方法 |
CN112325710B (zh) * | 2020-09-24 | 2023-03-31 | 北京航天自动控制研究所 | 一种运载火箭大推力直接入轨高精度姿态控制方法和系统 |
CN112327626B (zh) * | 2020-11-14 | 2022-06-21 | 西北工业大学 | 基于数据分析的飞行器通道耦合协调控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008282195A (ja) * | 2007-05-10 | 2008-11-20 | Toshiba Corp | 飛しょう体の制御装置 |
CN102163059A (zh) * | 2011-04-27 | 2011-08-24 | 南京航空航天大学 | 推力变向无人机的姿态控制系统及控制方法 |
CN102360216A (zh) * | 2011-05-20 | 2012-02-22 | 南京航空航天大学 | 双发舰载飞机单发停车的安全着舰控制方法 |
CN102426458A (zh) * | 2011-11-28 | 2012-04-25 | 北京航空航天大学 | 一种适用于旋翼无人机的地面控制系统 |
JP5029442B2 (ja) * | 2007-08-27 | 2012-09-19 | 株式会社豊田中央研究所 | 車両姿勢角推定装置及びプログラム |
CN103076806A (zh) * | 2011-10-26 | 2013-05-01 | 北京航天长征飞行器研究所 | 三回路自动驾驶仪控制参数一体化解析整定方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8306674B2 (en) * | 2009-10-01 | 2012-11-06 | Raytheon Company | System and method for divert and attitude control in flight vehicles |
-
2014
- 2014-08-12 CN CN201410394876.9A patent/CN104155988B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008282195A (ja) * | 2007-05-10 | 2008-11-20 | Toshiba Corp | 飛しょう体の制御装置 |
JP5029442B2 (ja) * | 2007-08-27 | 2012-09-19 | 株式会社豊田中央研究所 | 車両姿勢角推定装置及びプログラム |
CN102163059A (zh) * | 2011-04-27 | 2011-08-24 | 南京航空航天大学 | 推力变向无人机的姿态控制系统及控制方法 |
CN102360216A (zh) * | 2011-05-20 | 2012-02-22 | 南京航空航天大学 | 双发舰载飞机单发停车的安全着舰控制方法 |
CN103076806A (zh) * | 2011-10-26 | 2013-05-01 | 北京航天长征飞行器研究所 | 三回路自动驾驶仪控制参数一体化解析整定方法 |
CN102426458A (zh) * | 2011-11-28 | 2012-04-25 | 北京航空航天大学 | 一种适用于旋翼无人机的地面控制系统 |
Also Published As
Publication number | Publication date |
---|---|
CN104155988A (zh) | 2014-11-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104155988B (zh) | 飞行器的多通道姿态控制器 | |
CN105242676B (zh) | 一种有限时间收敛时变滑模姿态控制方法 | |
CN104950898B (zh) | 一种再入飞行器全阶非奇异终端滑模姿态控制方法 | |
CN102862686B (zh) | 再入飞行器的最优积分滑模姿态控制方法及控制器 | |
CN102929283B (zh) | 基于sdre的再入飞行器自适应最优滑模姿态控制方法 | |
CN106843245A (zh) | 一种无人机姿态控制方法、装置及无人机 | |
CN104950899B (zh) | 一种固定时间收敛的飞行器姿态控制方法 | |
CN102163059B (zh) | 推力变向无人机的姿态控制系统及控制方法 | |
CN102707624B (zh) | 基于飞行器常规模型的纵向控制器区域设计方法 | |
CN102707723B (zh) | 基于飞行器常规模型的横航向控制器区域设计方法 | |
CN103558857A (zh) | 一种btt飞行器的分布式复合抗干扰姿态控制方法 | |
CN104950671A (zh) | 基于自适应模糊的再入飞行器pid型滑模姿态控制方法 | |
CN110316400B (zh) | 一种鸭翼布局固定翼无人机直接升力控制方法 | |
CN102736631B (zh) | 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 | |
CN104298109A (zh) | 基于多控制器融合的无尾飞行器协调转弯控制方法 | |
CN106647264A (zh) | 一种基于控制约束的扩展鲁棒h∞的无人机控制方法 | |
CN105116914A (zh) | 一种平流层飞艇解析模型预测路径跟踪控制方法 | |
Li et al. | Angular acceleration estimation-based incremental nonlinear dynamic inversion for robust flight control | |
CN102692928B (zh) | 基于飞行器四元数模型的控制器区域设计方法 | |
CN102707722B (zh) | 基于飞行器常规模型的全维控制器区域设计方法 | |
CN103455035A (zh) | 基于反步设计和非线性反馈的pd+姿态控制律设计方法 | |
CN102707629B (zh) | 基于飞行器切换模型的全维控制器区域设计方法 | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN110231831B (zh) | 一种基于角度测量的航天器姿态解耦最优控制方法 | |
CN104155989A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150520 Termination date: 20200812 |
|
CF01 | Termination of patent right due to non-payment of annual fee |