纵列式飞行器仿地飞行控制方法、系统及电子设备与流程

摘要: 本发明涉及飞行器飞行控制,尤其涉及一种纵列式飞行器仿地飞行控制方法、系统及电子设备。背景技术:1、目前,纵列式飞行器凭借载荷能力强、纵向稳定性好的特点,在低空作...
纵列式飞行器仿地飞行控制方法、系统及电子设备与流程

本发明涉及飞行器飞行控制,尤其涉及一种纵列式飞行器仿地飞行控制方法、系统及电子设备。

背景技术:

1、目前,纵列式飞行器凭借载荷能力强、纵向稳定性好的特点,在低空作业场景中得到广泛应用。仿地飞行控制是保障飞行器低空飞行安全与作业质量的核心技术。

2、现有的纵列式飞行器仿地飞行控制方法的实现方式为基于飞行器质心位置和俯仰姿态等运动参数,结合局部地形高度,计算得到质心离地高度,再以飞行器的质心离地高度为控制对象,使质心离地高度跟踪期望离地高度,通过高度闭环控制生成总推力控制量,通过姿态闭环控制生成俯仰力矩控制量,并将总推力控制量和俯仰力矩控制量分配至前后旋翼,得到前后旋翼指令推力,以此驱动纵列式飞行器维持期望离地高度,实现地形跟随飞行。

3、然而现有技术未充分考虑纵列式飞行器前后旋翼沿机体纵向分布的构型特点,近地效应作用的估计精度较低,飞行稳定性较差。同时,现有技术的推力分配未考虑非对称近地效应,易出现扰动补偿过程中推力分配与飞行器构型特性不匹配的问题,降低了纵列式飞行器仿地飞行控制的可实现性。

技术实现思路

1、本发明提供了一种纵列式飞行器仿地飞行控制方法、系统及电子设备,考虑了纵列式飞行器的前后旋翼沿机体纵向分布的构型特点,提高了近地效应作用的估计精度和飞行稳定性,同时还考虑了非对称近地效应,提高了扰动补偿过程中推力分配与飞行器构型特性之间的匹配性,提高了纵列式飞行器仿地飞行控制的可实现性。

2、根据本发明的一方面,提供了一种纵列式飞行器仿地飞行控制方法,所述方法包括:

3、获取纵列式飞行器的质心水平位置、质心高度、垂向速度、俯仰角、俯仰角速度以及对应水平位置处的局部地形高度;其中,所述对应水平位置至少包括质心水平位置;

4、根据所述质心高度、质心局部地形高度和期望离地高度,计算仿地高度误差;

5、分别获取前旋翼地效增益、后旋翼地效增益、当前前旋翼指令推力以及当前后旋翼指令推力;

6、根据所述前旋翼地效增益、所述后旋翼地效增益、所述当前前旋翼指令推力和所述当前后旋翼指令推力,计算非对称近地效应引起的总升力扰动和俯仰力矩扰动;

7、基于所述垂向速度、所述仿地高度误差和所述总升力扰动,生成总推力控制量,以及根据所述俯仰角、所述俯仰角速度和所述俯仰力矩扰动,生成俯仰力矩控制量;

8、基于所述总推力控制量和所述俯仰力矩控制量进行推力分配,生成目标前旋翼指令推力和目标后旋翼指令推力,以采用所述目标前旋翼指令推力和所述目标后旋翼指令推力控制所述纵列式飞行器进行低空仿地飞行。

9、根据本发明的另一方面,提供了一种纵列式飞行器仿地飞行控制系统,所述系统包括:

10、第一数据获取模块,用于获取纵列式飞行器的质心水平位置、质心高度、垂向速度、俯仰角、俯仰角速度以及对应水平位置处的局部地形高度;其中,所述对应水平位置至少包括质心水平位置;

11、仿地高度误差计算模块,用于根据所述质心高度、质心局部地形高度和期望离地高度,计算仿地高度误差;

12、地效增益获取模块,用于分别获取前旋翼地效增益、后旋翼地效增益、当前前旋翼指令推力以及当前后旋翼指令推力;

13、非对称地效扰动计算模块,用于根据所述前旋翼地效增益、所述后旋翼地效增益、所述当前前旋翼指令推力和所述当前后旋翼指令推力,计算非对称近地效应引起的总升力扰动和俯仰力矩扰动;

14、抗扰控制模块,用于基于所述垂向速度、所述仿地高度误差和所述总升力扰动,生成总推力控制量,以及根据所述俯仰角、所述俯仰角速度和所述俯仰力矩扰动,生成俯仰力矩控制量;

15、推力分配模块,用于基于所述总推力控制量和所述俯仰力矩控制量进行推力分配,生成目标前旋翼指令推力和目标后旋翼指令推力,以采用所述目标前旋翼指令推力和所述目标后旋翼指令推力控制所述纵列式飞行器进行低空仿地飞行。

