CN104590557B - 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置 - Google Patents
一种多旋翼和固定翼复合飞行器的飞行控制方法及装置 Download PDFInfo
- Publication number
- CN104590557B CN104590557B CN201510061186.6A CN201510061186A CN104590557B CN 104590557 B CN104590557 B CN 104590557B CN 201510061186 A CN201510061186 A CN 201510061186A CN 104590557 B CN104590557 B CN 104590557B
- Authority
- CN
- China
- Prior art keywords
- formula
- control
- pitch
- rotor
- controlled variable
- 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
本申请公开了一种多旋翼和固定翼复合飞行器的飞行控制方法及装置,当复合飞行器处于混合工作模式时,对复合飞行器的当前姿态角和姿态角指令求差,得到姿态角偏差信号,对姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备,从而使固定翼各舵机带动自身舵面偏转,多旋翼设备控制转速或桨距变化,固定翼和多旋翼各自产生的相应控制力,使机体向减小姿态角偏差方向运动,从而消除姿态角偏差。可以看出,本发明通过采用控制量分配技术,实现对固定翼舵面和多旋翼的转速或桨距的同时控制,完成了对复合飞行器的姿态控制,具备固定翼与多旋翼组成的复合飞行器在混合工作模式下的飞行控制功能。
Description
技术领域
本发明涉及复合飞行器技术领域,更具体的说,涉及一种多旋翼和固定翼复合飞行器的飞行控制方法及装置。
背景技术
由固定翼和多旋翼组成的复合飞行器是近年来出现的一种新型飞行器,复合飞行器综合了固定翼与多旋翼的优点,其既可以像直升机一样垂直起降和飞行,又可以像固定翼飞机一样起降和飞行,也可以使用两个动力***混合工作模式实现起降和飞行。
复合飞行器包括一个多旋翼动力***、一个固定翼动力***和一个控制***,固定翼动力***与多旋翼动力***在结构上相互独立,控制***包括固定翼控制***和多旋翼控制***,控制***可以控制固定翼控制***和多旋翼控制***单独工作或是协同工作。
当复合飞行器处于混合工作模式时,控制***通过控制固定翼控制***和多旋翼控制***协同工作实现固定翼动力***与多旋翼动力***的协同工作,从而实现复合飞行器完成直升机模式飞行和固定翼模式飞行间的转换。但是,在混合工作模式下,当复合飞行器的空速较小,甚至接近于零时,由于固定翼操作舵面产生的控制力较小,不足以完成对复合飞行器的控制,因此,目前采用控制多旋翼的转速或桨距的控制姿态来减小姿态角偏差,并不利用固定翼的操作舵面,从而造成资源浪费,导致控制***的控制效率低。
发明内容
有鉴于此,本发明提供一种多旋翼和固定翼复合飞行器的飞行控制方法及装置,以实现对固定翼舵面和多旋翼的同时控制,提高控制***的控制效率。
一种多旋翼和固定翼复合飞行器的飞行控制方法,包括:
当复合飞行器处于混合工作模式时,获取惯性组合输出的所述复合飞行器的当前姿态角、当前角速度、当前速度和当前位置;
利用所述当前速度和当前位置,计算得到姿态角指令;
对所述当前姿态角和所述姿态角指令求差,得到姿态角偏差信号,所述姿态角偏差信号包括滚动姿态角偏差信号和俯仰姿态角偏差信号;
对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备,以使固定翼各舵机带动自身舵面偏转,所述多旋翼设备控制转速或桨距变化。
优选的,所述对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备的过程具体如下:
将所述姿态角偏差信号带入第一公式,得到滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz,所述第一公式的表达式如下:
式中,kx1Wx1(s)为滚动角速度静态增益及校正网络,kx2Wx2(s)为滚动角静态增益及校正网络,ky1Wy1(s)为偏航角速度静态增益及校正网络,kz1Wz1(s)为俯仰角速度静态增益及校正网络,kz2Wz2(s)为俯仰角静态增益及校正网络,ωx为滚动角速度,ωy为偏航角速度,ωz为俯仰角速度,γ为滚动角,为俯仰角,γc为滚动角指令,俯仰角指令,(γ-γc)为滚动姿态角偏差信号,为俯仰姿态角偏差信号;
将获取的所述复合飞行器的当前空速带入第二公式,得到控制量分配系数η,所述当前空速由大气数据计算机测量得到,所述第二公式的表达式如下:
式中,V为复合飞行器的当前空速,Vmin为固定翼失速速度;
利用第三公式分别计算副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az,所述第三公式的表达式如下:
式中,为旋翼滚动通道控制力矩导数,为旋翼偏航通道控制力矩导数,为旋翼俯仰通道控制力矩导数,为副翼控制力矩导数,为方向舵控制力矩导数,为升降舵控制力矩导数;
将滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz带入第四公式,得到副翼舵控量δx、方向舵舵控量δy和升降舵舵控量δz,所述第四公式表达式如下:
将滚动通道控制量Ux、偏航通道控制量Uy、俯仰通道控制量Uz、控制量分配系数η、副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az带入第五公式,得到旋翼设备的旋翼通道控制量Tx、偏航通道控制量Ty和俯仰通道控制量Tz,所述第五公式的表达式如下:
优选的,当所述多旋翼设备采用四旋翼时,第一旋翼的控制量D1、第二旋翼的控制量D2、第三旋翼的控制量D3和第四旋翼的控制量D4的获取参见第六公式,所述第六公式的表达式为:
式中,T0为维持复合飞行器水平飞行的桨距或转速。
一种多旋翼和固定翼复合飞行器的飞行控制装置,包括:
获取单元,用于当复合飞行器处于混合工作模式时,获取惯性组合输出的所述复合飞行器的当前姿态角、当前角速度、当前速度和当前位置;
计算单元,用于利用所述当前速度和当前位置,计算得到姿态角指令;
求差单元,用于对所述当前姿态角和所述姿态角指令求差,得到姿态角偏差信号,所述姿态角偏差信号包括滚动姿态角偏差信号和俯仰姿态角偏差信号;
配置单元,用于对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备,以使固定翼各舵机带动自身舵面偏转,所述多旋翼设备控制转速或桨距变化。
优选的,所述配置单元包括:
通道控制量求取子单元,用于将所述姿态角偏差信号带入第一公式,得到滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz,所述第一公式的表达式如下:
式中,kx1Wx1(s)为滚动角速度静态增益及校正网络,kx2Wx2(s)为滚动角静态增益及校正网络,ky1Wy1(s)为偏航角速度静态增益及校正网络,kz1Wz1(s)为俯仰角速度静态增益及校正网络,kz2Wz2(s)为俯仰角静态增益及校正网络,ωx为滚动角速度,ωy为偏航角速度,ωz为俯仰角速度,γ为滚动角,为俯仰角,γc为滚动角指令,俯仰角指令,(γ-γc)为滚动姿态角偏差信号,为俯仰姿态角偏差信号;
控制量分配系数求取单元,用于将获取的所述复合飞行器的当前空速带入第二公式,得到控制量分配系数η,所述当前空速由大气数据计算机测量得到,所述第二公式的表达式如下:
式中,V为复合飞行器的当前空速,Vmin为固定翼失速速度;
控制能力等效系数求取单元,用于利用第三公式分别计算副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az,所述第三公式的表达式如下:
式中,为旋翼滚动通道控制力矩导数,为旋翼偏航通道控制力矩导数,为旋翼俯仰通道控制力矩导数,为副翼控制力矩导数,为方向舵控制力矩导数,为升降舵控制力矩导数;
固定翼控制量分配子单元,用于将滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz带入第四公式,得到副翼舵控量δx、方向舵舵控量δy和升降舵舵控量δz,所述第四公式表达式如下:
多旋翼控制量分配子单元,用于将滚动通道控制量Ux、偏航通道控制量Uy、俯仰通道控制量Uz、控制量分配系数η、副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az带入第五公式,得到旋翼设备的旋翼通道控制量Tx、偏航通道控制量Ty和俯仰通道控制量Tz,所述第五公式的表达式如下:
优选的,当所述多旋翼设备采用四旋翼时,第一旋翼的控制量D1、第二旋翼的控制量D2、第三旋翼的控制量D3和第四旋翼的控制量D4的获取参见第六公式,所述第六公式的表达式为:
式中,T0为维持复合飞行器水平飞行的桨距或转速。
从上述的技术方案可以看出,本发明提供了一种多旋翼和固定翼复合飞行器的飞行控制方法及装置,当复合飞行器处于混合工作模式时,对复合飞行器的当前姿态角和姿态角指令求差,得到姿态角偏差信号,对姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备,从而使固定翼各舵机带动自身舵面偏转,多旋翼设备控制转速或桨距变化,固定翼和多旋翼各自产生的相应控制力,使机体向减小姿态角偏差方向运动,从而消除姿态角偏差。可以看出,本发明通过采用控制量分配技术,实现对固定翼舵面和多旋翼的转速或桨距的同时控制,完成了对复合飞行器的姿态控制,具备固定翼与多旋翼组成的复合飞行器在混合工作模式下的飞行控制功能,相比现有技术采用仅控制多旋翼的转速和桨距的方法而言,本发明充分利用了资源,从而提高了控制***的控制效率。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1为本发明实施例公开的一种多旋翼和固定翼复合飞行器的飞行控制***图;
图2为本发明实施例公开的一种多旋翼和固定翼复合飞行器的飞行控制方法流程图;
图3为本发明实施例公开的一种多旋翼和固定翼复合飞行器的飞行控制装置的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例公开了一种多旋翼和固定翼复合飞行器的飞行控制方法及装置,以实现对固定翼舵面和多旋翼的同时控制,提高控制***的控制效率。
参见图1,本发明实施例公开了一种多旋翼和固定翼复合飞行器的飞行控制***图,包括:惯性组合1、大气数据计算机2、升降舵机3、方向舵机4、副翼舵机5、多旋翼设备6和飞控计算机7;
飞控计算机7分别与惯性组合1、大气数据计算机2、升降舵机3、方向舵机4、副翼舵机5和多旋翼设备6连接。
需要说明的是,本实施例还可以根据飞控架构的不同相应的减少或增加设备,例如,增加GNSS(Global Navigation Satellite System,全球卫星导航***)接收***,减少方向舵机4。
惯性组合1可以用位置陀螺+速率陀螺+GNSS代替,飞控计算机7和惯性组合1可集成为导航控制器。
参见图2,本发明实施例公开的一种多旋翼和固定翼复合飞行器的飞行控制方法流程图,包括步骤:
步骤S11、当复合飞行器处于混合工作模式时,获取惯性组合1输出的所述复合飞行器的当前姿态角、当前角速度、当前速度和当前位置;
其中,惯性组合1是集成了三轴角速度陀螺、三轴加速度计和导航解算板的惯性导航测量装置,三轴角速度陀螺用于测量机组绕俯仰轴的角速度、偏航轴的角速度和滚动轴的角速度;三轴加速度计用于测量机组绕俯仰轴的加速度、偏航轴的加速度和滚动轴的加速度;导航解算板内设置有导航算法。
对机组绕俯仰轴的角速度、偏航轴的角速度和滚动轴的角速度采用导航算法可以得到复合飞行器的当前姿态角。
由机组绕俯仰轴的角速度、偏航轴的角速度、滚动轴的角速度、绕俯仰轴的加速度、偏航轴的加速度和滚动轴的加速度计算得到复合飞行器的当前速度。
根据复合飞行器的当前速度可以得到复合飞行器的当前位置。
其中,当前角速度包括:滚动角速度、偏航角速度和俯仰角速度。
步骤S12、利用所述当前速度和当前位置,计算得到姿态角指令;
计算姿态角指令的方法很多,其中一种常用的方法如下:
俯仰角指令根据爬升、平飞、下降等不同阶段采用不同的固定值;
滚动角指令γc计算公式如下:
式中,afc为法向加速度指令,单位为m/s2;
ahc为横向加速度指令,单位为m/s2;
Vn为飞行器地速,单位为m/s;
L1为法向导引系数;
L2为横向导引系数;
H为飞行高度,单位为m;
ΔH为飞行器与预定飞行高度的距离,单位为m;
z为飞行器与航路的距离,单位为m。
滚动角指令单位为rad。
步骤S13、对所述当前姿态角和所述姿态角指令求差,得到姿态角偏差信号;
其中,所述姿态角偏差信号包括滚动姿态角偏差信号、偏航姿态角偏差信号和俯仰姿态角偏差信号。
步骤S14、对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机3、方向舵机4、副翼舵机5和多旋翼设备6,以使固定翼各舵机带动自身舵面偏转,所述多旋翼设备6控制转速或桨距变化。
优选的,多旋翼设备6采用四旋翼。
综上可以看出,本发明提供的多旋翼和固定翼复合飞行器的飞行控制方法,当复合飞行器处于混合工作模式时,对复合飞行器的当前姿态角和姿态角指令求差,得到姿态角偏差信号,对姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机3、方向舵机4、副翼舵机5和多旋翼设备6,从而使固定翼各舵机带动自身舵面偏转,多旋翼设备6控制转速或桨距变化,固定翼和多旋翼各自产生的相应控制力,使机体向减小姿态角偏差方向运动,从而消除姿态角偏差。可以看出,本发明通过采用控制量分配技术,实现对固定翼舵面和多旋翼的转速和桨距的同时控制,完成了对复合飞行器的姿态控制,具备固定翼与多旋翼组成的复合飞行器在混合工作模式下的飞行控制功能,相比现有技术采用仅控制多旋翼的转速和桨距的方法而言,本发明充分利用了资源,从而提高了控制***的控制效率。
其次,由于固定翼舵面在空速较低的情况下控制效率低,多旋翼的转速或桨距在空速较大的情况下能耗较大,因此,本发明通过同时控制固定翼舵面和多旋翼的转速或桨距,可以实现两者之间的互补,从而提高控制效率,降低能耗。
再次,随着复合飞行器空速的逐步增加,可充分利用固定翼舵面的控制能力,减少多旋翼造成的阻力,提高复合飞行器的加速性,降低固定翼动力***的能耗。
进一步,固定翼舵面和多旋翼可共用一个飞控计算机和传感器,从而减少控制***器件,降低成本。
最后,本发明还可以实现多旋翼控制到固定翼舵面控制的平稳过渡,避免切换时的扰动。
为进一步对本发明的工作原理进行说明,当复合飞行器处于混合工作模式时,对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机3、方向舵机4、副翼舵机5和多旋翼设备6的过程,具体阐述如下:
第一步:利用姿态角偏差信号计算通道控制量;
将姿态角偏差信号带入第一公式(1),得到滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz,第一公式(1)的表达式如下:
式中,kx1Wx1(s)为滚动角速度静态增益及校正网络;
kx2Wx2(s)为滚动角静态增益及校正网络;
ky1Wy1(s)为偏航角速度静态增益及校正网络;
kz1Wz1(s)为俯仰角速度静态增益及校正网络;
kz2Wz2(s)为俯仰角静态增益及校正网络;
ωx为滚动角速度,单位rad/s;
ωy为偏航角速度,单位rad/s;
ωz为俯仰角速度,单位rad/s;
γ为滚动角,单位rad;
为俯仰角,单位rad;
γc为滚动角指令,单位rad;
俯仰角指令,单位rad。
第二步:计算通道控制量分配系数;
将获取的所述复合飞行器的当前空速带入第二公式得到控制量分配系数η,所述当前空速由大气数据计算机2测量得到,第二公式(2)的表达式如下:
式中,V为复合飞行器的当前空速,单位m/s;
Vmin为固定翼失速速度,单位m/s。
其中,Vmin是一个固定值。
需要说明的是,本发明采用通道控制量分配系数随复合飞行器飞行状态实时计算技术,可以实现旋翼控制到固定翼舵面控制的平稳过渡。
通道控制量分配系数的计算并不局限于上述方法,还可以采用其它方法,例如采用动压计算。
第三步:计算控制能力等效系数;
利用第三公式(3)分别计算副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az,第三公式(3)的表达式如下:
式中,为旋翼滚动通道控制力矩导数;
为旋翼偏航通道控制力矩导数;
为旋翼俯仰通道控制力矩导数;
为副翼控制力矩导数;
为方向舵控制力矩导数;
为升降舵控制力矩导数。
需要说明的是,本发明通过采用控制能力等效系数技术,可以实现固定翼舵面和旋翼控制量协调分配。
其中,在某些情况下,控制能力等效系数也可以采用控制力乘力臂来计算。
第四步:对固定翼控制量分配;
将滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz带入第四公式(4),得到副翼舵控量δx、方向舵舵控量δy和升降舵舵控量δz,第四公式(4)表达式如下:
其中,副翼舵控量δx、方向舵舵控量δy和升降舵舵控量δz的单位均为rad。
第五步,对多旋翼控制量分配;
将滚动通道控制量Ux、偏航通道控制量Uy、俯仰通道控制量Uz、控制量分配系数η、副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az带入第五公式(5),得到旋翼设备的旋翼通道控制量Tx、偏航通道控制量Ty和俯仰通道控制量Tz,第五公式(5)的表达式如下:
本领域技术人员都公知的是,多旋翼设备6至少有四个旋翼,由于多旋翼设备6多采用四旋翼,因此,本发明在多旋翼设备6为四旋翼时,对各旋翼的控制量分配进行了说明,具体参见第六公式(6),
式中,D1为第一旋翼的控制量;
D2为第二旋翼的控制量;
D3为第三旋翼的控制量;
D4为第四旋翼的控制量;
T0为维持复合飞行器水平飞行的桨距或转速。
其中,上述的第一步、第二步和第三步的执行顺序并不局限于本申请公开的顺序,同样,第四步和第五步的执行顺序并不局限于本申请公开的顺序。
需要说明的是,根据上述内容,获得的多于四旋翼的其他旋翼的控制量分配式也属于本发明的保护范围。
与上述方法实施例相对应,本发明还提供了一种多旋翼和固定翼复合飞行器的飞行控制***。
参见图3,本发明实施例公开的一种多旋翼和固定翼复合飞行器的飞行控制装置的结构示意图,包括
获取单元21,用于当复合飞行器处于混合工作模式时,获取惯性组合输出的所述复合飞行器的当前姿态角、当前角速度、当前速度和当前位置;
其中,当前角速度包括:滚动角速度、偏航角速度和俯仰角速度。
计算单元22,用于利用所述当前速度和当前位置,计算得到姿态角指令;
求差单元23,用于对所述当前姿态角和所述姿态角指令求差,得到姿态角偏差信号,所述姿态角偏差信号包括滚动姿态角偏差信号和俯仰姿态角偏差信号;
配置单元24,用于对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备,以使固定翼各舵机带动自身舵面偏转,所述多旋翼设备控制转速或桨距变化。
优选的,多旋翼设备6采用四旋翼。
综上可以看出,本发明提供的多旋翼和固定翼复合飞行器的飞行控制方法,当复合飞行器处于混合工作模式时,对复合飞行器的当前姿态角和姿态角指令求差,得到姿态角偏差信号,对姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机3、方向舵机4、副翼舵机5和多旋翼设备6,从而使固定翼各舵机带动自身舵面偏转,多旋翼设备6控制转速或桨距变化,固定翼和多旋翼各自产生的相应控制力,使机体向减小姿态角偏差方向运动,从而消除姿态角偏差。可以看出,本发明通过采用控制量分配技术,实现对固定翼舵面和多旋翼的转速和桨距的同时控制,完成了对复合飞行器的姿态控制,具备固定翼与多旋翼组成的复合飞行器在混合工作模式下的飞行控制功能,相比现有技术采用仅控制多旋翼的转速和桨距的方法而言,本发明充分利用了资源,从而提高了控制***的控制效率。
其次,由于固定翼舵面在空速较低的情况下控制效率低,多旋翼的转速或桨距在空速较大的情况下能耗较大,因此,本发明通过同时控制固定翼舵面和多旋翼的转速或桨距,可以实现两者之间的互补,从而提高控制效率,降低能耗。
再次,随着复合飞行器空速的逐步增加,可充分利用固定翼舵面的控制能力,减少多旋翼造成的阻力,提高复合飞行器的加速性,降低固定翼动力***的能耗。
进一步,固定翼舵面和多旋翼可共用一个飞控计算机和传感器,从而减少控制***器件,降低成本。
最后,本发明还可以实现多旋翼控制到固定翼舵面控制的平稳过渡,避免切换时的扰动。
为进一步对本发明的工作原理进行说明,当复合飞行器处于混合工作模式时,配置单元包括:通道控制量求取子单元、控制量分配系数求取单元、控制能力等效系数求取单元、固定翼控制量分配子单元和多旋翼控制量分配子单元;
通道控制量求取子单元,用于将姿态角偏差信号带入第一公式(1),得到滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz,第一公式(1)的表达式如下:
式中,kx1Wx1(s)为滚动角速度静态增益及校正网络;
kx2Wx2(s)为滚动角静态增益及校正网络;
ky1Wy1(s)为偏航角速度静态增益及校正网络;
kz1Wz1(s)为俯仰角速度静态增益及校正网络;
kz2Wz2(s)为俯仰角静态增益及校正网络;
ωx为滚动角速度,单位rad/s;
ωy为偏航角速度,单位rad/s;
ωz为俯仰角速度,单位rad/s;
γ为滚动角,单位rad;
为俯仰角,单位rad;
γc为滚动角指令,单位rad;
俯仰角指令,单位rad;
第二步:计算通道控制量分配系数;
控制量分配系数求取单元,用于将获取的所述复合飞行器的当前空速带入第二公式得到控制量分配系数η,所述当前空速由大气数据计算机2测量得到,第二公式(2)的表达式如下:
式中,V为复合飞行器的当前空速,单位m/s;
Vmin为固定翼失速速度,单位m/s。
其中,Vmin是一个固定值。
需要说明的是,本发明采用通道控制量分配系数随复合飞行器飞行状态实时计算技术,可以实现旋翼控制到固定翼舵面控制的平稳过渡。
通道控制量分配系数的计算并不局限于上述方法,还可以采用其它方法,例如采用动压计算。
控制能力等效系数求取单元,用于利用第三公式(3)分别计算副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az,第三公式(3)的表达式如下:
式中,为旋翼滚动通道控制力矩导数;
为旋翼偏航通道控制力矩导数;
为旋翼俯仰通道控制力矩导数;
为副翼控制力矩导数;
为方向舵控制力矩导数;
为升降舵控制力矩导数。
需要说明的是,本发明通过采用控制能力等效系数技术,可以实现固定翼舵面和旋翼控制量协调分配。
其中,在某些情况下,控制能力等效系数也可以采用控制力乘力臂来计算。
固定翼控制量分配子单元,用于将滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz带入第四公式(4),得到副翼舵控量δx、方向舵舵控量δy和升降舵舵控量δz,第四公式(4)表达式如下:
其中,副翼舵控量δx、方向舵舵控量δy和升降舵舵控量δz的单位均为rad。
多旋翼控制量分配子单元,用于将滚动通道控制量Ux、偏航通道控制量Uy、俯仰通道控制量Uz、控制量分配系数η、副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az带入第五公式(5),得到旋翼设备的旋翼通道控制量Tx、偏航通道控制量Ty和俯仰通道控制量Tz,第五公式(5)的表达式如下:
本领域技术人员都公知的是,多旋翼设备6至少有四个旋翼,由于多旋翼设备6多采用四旋翼,因此,本发明在多旋翼设备6为四旋翼时,对各旋翼的控制量分配进行了说明,具体参见第六公式(6),
式中,D1为第一旋翼的控制量;
D2为第二旋翼的控制量;
D3为第三旋翼的控制量;
D4为第四旋翼的控制量;
T0为维持复合飞行器水平飞行的桨距或转速。
需要说明的是,根据上述内容,获得的多于四旋翼的其他旋翼的控制量分配式也属于本发明的保护范围。
其中,装置实施例中各组成部分的具体工作原理参见方法实施例对应部分,本发明在此不做限定。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (6)
1.一种多旋翼和固定翼复合飞行器的飞行控制方法,其特征在于,包括:
当复合飞行器处于混合工作模式时,获取惯性组合输出的所述复合飞行器的当前姿态角、当前角速度、当前速度和当前位置;
利用所述当前速度和当前位置,计算得到姿态角指令;
对所述当前姿态角和所述姿态角指令求差,得到姿态角偏差信号,所述姿态角偏差信号包括滚动姿态角偏差信号和俯仰姿态角偏差信号;
对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备,以使固定翼各舵机带动自身舵面偏转,所述多旋翼设备控制转速或桨距变化。
2.根据权利要求1所述的飞行控制方法,其特征在于,所述对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备的过程具体如下:
将所述姿态角偏差信号带入第一公式,得到滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz,所述第一公式的表达式如下:
式中,kx1Wx1(s)为滚动角速度静态增益及校正网络,kx2Wx2(s)为滚动角静态增益及校正网络,ky1Wy1(s)为偏航角速度静态增益及校正网络,kz1Wz1(s)为俯仰角速度静态增益及校正网络,kz2Wz2(s)为俯仰角静态增益及校正网络,ωx为滚动角速度,ωy为偏航角速度,ωz为俯仰角速度,γ为滚动角,为俯仰角,γc为滚动角指令,俯仰角指令,(γ-γc)为滚动姿态角偏差信号,为俯仰姿态角偏差信号;
将获取的所述复合飞行器的当前空速带入第二公式,得到控制量分配系数η,所述当前空速由大气数据计算机测量得到,所述第二公式的表达式如下:
式中,V为复合飞行器的当前空速,Vmin为固定翼失速速度;
利用第三公式分别计算副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az,所述第三公式的表达式如下:
式中,为旋翼滚动通道控制力矩导数,为旋翼偏航通道控制力矩导数,为旋翼俯仰通道控制力矩导数,为副翼控制力矩导数,为方向舵控制力矩导数,为升降舵控制力矩导数;
将滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz带入第四公式,得到副翼舵控量δx、方向舵舵控量δy和升降舵舵控量δz,所述第四公式表达式如下:
将滚动通道控制量Ux、偏航通道控制量Uy、俯仰通道控制量Uz、控制量分配系数η、副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az带入第五公式,得到旋翼设备的滚动通道控制量Tx、偏航通道控制量Ty和俯仰通道控制量Tz,所述第五公式的表达式如下:
3.根据权利要求2所述的飞行控制方法,其特征在于,当所述多旋翼设备采用四旋翼时,第一旋翼的控制量D1、第二旋翼的控制量D2、第三旋翼的控制量D3和第四旋翼的控制量D4的获取参见第六公式,所述第六公式的表达式为:
式中,T0为维持复合飞行器水平飞行的桨距或转速。
4.一种多旋翼和固定翼复合飞行器的飞行控制装置,其特征在于,包括:
获取单元,用于当复合飞行器处于混合工作模式时,获取惯性组合输出的所述复合飞行器的当前姿态角、当前角速度、当前速度和当前位置;
计算单元,用于利用所述当前速度和当前位置,计算得到姿态角指令;
求差单元,用于对所述当前姿态角和所述姿态角指令求差,得到姿态角偏差信号,所述姿态角偏差信号包括滚动姿态角偏差信号和俯仰姿态角偏差信号;
配置单元,用于对所述姿态角偏差信号采用控制量分配技术进行运算处理后,分别配置到升降舵机、方向舵机、副翼舵机和多旋翼设备,以使固定翼各舵机带动自身舵面偏转,所述多旋翼设备控制转速或桨距变化。
5.根据权利要求4所述的飞行控制装置,其特征在于,所述配置单元包括:
通道控制量求取子单元,用于将所述姿态角偏差信号带入第一公式,得到滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz,所述第一公式的表达式如下:
式中,kx1Wx1(s)为滚动角速度静态增益及校正网络,kx2Wx2(s)为滚动角静态增益及校正网络,ky1Wy1(s)为偏航角速度静态增益及校正网络,kz1Wz1(s)为俯仰角速度静态增益及校正网络,kz2Wz2(s)为俯仰角静态增益及校正网络,ωx为滚动角速度,ωy为偏航角速度,ωz为俯仰角速度,γ为滚动角,为俯仰角,γc为滚动角指令,俯仰角指令,(γ-γc)为滚动姿态角偏差信号,为俯仰姿态角偏差信号;
控制量分配系数求取单元,用于将获取的所述复合飞行器的当前空速带入第二公式,得到控制量分配系数η,所述当前空速由大气数据计算机测量得到,所述第二公式的表达式如下:
式中,V为复合飞行器的当前空速,Vmin为固定翼失速速度;
控制能力等效系数求取单元,用于利用第三公式分别计算副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az,所述第三公式的表达式如下:
式中,为旋翼滚动通道控制力矩导数,为旋翼偏航通道控制力矩导数,为旋翼俯仰通道控制力矩导数,为副翼控制力矩导数,为方向舵控制力矩导数,为升降舵控制力矩导数;
固定翼控制量分配子单元,用于将滚动通道控制量Ux、偏航通道控制量Uy和俯仰通道控制量Uz带入第四公式,得到副翼舵控量δx、方向舵舵控量δy和升降舵舵控量δz,所述第四公式表达式如下:
多旋翼控制量分配子单元,用于将滚动通道控制量Ux、偏航通道控制量Uy、俯仰通道控制量Uz、控制量分配系数η、副翼与旋翼滚动通道控制能力等效系数ax、方向舵与旋翼偏航通道控制能力等效系数ay、以及升降舵与旋翼俯仰通道控制能力等效系数az带入第五公式,得到旋翼设备的滚动通道控制量Tx、偏航通道控制量Ty和俯仰通道控制量Tz,所述第五公式的表达式如下:
6.根据权利要求5所述的飞行控制装置,其特征在于,当所述多旋翼设备采用四旋翼时,第一旋翼的控制量D1、第二旋翼的控制量D2、第三旋翼的控制量D3和第四旋翼的控制量D4的获取参见第六公式,所述第六公式的表达式为:
式中,T0为维持复合飞行器水平飞行的桨距或转速。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510061186.6A CN104590557B (zh) | 2015-02-05 | 2015-02-05 | 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510061186.6A CN104590557B (zh) | 2015-02-05 | 2015-02-05 | 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104590557A CN104590557A (zh) | 2015-05-06 |
CN104590557B true CN104590557B (zh) | 2016-10-26 |
Family
ID=53116703
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510061186.6A Active CN104590557B (zh) | 2015-02-05 | 2015-02-05 | 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104590557B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108639332A (zh) * | 2018-06-12 | 2018-10-12 | 中国科学院工程热物理研究所 | 复合三旋翼无人机多模态飞行控制方法 |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105652879B (zh) * | 2016-01-15 | 2018-11-02 | 中国人民解放军国防科学技术大学 | 一种无副翼无人机自主飞行控制方法 |
CN106809382B (zh) * | 2017-01-20 | 2019-01-15 | 亿航智能设备(广州)有限公司 | 一种飞行器及其控制方法 |
CN108750086B (zh) * | 2018-04-24 | 2021-04-30 | 电子科技大学 | 一种直升机电动尾桨变距变速协同控制方法及装置 |
CN108803643B (zh) * | 2018-06-19 | 2021-08-20 | 成都纵横自动化技术股份有限公司 | 飞行控制方法、装置、飞行控制器及复合翼飞行器 |
CN110271663A (zh) * | 2019-04-30 | 2019-09-24 | 重庆大学 | 两侧分离式四旋翼与飞翼布局复合型无人机及其控制方法 |
WO2020237528A1 (zh) * | 2019-05-29 | 2020-12-03 | 深圳市大疆创新科技有限公司 | 垂直起降无人机的飞行控制方法、设备及垂直起降无人机 |
CN111752291A (zh) * | 2019-06-17 | 2020-10-09 | 广州极飞科技有限公司 | 高度控制方法、装置、无人机及存储介质 |
CN110262558B (zh) * | 2019-07-18 | 2022-05-06 | 成都飞机工业(集团)有限责任公司 | 一种无人机定点着陆的控制方法 |
CN112136092A (zh) * | 2019-08-29 | 2020-12-25 | 深圳市大疆创新科技有限公司 | 一种飞行控制方法、设备及飞行器 |
CN110667832B (zh) * | 2019-10-01 | 2022-11-15 | 西安爱生技术集团公司 | 一种十六旋翼飞行器垂起俯仰姿态梯度控制方法 |
CN112947520B (zh) * | 2021-02-08 | 2023-02-28 | 北京电子工程总体研究所 | 一种低速飞行器失速下提高稳定的姿态控制方法和装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102736631A (zh) * | 2012-06-11 | 2012-10-17 | 北京航空航天大学 | 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 |
CN103043212A (zh) * | 2011-10-17 | 2013-04-17 | 田瑜 | 固定翼与电动多旋翼组成的复合飞行器 |
CN103057712A (zh) * | 2012-12-31 | 2013-04-24 | 北京航空航天大学 | 微小型飞行机器人集成飞行控制*** |
CN104044734A (zh) * | 2014-06-20 | 2014-09-17 | 中国科学院合肥物质科学研究院 | 具有可倾斜机翼和旋翼的多旋翼无人机及控制***和方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE1282555T1 (de) * | 2000-05-16 | 2003-09-18 | Bell Helicopter Textron, Inc. | Multimodales schwenkrotorgondel-steuerungssystem mit integriertem flugbereichsschutz |
US8256704B2 (en) * | 2007-08-14 | 2012-09-04 | Lapcad Engineering, Inc. | Vertical/short take-off and landing aircraft |
-
2015
- 2015-02-05 CN CN201510061186.6A patent/CN104590557B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103043212A (zh) * | 2011-10-17 | 2013-04-17 | 田瑜 | 固定翼与电动多旋翼组成的复合飞行器 |
CN102736631A (zh) * | 2012-06-11 | 2012-10-17 | 北京航空航天大学 | 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 |
CN103057712A (zh) * | 2012-12-31 | 2013-04-24 | 北京航空航天大学 | 微小型飞行机器人集成飞行控制*** |
CN104044734A (zh) * | 2014-06-20 | 2014-09-17 | 中国科学院合肥物质科学研究院 | 具有可倾斜机翼和旋翼的多旋翼无人机及控制***和方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108639332A (zh) * | 2018-06-12 | 2018-10-12 | 中国科学院工程热物理研究所 | 复合三旋翼无人机多模态飞行控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104590557A (zh) | 2015-05-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104590557B (zh) | 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置 | |
Huang et al. | Aerodynamics and control of autonomous quadrotor helicopters in aggressive maneuvering | |
CN104898429B (zh) | 一种基于自抗扰控制的三旋翼姿态控制方法 | |
CN105468009B (zh) | 应用于微小型飞行器的多动力融合飞控***以及方法 | |
CN105912015B (zh) | 一种复合翼无人机自动驾驶仪及其采用的控制方法 | |
CN104765272A (zh) | 一种基于pid神经元网络控制(pidnn)的四旋翼飞行器控制方法 | |
CN105923147B (zh) | 一种固定翼无人机降落控制方法 | |
CN104760695A (zh) | 一种利用矢量旋转法来进行四旋翼飞机控制的方法 | |
CN104210655A (zh) | 一种双旋翼无人机 | |
CN106892094A (zh) | 一种空间六自由度独立可控四旋翼无人飞行器及其控制方法 | |
US20170371352A1 (en) | Method for dynamically converting the attitude of a rotary-wing drone | |
CN100541372C (zh) | 一种无人机发动机意外停车下的自动归航控制方法 | |
CN104044734A (zh) | 具有可倾斜机翼和旋翼的多旋翼无人机及控制***和方法 | |
CN106114854A (zh) | 一种无人驾驶航空器 | |
CN206050075U (zh) | 一种油动多旋翼无人机定桨距变转速*** | |
CN105759613A (zh) | 倾转旋翼机的控制方法和控制装置 | |
CN106043695B (zh) | 一种油动多旋翼无人机定桨距变转速***及控制技术 | |
CN207374661U (zh) | 多旋翼无人机 | |
CN106114853A (zh) | 一种无人驾驶航空器 | |
CN107215454A (zh) | 一种新型复合滚转姿态控制***及方法 | |
CN109606674A (zh) | 尾坐式垂直起降无人机及其控制***与控制方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN107856850A (zh) | 多旋翼无人机及其控制方法 | |
CN108820203A (zh) | 一种倾转式垂直起降固定翼的无人机及飞行控制*** | |
CN101786505B (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 | ||
CP03 | Change of name, title or address |
Address after: 643000 No.9 Aviation Avenue, Zigong Aviation Industrial Park, Sichuan Province Patentee after: China Electric Special Aircraft Systems Engineering Co., Ltd. Address before: 618300 No. 74 Taizhong Road, Guanghan City, Deyang City, Sichuan Province Patentee before: In Dianke (Deyang Guanghan) Special Aircraft System Engineering Co. Ltd. |
|
CP03 | Change of name, title or address |