[发明专利]一种四旋翼飞行器控制系统及控制方法

说明书

技术领域

本发明具体涉及一种四旋翼飞行器控制系统及控制方法，属于飞行器控制技术领域。

背景技术

姿态控制是四旋翼飞行器飞行控制的基础，现行飞行器在飞行过程中它会受到各种外部环境的干扰，很难获得其准确的性能参数。利用陀螺仪或姿态检测芯片进行物体姿态检测时，会产生累计误差。

中国发明专利CN 102955477 B，公开了一种四旋翼飞行器控制系统及控制方法，虽然实现了低成本和较高精度的姿态控制，但是并没有解决累积误差的问题。

发明内容

因此，针对现有技术的上述不足，本发明目的旨在提供一种四旋翼飞行器控制系统及控制方法。以期四旋翼飞行器的平稳快速运行，远程监控及提高抗干扰能力带了技术支持。

具体的，四旋翼飞行器控制系统，包括控制器，所述四旋翼飞行器控制系统还包括飞行姿态检测器、无线通信装置、USB通讯串口、上位机，无线通信装置的一端通过USB通讯串口与上位机通讯连接，无线通信装置的另一端连接控制器，控制器还分别连接飞行姿态检测器及四旋翼飞行器电机。

进一步的，所述飞行姿态检测器包括陀螺仪、加速度计、数字罗盘。

其中，所述加速度计为MPU-6050，所述数字罗盘为HMC5883L。

进一步的，所述控制器为STM32F103C8T32位嵌入式微控制器。

进一步的，所述无线通信装置的两端均为nRF24.L0芯片。

本发明提供的基于上述四旋翼飞行器控制系统实现的四旋翼飞行器控制方法具体为：

由飞行姿态检测器检测到四旋翼飞行器的飞行姿态数据，输入控制器，由控制器利用PID控制算法以PWM方式控制四旋翼飞行器电机转动，在四旋翼飞行器飞行过程中，控制器将飞行姿态数据输送至无线通信装置，无线通信装置通过USB通讯串口与电脑的上位机进行即时通信并将上位机发出的控制信号输送至控制器。

本发明的有益效果在于：

综上所述，本发明提供的四旋翼飞行器控制系统及控制方法，以解决四旋翼飞行器在室内外环境中低速平稳飞行为目标，达到飞行稳定，具备抗扰动能力强，能够实现远程监控技术要求。在分析四旋翼飞行器工作原理的基础上，通过控制器，用飞行姿态检测器对飞行姿态和加速度进行检测，无线通信装置实现无线通信，USB串口上位机进行监控，完成四旋翼飞行器的设计。以惯性测量模块采集实时数据，采用卡尔曼滤波器进行姿态算解，运用PID算法以PWM方式驱动飞行电机。为四旋翼飞行器的平稳快速运行，远程监控及提高抗干扰能力带了技术支持，达到平稳快速运行的效果。

附图说明

图1是本发明四旋翼飞行器控制系统的结构示意图。

图2是控制器利用PID控制算法以PWM方式控制四旋翼飞行器电机的流程图。

附图标记如下：

1-控制器；2-飞行姿态检测器；3-无线通信装置；4-USB通讯串口；

5-上位机；6-四旋翼飞行器电机。

具体实施方式

下面结合附图对本发明的具体实施方式进行说明：

如图1所示，本发明的原理为，将飞行器的姿态检测信号传给单片机控制器，以惯性测量模块采集实时数据，采用卡尔曼滤波器进行姿态算解，运用PID算法以PWM方式驱动飞行电机。同时通过USB与上位机相连，由无线通信实现遥控操作，

具体的在本实施例中，四旋翼飞行器控制系统，包括控制器1、飞行姿态检测器2、无线通信装置3、USB通讯串口4、上位机5，无线通信装置3的一端通过USB通讯串口4与上位机5通讯连接，无线通信装置3的另一端连接控制器1，控制器1还分别连接飞行姿态检测器2及四旋翼飞行器电机6。

在本实施例中，飞行姿态检测器2包括陀螺仪、加速度计、数字罗盘。

具体的，加速度计为MPU-6050，数字罗盘为HMC5883L。

在本实施例中，控制器1为STM32F103C8T32位嵌入式微控制器。无线通信装置3采用两个nRF24.L0芯片，都可以接收或发送。

四旋翼飞行器控制方法为：

姿态控制先由飞行姿态检测器2检测到数据，然后输入STM32F103芯片，由芯片经过PID控制算法控制四旋翼飞行器电机6转动。无线通信则是STM32将数据传输给无线通信装置3的一个nRF24.L0芯片，再传输给另一个远程nRF24.L0芯片，通过USB通讯串口4与电脑的上位机5进行即时通信，完成远程控制。