CN206470609U - 无人飞行控制系统 - Google Patents

Abstract

本实用新型提供了一种无人飞行控制系统，由旋翼飞行器（1）、电机旋翼（2）、控制决策器（4）、多个检测器、低通滤波器（9）、卡尔曼滤波器（11）以及多个AD转换接口（10）构成，其中多个检测器包括高度检测器（5）、倾角检测器（6）和陀螺检测器（7），旋翼飞行器（1）分别与高度检测器（5）、倾角检测器（6）和陀螺检测器（7）连接，旋翼飞行器（1）还与电机旋翼（2）连接，电机旋翼（2）通过PWM模块（3）与控制决策器（4）连接，高度检测器（5）与低通滤波器（9）连接，倾角检测器（6）和陀螺检测器（7）与卡尔曼滤波器（11）连接。本实用新型提供的无人飞行控制系统，系统运行良好，独立控制性能好。

Description

无人飞行控制系统

技术领域

本实用新型涉及一种无人飞行控制系统，属于无人飞行控制领域。

背景技术

微小型无人飞行控制系统是一种电动的，由无线电地面遥控飞行或/和自主控制飞行的可垂直起降（VTOL）飞行器，在构造形式上属于旋翼飞行器，在功能上属于垂直起降飞行器。它利用空气动力来克服自身重量，结构简单、控制灵活，获得了越来越多的关注。

相对固定翼无人机而言，旋翼无人飞行器发展要缓慢得多。固定翼无人机在技术上已经非常成熟，而且在过去二十多年的局部战争中展现其优越的作战性能，为美国、以色列等国军队取得战争的胜利立下了功勋[2]。然而旋翼式垂直起降飞行器与固定翼无人机相比具有更大的优点：垂直起降、空中悬停、朝任意方向飞行，起飞着陆场地小、环境适应性强、高度智能化等。在军用方面，无人直升机既能执行各种非杀伤性任务，又能执行各种软硬杀伤性任务，包括侦察、监视、目标截获、诱饵、攻击、通信中继等。民用方面，无人直升机在大气监测、交通监控、资源勘探、电力线路监测、森林防火等方面具有广泛的应用前景。

无人飞行控制系统与传统直升机相比，尾桨控制和旋翼倾斜问题可以被忽略，这是因为对角线上的两对电机的旋转方向相反，正好抵消了它们产生的扭力矩。也就是说，无人飞行控制系统无需尾桨来抵消反扭力矩以及避免复杂的旋翼倾斜控制来实现各种飞行姿态。由于其独特的对称性和多旋翼性，飞行姿态是靠调整四个旋翼转速来实现的。

从另一方面来说，无人飞行控制系统具有高度耦合的动态特性，一个旋翼速度的改变将至少影响三个自由度方向上的运动。例如，减小右面旋翼的转速，左右升力出现了不平衡，这将会导致直升机向右滚动；同时左右为一组的旋翼产生的力矩和前后为一组的旋翼产生的力矩出现了不平衡，这将会导致直升机向右偏航；此外，滚转运动将导致直升机向右平移，从而改变了前进的方向。

迄今为止，微小型无人飞行控制系统基础理论与实验研究已取得较大进展，但要真正走向成熟与实用，还需面临诸多关键技术挑战。

实用新型内容

鉴于上述现有技术的不足之处，本实用新型的目的在于提供一种无人飞行控制系统。

本实用新型的目的是为了克服传统无人飞行器的不足，提供了一种智能化轻型化的无人飞行控制系统。为了达到上述目的，本实用新型采取了以下技术方案：

本实用新型提供了一种无人飞行控制系统，由旋翼飞行器、电机旋翼、控制决策器、多个检测器、低通滤波器、卡尔曼滤波器以及多个AD转换接口构成，其中多个检测器包括高度检测器、倾角检测器和陀螺检测器，所述旋翼飞行器分别与高度检测器、倾角检测器和陀螺检测器连接，旋翼飞行器还与电机旋翼连接，所述电机旋翼通过PWM模块与控制决策器连接，所述高度检测器与低通滤波器连接，倾角检测器和陀螺检测器与卡尔曼滤波器连接。

优选的，上述无人飞行控制系统还包括飞行指令控制器，分别与控制决策器、低通滤波器以及卡尔曼滤波器连接。

优选的，上述高度检测器通过SPI接口与低通滤波器连接。

优选的，上述倾角检测器和陀螺检测器通过AD转换接口与卡尔曼滤波器连接。

优选的，上述PWM模块包括四路PWM通道，分别为通道0和1、通道2和3；利用姿态检测信息和遥控信号得出控制策略，调节四路PWM信号的占空比，从而控制四个旋翼的转速。

相比现有技术，本实用新型提供的无人飞行控制系统，针对机械震动影响和陀螺仪温度漂移引起的零漂问题，使用卡尔曼滤波对当前姿态和陀螺仪零漂进行最优估计，简化的飞行器动力学模型，系统运行良好，独立控制性能好。

附图说明

图1为本实用新型无人飞行控制系统结构示意图；

图2为本实用新型无人飞行控制系统主程序流程示意图；

图3为本实用新型无人飞行控制系统Ims中断程序流程示意图；

图4为本实用新型无人飞行控制系统PWM中断程序流程示意图。

附图标记：1-旋翼飞行器；2-电机旋翼；3-PWM模块；4-控制决策器；5-高度检测器；6-倾角检测器；7-陀螺检测器；8-SPI接口；9-低通滤波器；10-AD转换接口；11-卡尔曼滤波器；12-飞行指令控制器。

具体实施方式

本实用新型提供一种无人飞行控制系统，为使本实用新型的目的、技术方案及效果更加清楚、明确，以下参照附图并举实施例对本实用新型进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本实用新型，并不用于限定本实用新型。

如图1所示，在实施例中，本实用新型由旋翼飞行器1、电机旋翼2、控制决策器4、多个检测器、低通滤波器9、卡尔曼滤波器11以及多个AD转换接口10，其中多个检测器包括高度检测器5、倾角检测器6和陀螺检测器7构成，所述旋翼飞行器1分别与高度检测器5、倾角检测器6和陀螺检测器7连接，旋翼飞行器1还与电机旋翼2连接，所述电机旋翼2通过PWM模块3与控制决策器4连接，所述高度检测器5与低通滤波器9连接，倾角检测器6和陀螺检测器7与卡尔曼滤波器11连接。

此外，无人飞行控制系统还包括一飞行指令控制器12，分别与控制决策器4、低通滤波器9以及卡尔曼滤波器11连接。高度检测器5通过SPI接口8与低通滤波器9连接。倾角检测器6和陀螺检测器7通过AD转换接口10与卡尔曼滤波器11连接。

其中，SPI接口两路分别用于对高度信息和倾角信息的读取。PWM模块，用到其中四路PWM通道，分别为通道0和1、通道2和3。利用姿态检测信息和遥控信号得出控制策略，调节四路PWM信号的占空比，从而控制四个旋翼的转速。

本实施例中的软件程序设计主要包括三个部分，模块初始化主程序，Ims定时中断程序，PWM中断服务子程序。

如图2所示，主程序是整个程序的执行入口，程序运行后，首先要进行CPU及其基本模块的初始化，然后进行所设计飞行器控制器参数初始化并且使能各个中断，最后进入死循环，等待中断事件的产生，当中断事件产生后，立即转到中断程序执行中断事件，执行完毕后重新进入等待状态，等待下一次中断事件的产生。

如图3所示，Ims定时中断服务子程序，定时器每计满1ms则进入定时中断服务子程序，进入程序后首先读取倾角传感器和陀螺仪的AD转换结果，然后对采样值进行窗口宽度为10的滑动平均滤波；若为起始状态则进行零位校准并进行卡尔曼滤波初始参数给定，否则对倾角信息和角速度信息进行卡尔曼滤波综合得出姿态角信息及陀螺仪零漂估计信息。

如图4所示，PWM中断服务子程序，为程序的控制决策部分，中断频率为100Hz，主要是考虑到了无刷电调的响应速度。遥控和电调信号均为标准的1-2ms脉宽信号，通过读取脉宽确定实际指令大小。该部分综合飞行器的位置、姿态以及遥控信息，通过设计好的控制算法，计算得出当前电机转速及所需输出的占空比，然后将占空比重载如PWM硬件模块，控制旋翼转速，从而调节飞行器姿态。

相比现有技术，本实用新型提供的无人飞行控制系统，针对机械震动影响和陀螺仪温度漂移引起的零漂问题，使用卡尔曼滤波对当前姿态和陀螺仪零漂进行最优估计，简化的飞行器动力学模型，系统运行良好，独立控制性能好。

可以理解的是，对本领域普通技术人员来说，可以根据本实用新型的技术方案及其实用新型构思加以等同替换或改变，而所有这些改变或替换都应属于本实用新型所附的权利要求的保护范围。

Claims (4)

1.一种无人飞行控制系统，其特征在于：所述无人飞行控制系统由旋翼飞行器（1）、电机旋翼（2）、控制决策器（4）、多个检测器、低通滤波器（9）、卡尔曼滤波器（11）以及多个AD转换接口（10）构成，其中多个检测器包括高度检测器（5）、倾角检测器（6）和陀螺检测器（7），所述旋翼飞行器（1）分别与高度检测器（5）、倾角检测器（6）和陀螺检测器（7）连接，旋翼飞行器（1）还与电机旋翼（2）连接，所述电机旋翼（2）通过PWM模块（3）与控制决策器（4）连接，所述高度检测器（5）与低通滤波器（9）连接，倾角检测器（6）和陀螺检测器（7）与卡尔曼滤波器（11）连接。

2.如权利要求1所述的无人飞行控制系统，其特征在于：所述无人飞行控制系统还包括飞行指令控制器（12），分别与控制决策器（4）、低通滤波器（9）以及卡尔曼滤波器（11）连接。

3.如权利要求1所述的无人飞行控制系统，其特征在于：所述高度检测器（5）通过SPI接口（8）与低通滤波器（9）连接。

4.如权利要求1所述的无人飞行控制系统，其特征在于：所述倾角检测器（6）和陀螺检测器（7）通过AD转换接口（10）与卡尔曼滤波器（11）连接。