CN106325289A - 基于瑞萨r5f100lea主控的四旋翼飞行控制器及其控制方法 - Google Patents
基于瑞萨r5f100lea主控的四旋翼飞行控制器及其控制方法 Download PDFInfo
- Publication number
- CN106325289A CN106325289A CN201610852098.2A CN201610852098A CN106325289A CN 106325289 A CN106325289 A CN 106325289A CN 201610852098 A CN201610852098 A CN 201610852098A CN 106325289 A CN106325289 A CN 106325289A
- Authority
- CN
- China
- Prior art keywords
- control
- data
- processing unit
- data processing
- r5f100lea
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000012545 processing Methods 0.000 claims abstract description 48
- 230000008569 process Effects 0.000 claims abstract description 11
- 230000001133 acceleration Effects 0.000 claims abstract description 10
- 238000001914 filtration Methods 0.000 claims abstract description 7
- 230000009187 flying Effects 0.000 claims description 28
- 238000013500 data storage Methods 0.000 claims description 12
- 238000004891 communication Methods 0.000 claims description 9
- 101150093547 AUX1 gene Proteins 0.000 claims description 4
- 101100125299 Agrobacterium rhizogenes aux2 gene Proteins 0.000 claims description 4
- 241001269238 Data Species 0.000 claims description 4
- 101100367246 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) SWA2 gene Proteins 0.000 claims description 4
- 238000005096 rolling process Methods 0.000 claims description 4
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 abstract description 5
- 238000011161 development Methods 0.000 abstract description 2
- 230000000694 effects Effects 0.000 abstract description 2
- 238000012913 prioritisation Methods 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000002604 ultrasonography Methods 0.000 description 3
- 230000005611 electricity Effects 0.000 description 2
- 230000035945 sensitivity Effects 0.000 description 2
- 230000000087 stabilizing effect Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004806 packaging method and process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于瑞萨R5F100LEA主控的四旋翼飞行控制器及其控制方法,控制器包含数据处理单元和姿态控制单元。工作时,数据处理单元接收并处理电子罗盘、六轴姿态传感器、气压计、GPS单元接口、遥控器接收机、超声波测距模块的数据,并对其进行卡尔曼滤波,然后将解算出的四旋翼姿态、高度、位置、速度、加速度、角速度以及遥控器控制指令后通过串口传给姿态控制单元,姿态控制单元利用接收到的数据信息控制四旋翼飞行器的姿态和高度。本发明成本低、性能可靠、控制效果好,对于飞控***的后续开发具有很好的实用价值。
Description
技术领域
本发明涉及定位导航与控制技术领域,尤其涉及一种应用于四旋翼飞行器的飞行控制器模块,具体来说是一种基于瑞萨R5F100LEA主控的四旋翼飞行控制器及其控制方法。
背景技术
四旋翼飞行器是一种结构简单、易于操控、可垂直起降、悬停状态稳定的无人飞行器,通过调节四个电机转速来改变旋翼转速,实现升力的变化,从而控制飞行器的姿态和位置。四旋翼飞行器有极高的可控性、机动性和稳定性,并且具有低噪声、无污染、携带方便、安全危害性小等特点,非常适合于执行中短距离的飞行任务。在军事和民用领域四旋翼飞行器均具有广阔的应用前景,如侦察监视、通信中继、搜索救援、目标跟踪、电力检修、航拍成像等。
随着无人机的智能化程度越来越高,遥控飞行器的飞控主控制器所要处理的数据也越来越多,一方面,增加了飞控主控制器的计算量,从而使其处理其他信息的资源变得越来越少;另一方面,降低了无人机的智能化程度。
发明内容
本发明所要解决的技术问题是针对背景技术中所涉及到的缺陷,提供一种基于瑞萨R5F100LEA主控的四旋翼飞行控制器及其控制方法,通过单独的数据处理单元将传感器信息处理后传给姿态控制单元,减轻飞控主控制器的计算量,增加飞控***的可靠性。
本发明为解决上述技术问题采用以下技术方案:
基于瑞萨R5F100LEA主控的四旋翼飞行控制器,包括数据处理单元、姿态控制单元、电子罗盘、六轴姿态传感器、气压计、GPS单元接口、超声波测距模块接口、遥控器接收机接口、GPS接收模块、遥控器接收机、超声波测距模块、数据输出接口、飞控状态指示灯、独立按键、数据存储器、无线通信模块接口、电机控制信号接口、无线通信模块和电机控制模块;
所述数据处理单元分别和电子罗盘、六轴姿态传感器、气压计、数据输出接口连接;所述GPS接收模块通过GPS接收模块接口与数据处理单元连接;所述超声波测距模块通过超声波测距模块接口与数据处理单元连接;所述遥控器接收机通过遥控器接收机接口与数据处理单元连接;
所述姿态控制单元分别与数据存储器、飞控状态指示灯、独立按键连接;所述无线通信模块通过无线通信模块接口与姿态控制单元连接;所述电机控制模块通过电机控制信号接口与控制单元连接;
所述数据处理单元通过UART串口与所述姿态控制单元连接;
所述GPS接收模块用于接收GPS卫星数据,并将接收到的数据传递给所述数据处理单元;
所述超声波测距模块用于以超声波测距的方式测量四旋翼飞行器距离地面的高度;
所述数据输出接口用于将数据处理单元处理后的数据对外输出;
所述飞控状态指示灯用于显示四旋翼飞行器的飞行模式,所述飞行模式包括手动模式、定高模式、定点模式、自主飞行模式;
所述独立按键用于在四旋翼飞行器起飞之前设置飞行模式;
所述数据存储器用于存储姿态控制单元需要用到的PID控制参数;
所述姿态控制单元的芯片型号为R5F100LEA。
作为基于瑞萨R5F100LEA主控的四旋翼飞行控制器进一步的优化方案,所述电子罗盘、六轴姿态传感器、气压计分别通过IIC总线与数据处理单元连接,所述数据存储器通过IIC总线与姿态控制单元连接。
作为基于瑞萨R5F100LEA主控的四旋翼飞行控制器进一步的优化方案,所述数据处理单元的芯片型号为STM32F103C8T6。
作为基于瑞萨R5F100LEA主控的四旋翼飞行控制器进一步的优化方案,所述电子罗盘的芯片型号为HMC5883L。
作为基于瑞萨R5F100LEA主控的四旋翼飞行控制器进一步的优化方案,所述六轴姿态传感器的芯片型号为MPU6050。
作为基于瑞萨R5F100LEA主控的四旋翼飞行控制器进一步的优化方案,所述气压计的芯片型号为BMP180。
作为基于瑞萨R5F100LEA主控的四旋翼飞行控制器进一步的优化方案,所述数据存储器的芯片型号为AT24C08。
作为基于瑞萨R5F100LEA主控的四旋翼飞行控制器进一步的优化方案,所述数据输出接口的串口波特率值为115200。
本发明还公开了一种该基于瑞萨R5F100LEA主控的四旋翼飞行控制器的控制方法,包含以下步骤:
步骤1),数据处理单元通过IIC总线读取电子罗盘、六轴姿态传感器和气压计的感应数据,对其进行卡尔曼滤波处理得到三轴磁强度值、三轴加速度值、三轴角速度值和气压高度,然后利用得到三轴磁强度值、三轴加速度值、三轴角速度值通过四元数法解算出四旋翼飞行器的三轴姿态角;
步骤2),数据处理单元读取GPS接收模块的感应数据,对其进行卡尔曼滤波处理,然后解算出四旋翼飞行器的GPS信息,所述GPS信息包含四旋翼飞行器是否被定位、定位卫星的数量、经度、纬度、GPS高度、GPS速度和速度朝向;
步骤3),数据处理单元读取遥控器接收机的信号和超声波测距模块的感应型号,解算出四旋翼飞行器的6通道遥控数据和超声高度,所述6通道遥控数据包含油门指令THR、偏航指令YAW、滚转指令ROL、俯仰指令PIT、辅助指令AUX1和辅助指令AUX2,所述超声高度为超声波测距模块以超声波测距的方式测量四旋翼飞行器距离地面的高度;
步骤4),数据处理单元通过UART串口输出处理过的传感器数据,所述处理过的传感器数据包含以下数据:三轴磁强度值、三轴加速度值、三轴角速度值、三轴姿态角、气压高度、GPS信息、6通道遥控数据和超声高度;
步骤5),数据处理单元通过UART串口将处理过的传感器数据传输给姿态控制单元,姿态控制单元利用上述传感器信息通过PID控制方法控制四旋翼飞行器的姿态和位置。
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
1、将传感器信号处理与姿态控制分别放在两个不同的单元中进行,减轻飞控***主控制器的工作负担,提高了飞控***的运算速度;
2、可利用的高度信息包括超声波高度、气压高度和GPS高度,当飞行器处于不同高度时,采用上述不同高度传感器的融合信息有利于提高飞行器的飞行品质;
3、设置了数据输出接口,使得该控制器既可以用作四旋翼飞行控制器,又可以用作航姿传感器模块为其他应用***提供必要的传感器信息;
4、采用R5F100LEA作为飞控***的主控芯片,省去大量底层驱动程序的编写工作,减小飞控软件开发难度。
附图说明
图1是本发明的硬件结构框图;
图2是本发明中数据处理单元的电气连接示意图;
图3是本发明中姿态控制单元的电气连接示意图。
具体实施方式
下面结合附图对本发明的技术方案做进一步的详细说明:
如图1、图2和图3所示,本发明公开了一种基于瑞萨R5F100LEA主控的四旋翼飞行控制器,包括数据处理单元、姿态控制单元、电子罗盘、六轴姿态传感器、气压计、GPS单元接口、超声波测距模块接口、遥控器接收机接口、GPS接收模块、遥控器接收机、超声波测距模块、数据输出接口、飞控状态指示灯、独立按键、数据存储器、无线通信模块接口、电机控制信号接口、无线通信模块和电机控制模块;
所述数据处理单元分别和电子罗盘、六轴姿态传感器、气压计、数据输出接口连接;所述GPS接收模块通过GPS接收模块接口与数据处理单元连接;所述超声波测距模块通过超声波测距模块接口与数据处理单元连接;所述遥控器接收机通过遥控器接收机接口与数据处理单元连接;
所述姿态控制单元分别与数据存储器、飞控状态指示灯、独立按键连接;所述无线通信模块通过无线通信模块接口与姿态控制单元连接;所述电机控制模块通过电机控制信号接口与控制单元连接;
所述数据处理单元通过UART串口与所述姿态控制单元连接;
所述GPS接收模块用于接收GPS卫星数据,并将接收到的数据传递给所述数据处理单元;
所述超声波测距模块用于以超声波测距的方式测量四旋翼飞行器距离地面的高度;
所述数据输出接口用于将数据处理单元处理后的数据对外输出;
所述飞控状态指示灯用于显示四旋翼飞行器的飞行模式,所述飞行模式包括手动模式、定高模式、定点模式、自主飞行模式;
所述独立按键用于在四旋翼飞行器起飞之前设置飞行模式;
所述数据存储器用于存储姿态控制单元需要用到的PID控制参数;
所述姿态控制单元的芯片型号为R5F100LEA。
数据处理单元:该飞行控制器采用STM32F103C8T6芯片作为数据处理单元,STM32F103C8T6是由STMicroelectronics公司生产的32位Cortex-M3内核处理器,共有48引脚,最高工作频率为72MHz。该芯片拥有36路数字输入/输出接口、4个16位定时器、3个UART通信接口,封装方式为LQFP48。对于本发明所述的航姿传感器模块,STM32F103C8T6具有足够的资源和性能。
姿态控制单元:选用瑞萨科技公司生产的R5F100LEA作为姿态控制单元。该芯片共有64个引脚,Flash存储器大小为64Kb,具有8个IIC控制器、8个SPI控制器、4个UART通信接口。该芯片配合瑞萨科技公司开发的CubeSuite程序编译及烧录软件使用起来非常方便,可以免去大量的底层驱动程序的编写。
电子罗盘:选用美国Honeywell公司生产的HMC5883L电子罗盘,其是一种表面贴装的高集成模块,并带有数字接口的弱磁传感器芯片,应用于低成本罗盘和磁场检测领域。能使罗盘精度控制在1°到2°的12位模数转换器,带有16个引脚,接口为简易的IIC系列总线,尺寸为3.0×3.0×0.9mm。具有在轴向高灵敏度和线性高精度的特点,是灵敏度最高和可靠性最好的传感器。
六轴姿态传感器:选用美国Invensense公司生产的MPU-6050六轴姿态传感器,其整合了3轴陀螺仪、3轴加速器,为全球首例整合性6轴运动处理组件。MPU-6050以数字输出6轴或9轴的旋转矩阵、四元数、欧拉角格式的融合演算数据。相较于多组件方案,MPU-6050免除了组合陀螺仪与加速器时之轴间差的问题,减少了大量的包装空间,具有低功耗、低成本、高性能的特点。角速度的感测范围为±250º、±500º、±1000º与±2000º/sec(dsp),可准确追踪快速与慢速动作;同时可编程的加速计的感测范围为±2g、±4g、±8g与±16g。传感器的测量数据最终可通过最高400kHz的IIC总线输出。
数字气压计:采用德国博世公司生产的BMP180芯片,BMP180是一款低成本、高精度、小体积、超低能耗的气压传感器。可测量的高度范围为海拔-500m~9000m,高线性模式下测量精度为0.25m。尺寸为3.6mm×3.8×0.93mm,电源电压为1.8V~3.6V,含有温度输出。可通过IIC总线直接与数据处理单元相连来输出数据。
超声波测距模块接口:可以兼容低成本的超声波测距模块,比如深圳市捷深科技有限公司生产的型号为HC-SR04的超声波单元。该种类型的超声波单元可提供2cm-400cm非接触式测距功能,测距精度为3mm。该模块通过IO口Trig触发测距,同时Echo引脚变为高电平,收到回波信号后Echo引脚变为低电平,Echo引脚持续的时间即超声波从发射到返回所用的时间,距离=(高电平时间*声速)/2。
GPS接收模块接口:可兼容UBLOXGPS模块,通过数据处理单元STM32F103C8T6的UART串口与GPS接收模块相连,串口波特率9600。
遥控器接收机接口:该接收机接口可以兼容Futaba、天地飞等航模遥控器接收机,通过数据处理单元STM32F103C8T6的定时器捕获功能来读取遥控器接收机输出PWM波的高电平长度,单位为us。该模块最多可读取6通道的遥控器数据。
数据输出接口:该接口通过串口输出传感器数据,串口波特率为115200。并且数据格式兼容匿名提供的开源飞控上位机v4.06版,在上位机上可以显示该模块输出的所有数据。
数据存储器:采用ATMEL公司生产的AT24C08芯片。该芯片具有8个引脚、8KB的存储空间,可通过IIC总线进行读写存储器中的数据。该芯片具有很好的稳定性,支持读写次数一百万次,数据保存时长100年。另外,该芯片操作方便、成本低。
本发明的工作方法如下:
(1)数据处理单元STM32F103C8T6通过IIC总线读取电子罗盘、六轴姿态传感器和气压计的传感器数据,对其进行卡尔曼滤波处理得到三轴磁强度值、三轴加速度值、三轴角速度值和气压高度,然后利用得到三轴磁强度值、三轴加速度值、三轴角速度值通过四元数法解算出四旋翼飞行器的三轴姿态角;
(2)数据处理单元STM32F103C8T6通过UART串口读取GPS接收模块的感应数据(串口波特率9600),然后解算出四旋翼飞行器的GPS信息,所述GPS信息包含四旋翼飞行器是否被定位、定位卫星的数量、经度、纬度、GPS高度、GPS速度和速度朝向;
(3)数据处理单元STM32F103C8T6通过TIMER管脚读取遥控器接收机通道信号输出管脚和超声波测距模块回波状态Echo管脚的高电平长度,解算出四旋翼飞行器的6通道遥控数据和超声高度,所述6通道遥控数据包含油门指令THR、偏航指令YAW、滚转指令ROL、俯仰指令PIT、辅助指令AUX1和辅助指令AUX2,所述超声高度为超声波测距模块以超声波测距的方式测量四旋翼飞行器距离地面的高度;
(4)数据处理单元STM32F103C8T6通过UART串口输出处理过的各传感器数据(串口波特率默认值为115200),输出的数据包括:三轴姿态角(俯仰角PIT、滚转角ROL、航向角YAW),三轴加速度值(ACC-X、ACC-Y、ACC-Z),三轴角速度值(GYR-X、GYR-Y、GYR-Z),三轴磁强度值(MAG-X、MAG-XY、MAG-Z),气压高度、超声高度、GPS信息(精度、纬度、定位状态、卫星数量、GPS高度、GPS速度、速度朝向),6通道遥控数据(油门指令THR、偏航指令YAW、滚转指令ROL、俯仰指令PIT、辅助指令AUX1、辅助指令AUX2)。
(5)数据处理单元STM32F103C8T6通过UART串口输出处理过的各传感器数据(串口波特率默认值为115200)传输给姿态控制单元R5F100LEA,姿态控制单元利用上述传感器信息通过PID控制方法控制四旋翼飞行器的姿态和位置。
外部5V直流电源通过电源接口给整个飞行控制器供电,经稳压芯片AMS1117-3.3转换为3.3V给STM32F103C8T6、R5F100LEA、AT24C08、LED灯及含有3.3V电源的接口供电,3.3V电源再经过MIC3219-3.3BM5芯片稳压和滤波处理给传感器芯片HMC5883L、MPU6050、BMP180供电,同时还可以通过遥控器接收机接口、超声波测距模块接口、GPS单元接口中的5V引脚分别给遥控器接收机、超声波测距模块、GPS单元供电。
该飞行控制器还包括飞控状态指示灯D2-D5和独立按键K1、K2,飞控状态指示灯可以实时显示四旋翼飞行器的状态,独立按键可以用来设置四旋翼飞行器的飞行模式,可以设置为一键起飞模式。
本技术领域技术人员可以理解的是,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.基于瑞萨R5F100LEA主控的四旋翼飞行控制器,其特征在于,包括数据处理单元、姿态控制单元、电子罗盘、六轴姿态传感器、气压计、GPS单元接口、超声波测距模块接口、遥控器接收机接口、GPS接收模块、遥控器接收机、超声波测距模块、数据输出接口、飞控状态指示灯、独立按键、数据存储器、无线通信模块接口、电机控制信号接口、无线通信模块和电机控制模块;
所述数据处理单元分别和电子罗盘、六轴姿态传感器、气压计、数据输出接口连接;所述GPS接收模块通过GPS接收模块接口与数据处理单元连接;所述超声波测距模块通过超声波测距模块接口与数据处理单元连接;所述遥控器接收机通过遥控器接收机接口与数据处理单元连接;
所述姿态控制单元分别与数据存储器、飞控状态指示灯、独立按键连接;所述无线通信模块通过无线通信模块接口与姿态控制单元连接;所述电机控制模块通过电机控制信号接口与控制单元连接;
所述数据处理单元通过UART串口与所述姿态控制单元连接;
所述GPS接收模块用于接收GPS卫星数据,并将接收到的数据传递给所述数据处理单元;
所述超声波测距模块用于以超声波测距的方式测量四旋翼飞行器距离地面的高度;
所述数据输出接口用于将数据处理单元处理后的数据对外输出;
所述飞控状态指示灯用于显示四旋翼飞行器的飞行模式,所述飞行模式包括手动模式、定高模式、定点模式、自主飞行模式;
所述独立按键用于在四旋翼飞行器起飞之前设置飞行模式;
所述数据存储器用于存储姿态控制单元需要用到的PID控制参数;
所述姿态控制单元的芯片型号为R5F100LEA。
2.根据权利要求1所述的基于瑞萨R5F100LEA主控的四旋翼飞行控制器,其特征在于,所述电子罗盘、六轴姿态传感器、气压计分别通过IIC总线与数据处理单元连接,所述数据存储器通过IIC总线与姿态控制单元连接。
3.根据权利要求1所述的基于瑞萨R5F100LEA主控的四旋翼飞行控制器,其特征在于,所述数据处理单元的芯片型号为STM32F103C8T6。
4.根据权利要求1所述的基于瑞萨R5F100LEA主控的四旋翼飞行控制器,其特征在于,所述电子罗盘的芯片型号为HMC5883L。
5.根据权利要求1所述的基于瑞萨R5F100LEA主控的四旋翼飞行控制器,其特征在于,所述六轴姿态传感器的芯片型号为MPU6050。
6.根据权利要求1所述的基于瑞萨R5F100LEA主控的四旋翼飞行控制器,其特征在于,所述气压计的芯片型号为BMP180。
7.根据权利要求1所述的基于瑞萨R5F100LEA主控的四旋翼飞行控制器,其特征在于,所述数据存储器的芯片型号为AT24C08。
8.根据权利要求1所述的基于瑞萨R5F100LEA主控的四旋翼飞行控制器,其特征在于,所述数据输出接口的串口波特率值为115200。
9.基于权利要求2所述的基于瑞萨R5F100LEA主控的四旋翼飞行控制器的控制方法,其特征在于,包含以下步骤:
步骤1),数据处理单元通过IIC总线读取电子罗盘、六轴姿态传感器和气压计的感应数据,对其进行卡尔曼滤波处理得到三轴磁强度值、三轴加速度值、三轴角速度值和气压高度,然后利用得到三轴磁强度值、三轴加速度值、三轴角速度值通过四元数法解算出四旋翼飞行器的三轴姿态角;
步骤2),数据处理单元读取GPS接收模块的感应数据,对其进行卡尔曼滤波处理,然后解算出四旋翼飞行器的GPS信息,所述GPS信息包含四旋翼飞行器是否被定位、定位卫星的数量、经度、纬度、GPS高度、GPS速度和速度朝向;
步骤3),数据处理单元读取遥控器接收机的信号和超声波测距模块的感应信号,解算出四旋翼飞行器的6通道遥控数据和超声高度,所述6通道遥控数据包含油门指令THR、偏航指令YAW、滚转指令ROL、俯仰指令PIT、辅助指令AUX1和辅助指令AUX2,所述超声高度为超声波测距模块以超声波测距的方式测量四旋翼飞行器距离地面的高度;
步骤4),数据处理单元通过UART串口输出处理过的传感器数据,所述处理过的传感器数据包含以下数据:三轴磁强度值、三轴加速度值、三轴角速度值、三轴姿态角、气压高度、GPS信息、6通道遥控数据和超声高度;
步骤5),数据处理单元通过UART串口将处理过的传感器数据传输给姿态控制单元,姿态控制单元利用上述传感器信息通过PID控制方法控制四旋翼飞行器的姿态和位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610852098.2A CN106325289A (zh) | 2016-09-26 | 2016-09-26 | 基于瑞萨r5f100lea主控的四旋翼飞行控制器及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610852098.2A CN106325289A (zh) | 2016-09-26 | 2016-09-26 | 基于瑞萨r5f100lea主控的四旋翼飞行控制器及其控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106325289A true CN106325289A (zh) | 2017-01-11 |
Family
ID=57820579
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610852098.2A Pending CN106325289A (zh) | 2016-09-26 | 2016-09-26 | 基于瑞萨r5f100lea主控的四旋翼飞行控制器及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106325289A (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106598059A (zh) * | 2017-01-25 | 2017-04-26 | 桂林航天工业学院 | 基于fpga的多旋翼无人机*** |
CN107065927A (zh) * | 2017-04-20 | 2017-08-18 | 杭州电子科技大学 | 一种太阳能续航的四旋翼飞行器及控制方法 |
CN107054675A (zh) * | 2017-03-15 | 2017-08-18 | 上海交通大学 | 一种微型叠层式四旋翼飞行控制器 |
CN107272740A (zh) * | 2017-07-28 | 2017-10-20 | 北京航天光华电子技术有限公司 | 一种新型四旋翼无人机控制*** |
CN108803664A (zh) * | 2018-08-01 | 2018-11-13 | 辽宁壮龙无人机科技有限公司 | 一种自主飞行投物无人机及控制方法 |
CN108845587A (zh) * | 2018-06-08 | 2018-11-20 | 赫星科技有限公司 | 无人机实时操控***及无人机 |
CN109606041A (zh) * | 2019-01-03 | 2019-04-12 | 张夯 | 一种陆空飞行器 |
CN110162072A (zh) * | 2019-05-28 | 2019-08-23 | 哈尔滨工业大学 | 四旋翼飞行器三自由度姿态控制实验装置 |
CN112173093A (zh) * | 2020-09-09 | 2021-01-05 | 昆明理工大学 | 一种快速通信的四旋翼无人机*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102424112A (zh) * | 2011-11-30 | 2012-04-25 | 东北大学 | 微小型四旋翼飞行器的三层机载飞控装置 |
CN102945048A (zh) * | 2012-11-20 | 2013-02-27 | 南京理工大学 | 多螺旋桨飞行器控制装置 |
CN105259917A (zh) * | 2015-11-08 | 2016-01-20 | 杨珊珊 | 一种无人飞行器安全快速降落装置及方法 |
CN105700553A (zh) * | 2016-01-28 | 2016-06-22 | 中国科学院自动化研究所 | 多无人机自主协同决策快速集成*** |
CN105955286A (zh) * | 2016-06-08 | 2016-09-21 | 深圳蚁石科技有限公司 | 一种双核多旋翼飞行控制器 |
CN206133313U (zh) * | 2016-09-26 | 2017-04-26 | 南京航空航天大学 | 基于瑞萨r5f100lea主控的四旋翼飞行控制器 |
-
2016
- 2016-09-26 CN CN201610852098.2A patent/CN106325289A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102424112A (zh) * | 2011-11-30 | 2012-04-25 | 东北大学 | 微小型四旋翼飞行器的三层机载飞控装置 |
CN102945048A (zh) * | 2012-11-20 | 2013-02-27 | 南京理工大学 | 多螺旋桨飞行器控制装置 |
CN105259917A (zh) * | 2015-11-08 | 2016-01-20 | 杨珊珊 | 一种无人飞行器安全快速降落装置及方法 |
CN105700553A (zh) * | 2016-01-28 | 2016-06-22 | 中国科学院自动化研究所 | 多无人机自主协同决策快速集成*** |
CN105955286A (zh) * | 2016-06-08 | 2016-09-21 | 深圳蚁石科技有限公司 | 一种双核多旋翼飞行控制器 |
CN206133313U (zh) * | 2016-09-26 | 2017-04-26 | 南京航空航天大学 | 基于瑞萨r5f100lea主控的四旋翼飞行控制器 |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106598059A (zh) * | 2017-01-25 | 2017-04-26 | 桂林航天工业学院 | 基于fpga的多旋翼无人机*** |
CN107054675A (zh) * | 2017-03-15 | 2017-08-18 | 上海交通大学 | 一种微型叠层式四旋翼飞行控制器 |
CN107054675B (zh) * | 2017-03-15 | 2019-07-05 | 上海交通大学 | 一种微型叠层式四旋翼飞行控制器 |
CN107065927A (zh) * | 2017-04-20 | 2017-08-18 | 杭州电子科技大学 | 一种太阳能续航的四旋翼飞行器及控制方法 |
CN107065927B (zh) * | 2017-04-20 | 2020-10-09 | 杭州电子科技大学 | 一种太阳能续航的四旋翼飞行器及控制方法 |
CN107272740A (zh) * | 2017-07-28 | 2017-10-20 | 北京航天光华电子技术有限公司 | 一种新型四旋翼无人机控制*** |
CN108845587A (zh) * | 2018-06-08 | 2018-11-20 | 赫星科技有限公司 | 无人机实时操控***及无人机 |
CN108803664A (zh) * | 2018-08-01 | 2018-11-13 | 辽宁壮龙无人机科技有限公司 | 一种自主飞行投物无人机及控制方法 |
CN109606041A (zh) * | 2019-01-03 | 2019-04-12 | 张夯 | 一种陆空飞行器 |
CN110162072A (zh) * | 2019-05-28 | 2019-08-23 | 哈尔滨工业大学 | 四旋翼飞行器三自由度姿态控制实验装置 |
CN112173093A (zh) * | 2020-09-09 | 2021-01-05 | 昆明理工大学 | 一种快速通信的四旋翼无人机*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106325289A (zh) | 基于瑞萨r5f100lea主控的四旋翼飞行控制器及其控制方法 | |
CN104615142B (zh) | 基于民用小型无人机的飞行控制器 | |
CN107132851B (zh) | 一种无人机飞行导航控制*** | |
CN105353762B (zh) | 基于双余度姿态传感器的六旋翼无人机的控制方法 | |
CN104656664B (zh) | 车载多旋翼无人直升机着陆导引控制***及导引控制方法 | |
CN105589467A (zh) | 一种低成本扩展航姿传感器模块 | |
CN204440169U (zh) | 微小型无人直升机多模态自主飞行的控制*** | |
CN108062108A (zh) | 一种基于机载计算机的智能多旋翼无人机及其实现方法 | |
CN104656660A (zh) | 微小型无人直升机多模态自主飞行的控制***及其方法 | |
CN104597912A (zh) | 一种六旋翼无人直升机跟踪飞行控制***及方法 | |
CN100356281C (zh) | 一种用于飞行器的自动驾驶仪 | |
CN105607640B (zh) | 四旋翼飞行器的位姿控制器 | |
TWI558617B (zh) | Unmanned flight vehicle autonomous flight computer system and control method | |
CN202758242U (zh) | 基于arm和fpga架构的固定翼无人机自动驾驶仪 | |
CN104503467A (zh) | 基于双核架构的无人机自主起降飞行控制*** | |
CN107505833A (zh) | 一种基于嵌入式操作***的飞行控制***及方法 | |
CN102830708A (zh) | 基于arm和fpga架构的固定翼无人机自动驾驶仪 | |
CN102426457A (zh) | 一种微型扑翼飞行器飞控导航*** | |
CN109471433B (zh) | 一种基于偏振罗盘的航向与姿态参考*** | |
CN105974494A (zh) | 一种基于双余度固定翼无人机的无线电探空*** | |
CN104765377A (zh) | 基于qnx的无人直升机飞行控制平台*** | |
CN105468010A (zh) | 多自由度惯性传感器四轴无人机自主导航飞行控制器 | |
CN2681997Y (zh) | 一种具有双处理器的飞行器自动驾驶仪 | |
CN205880667U (zh) | 一种双余度传感器的固定翼无人机自动飞行控制*** | |
CN201004180Y (zh) | 无人机姿态控制*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170111 |