16、根据本发明的另一方面,提供了一种电子设备,所述电子设备包括:

17、至少一个处理器;以及

18、与所述至少一个处理器通信连接的存储器;其中,

19、所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行本发明任一实施例所述的纵列式飞行器仿地飞行控制方法。

20、根据本发明的另一方面,提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现本发明任一实施例所述的纵列式飞行器仿地飞行控制方法。

21、根据本发明的另一方面,提供了一种计算机程序产品,所述计算机程序产品包括计算机程序,所述计算机程序在被处理器执行时实现本发明任一实施例所述的纵列式飞行器仿地飞行控制方法。

22、本发明实施例的技术方案,通过获取质心位置处的局部地形高度并计算仿地高度误差,使飞行器能够感知地形起伏并据此调整飞行高度,奠定了仿地飞行的感知基础;在此基础上,通过分别获取前旋翼地效增益与后旋翼地效增益,量化区分了前、后旋翼因各自局部离地高度不同而产生的差异化的近地效应,突破了现有技术仅以质心离地高度表征整机地效状态的局限性,准确反映了纵列式飞行器在起伏地形中前后旋翼近地环境的不对称性;进而通过差异化的前后旋翼地效增益与当前前后旋翼指令推力,计算非对称近地效应引起的总升力扰动和俯仰力矩扰动,由此将非对称地效的影响从整体升力变化中解耦,明确了总升力扰动对高度通道的作用以及俯仰力矩扰动对俯仰通道的作用,为分通道扰动补偿提供了精确的前馈信息;继而基于垂向速度、仿地高度误差和总升力扰动生成总推力控制量,以及基于俯仰角、俯仰角速度和俯仰力矩扰动生成俯仰力矩控制量,实现了高度通道与俯仰通道的独立扰动补偿,使得总升力扰动仅进入高度控制回路、俯仰力矩扰动仅进入姿态控制回路,避免了扰动信号在通道间的串扰,提升了扰动抑制的针对性和有效性;最后,基于总推力控制量和俯仰力矩控制量进行推力分配,生成目标前后旋翼指令推力,将分通道补偿后的虚拟控制量映射为物理可执行的前后旋翼指令,完整贯通了从地形感知、地效差异计算、非对称扰动建模、分通道补偿到推力分配的数据链条,使得纵列式飞行器在坡地和沟壑等复杂起伏地形中执行低空仿地飞行任务时,能够有效抑制由非对称近地效应引起的姿态扰动和高度跟踪误差,提升了仿地飞行控制的精度和飞行安全裕度。综上所述,本发明实施例的技术方案充分考虑了纵列式飞行器前后旋翼沿机体纵向分布的构型特点,提高了近地效应作用的估计精度和飞行稳定性,同时将非对称近地效应纳入扰动补偿和推理分配中,增强了扰动补偿过程中推力分配与飞行器构型特性之间的匹配性,提高了纵列式飞行器仿地飞行控制的工程可实现性。

23、应当理解,本部分所描述的内容并非旨在标识本发明的实施例的关键或重要特征,也不用于限制本发明的范围。本发明的其它特征将通过以下的说明书而变得容易理解。

1.一种纵列式飞行器仿地飞行控制方法,其特征在于,所述方法包括:

2.根据权利要求1所述的方法,其特征在于,在所述获取纵列式飞行器的质心水平位置、质心高度、垂向速度、俯仰角、俯仰角速度以及对应水平位置处的局部地形高度的同时,还包括:

3.根据权利要求2所述的方法,其特征在于,在所述获取纵列式飞行器的水平速度和所述质心水平位置处的质心局部地形坡度的同时,还包括:

4.根据权利要求1所述的方法,其特征在于,所述根据所述俯仰角、所述俯仰角速度和所述俯仰力矩扰动,生成俯仰力矩控制量,包括:

5.根据权利要求4所述的方法,其特征在于,在所述计算所述俯仰角和期望俯仰角之间的差值,得到俯仰角误差之前,还包括:

6.根据权利要求4所述的方法,其特征在于,所述基于所述俯仰角误差、所述俯仰角速度误差、所述俯仰力矩扰动以及所述期望俯仰角速度,生成俯仰力矩控制量,包括:

7.根据权利要求1所述的方法,其特征在于,获取前旋翼地效增益和后旋翼地效增益,包括:

8.根据权利要求1所述的方法,其特征在于,在所述基于所述总推力控制量和所述俯仰力矩控制量,生成目标前旋翼指令推力和目标后旋翼指令推力之后,还包括:

9.一种纵列式飞行器仿地飞行控制系统,其特征在于,所述系统包括:

10.一种电子设备,其特征在于,所述电子设备包括: