CN106155077A - 一种四旋翼飞行器控制***及控制方法 - Google Patents
一种四旋翼飞行器控制***及控制方法 Download PDFInfo
- Publication number
- CN106155077A CN106155077A CN201610805405.1A CN201610805405A CN106155077A CN 106155077 A CN106155077 A CN 106155077A CN 201610805405 A CN201610805405 A CN 201610805405A CN 106155077 A CN106155077 A CN 106155077A
- Authority
- CN
- China
- Prior art keywords
- module
- master controller
- sensor assembly
- signal
- control
- 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 15
- 238000001514 detection method Methods 0.000 claims abstract description 25
- 230000000386 athletic effect Effects 0.000 claims abstract description 14
- 230000004888 barrier function Effects 0.000 claims abstract description 10
- 238000013024 troubleshooting Methods 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 description 5
- 239000011159 matrix material Substances 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000004064 recycling Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012360 testing method 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)
Abstract
一种四旋翼飞行器控制***及控制方法,其技术要点是:该控制***包括主控制器和分别与其相连的运动姿态传感器模块、电源驱动模块、遥控接收模块、接口及扩展模块,所述运动姿态传感器模块包括惯性测量模块、超声波模块及红外探测模块。该控制方法为:主控制器通过运动姿态传感器模块进行数据采集,再定时读取遥控接收模块传来的数据,将所获得的遥控信号和检测数据做比较,计算出偏差,如四周没有障碍物,通过PID控制得到电机控制量并正常起飞。本发明可将飞行器的当前姿态与目标姿态进行对比,可根据运动姿态传感器模块的检测数据计算出当前姿态与目标姿态的差值,然后调整电机输出量,控制电机的转速,使其接近目标姿态。
Description
技术领域:
本发明涉及飞行器领域,具体涉及一种四旋翼飞行器控制***及控制方法。
背景技术:
资源紧缺是世界各国共同面对的难题,每年都会投入大量的人力、物力和财力。在能源勘测过程中,经常会遇到各种复杂的地势,如干旱的沙漠、充满瘴气的森林,浩瀚的海洋,有些地方允许人类探寻,但是有许多地方很难允许工作人员前往[1]。考虑这一限制,科研人员研发各种探测器代替工作人员,完成探测工作。
四旋翼是一种常见的多旋翼飞行器。该飞行器体积小,灵活稳定,具有一定的载重能力和续航能力,可以搭载摄像设备进行航空拍摄或者对火灾和犯罪现场进行监控;携带勘察设备对某些区域的地势或环境进行勘察等。四旋翼飞行器是通过改变电机转速来改变旋翼转速,进而改变升力,控制飞行器的飞行姿态和移动方式的,这种操作方式会导致其动力不稳,所以需要研究出一种能够长期确保飞行动力稳定的控制***和控制方法。
发明内容:
本发明提供了一种四旋翼飞行器控制***及控制方法,其可合成正确的飞行姿态数据,可得到稳定的姿态算法,可确保飞行动力的稳定。
本发明的四旋翼飞行器控制***,采用的技术方案在于:包括主控制器和分别与其相连的运动姿态传感器模块、电源驱动模块、遥控接收模块、接口及扩展模块,所述运动姿态传感器模块包括惯性测量模块、超声波模块及红外探测模块。
作为本控制***的进一步改进,所述惯性测量模块包括加速度仪和分布于三个轴向的三个单自由度的陀螺仪。
本发明的四旋翼飞行器控制方法,采用的技术方案在于:主控制器通过运动姿态传感器模块进行数据采集,再定时读取遥控接收模块传来的数据,将所获得的遥控信号和检测数据做比较,计算出偏差,如四周没有障碍物,通过PID控制得到电机控制量并正常起飞。
作为本控制方法的进一步改进,其主要包括以下步骤:
一、主控制器通过运动姿态传感器模块进行信号检测,判断是否有遥控接收模块的启动信号;
二、主控制器接收到启动信号后,判断周围是否有障碍物;
三、若有障碍物,则通过主控制器判断障碍物的方位并发出躲避障碍控制信号,之后再读取姿态传感器模块的检测信号;若无障碍物,则通过主控制器读取控制信号,再读取姿态传感器模块的检测信号;
四、主控制器根据姿态传感器模块的检测信号来将当前姿态与目标姿态进行对比,之后计算出飞行器的飞行姿态。
本发明的有益效果是:本发明可将飞行器的当前姿态与目标姿态进行对比,实现闭环控制,可根据运动姿态传感器模块的检测数据计算出当前姿态与目标姿态的差值,然后调整电机输出量,控制电机的转速,使其接近目标姿态,通过本发明的控制***和控制方法可合成正确的飞行姿态数据,可得到稳定的姿态算法,可确保飞行动力的稳定。
附图说明:
图1为本发明的控制***的电路原理图;
图2为本发明的控制方法的流程图。
具体实施方式:
参照图1,本发明的四旋翼飞行器控制***,包括主控制器和分别与其相连的运动姿态传感器模块、电源驱动模块、遥控接收模块、接口及扩展模块,所述运动姿态传感器模块包括惯性测量模块、超声波模块及红外探测模块,所述惯性测量模块包括加速度仪和分布于三个轴向的三个单自由度的陀螺仪。
参照图2,本发明的四旋翼飞行器控制方法,主控制器通过运动姿态传感器模块进行数据采集,再定时读取遥控接收模块传来的数据,将所获得的遥控信号和检测数据做比较,计算出偏差,如四周没有障碍物,通过PID控制得到电机控制量并正常起飞。
其主要包括以下步骤:
一、主控制器通过运动姿态传感器模块进行信号检测,判断是否有遥控接收模块的启动信号;
二、主控制器接收到启动信号后,判断周围是否有障碍物;
三、若有障碍物,则通过主控制器判断障碍物的方位并发出躲避障碍控制信号,之后再读取姿态传感器模块的检测信号;若无障碍物,则通过主控制器读取控制信号,再读取姿态传感器模块的检测信号;
四、主控制器根据姿态传感器模块的检测信号来将当前姿态与目标姿态进行对比,之后计算出飞行器的飞行姿态。
对于飞行姿态检测和飞行姿态的控制:对四旋翼飞行器进行姿态控制,首先需要解决的是姿态检测,只有检测到飞行器的姿态方能对其进行控制。现在普遍常用的是通过惯性导航技术来检测飞行姿态。惯性导航***通常由惯性测量模块、计算机和控制显示单元组成。惯性测量模块包含加速度仪和分布于三个轴向的三个单自由度的陀螺仪。
惯性导航***的工作原理是:以牛顿力学定律作为理论基础,利用陀螺仪建立空间坐标基准,即导航坐标系,再利用加速度仪测量载体的运动加速度,将运动加速度转化到导航坐标系后,经过两次积分运算,最终确定出载体的位置和速度等运动参数。惯性导航***按安装方式分类分为平台式惯性导航***与捷联式惯性导航***。平台式惯性导航***是将惯性测量模块固定在机电导航平台上,可以相对于重力加速度和地球自转角速度进行任意定向测试。导航平台用来模拟导航坐标系,把加速度仪的测量稳定在导航坐标系中,使其能直接测量载体在导航坐标系轴向的加速度,这样就可以用几何的方法从平台的框架上直接获取载体的姿态和航向信息。该***测量精度较高,方便对惯性器件的测量进行补偿和修正,但***结构复杂、成本高、体积大使用范围受到很大限制。然而,捷联式惯性导航***抛弃了复杂的机电导航平台,将加速度仪和陀螺仪直接固定在载体上,在计算机中直接对姿态矩阵进行计算,即通过姿态矩阵将加速度仪测得的加速度信息变换到导航坐标系,再求得载体的姿态和航向信息。在捷联式惯性导航***中,电气导航平台的功能更多地依靠计算机来完成,简化运算,便于信息存储和分析。直到1994年捷联式惯性导航***市场占有率约有百分之九十。
Claims (4)
1.一种四旋翼飞行器控制***,其特征在于:包括主控制器和分别与其相连的运动姿态传感器模块、电源驱动模块、遥控接收模块、接口及扩展模块,所述运动姿态传感器模块包括惯性测量模块、超声波模块及红外探测模块。
2.如权利要求1所述的一种四旋翼飞行器控制***,其特征在于:所述惯性测量模块包括加速度仪和分布于三个轴向的三个单自由度的陀螺仪。
3.一种四旋翼飞行器控制方法,其特征在于:主控制器通过运动姿态传感器模块进行数据采集,再定时读取遥控接收模块传来的数据,将所获得的遥控信号和检测数据做比较,计算出偏差,如四周没有障碍物,通过PID控制得到电机控制量并正常起飞。
4.如权利要求3所述的一种四旋翼飞行器控制方法,其特征在于主要包括以下步骤:
一、主控制器通过运动姿态传感器模块进行信号检测,判断是否有遥控接收模块的启动信号;
二、主控制器接收到启动信号后,判断周围是否有障碍物;
三、若有障碍物,则通过主控制器判断障碍物的方位并发出躲避障碍控制信号,之后再读取姿态传感器模块的检测信号;若无障碍物,则通过主控制器读取控制信号,再读取姿态传感器模块的检测信号;
四、主控制器根据姿态传感器模块的检测信号来将当前姿态与目标姿态进行对比,之后计算出飞行器的飞行姿态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610805405.1A CN106155077A (zh) | 2016-09-06 | 2016-09-06 | 一种四旋翼飞行器控制***及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610805405.1A CN106155077A (zh) | 2016-09-06 | 2016-09-06 | 一种四旋翼飞行器控制***及控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106155077A true CN106155077A (zh) | 2016-11-23 |
Family
ID=57340753
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610805405.1A Pending CN106155077A (zh) | 2016-09-06 | 2016-09-06 | 一种四旋翼飞行器控制***及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106155077A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106774374A (zh) * | 2017-01-20 | 2017-05-31 | 武汉科技大学 | 一种无人机自动巡检方法及*** |
CN109085843A (zh) * | 2017-06-13 | 2018-12-25 | 徐海东 | 一种四轴无人机控制*** |
CN110082386A (zh) * | 2019-04-19 | 2019-08-02 | 山东省科学院海洋仪器仪表研究所 | 一种尾翼可调式海底沉积物温度探针控制***及控制方法 |
CN112015193A (zh) * | 2020-08-18 | 2020-12-01 | 江阴市翔诺电子科技有限公司 | 模型飞机控制***及控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104020777A (zh) * | 2014-06-17 | 2014-09-03 | 成都华诚智印科技有限公司 | 一种体感跟随式飞行控制***及其控制方法 |
CN104460685A (zh) * | 2014-11-21 | 2015-03-25 | 南京信息工程大学 | 一种四旋翼飞行器的控制***及其控制方法 |
CN104635742A (zh) * | 2013-11-13 | 2015-05-20 | 四川豪斯特电子技术有限责任公司 | 一种无人机飞行控制装置 |
US20150253771A1 (en) * | 2008-02-12 | 2015-09-10 | Katherine C. Stuckman | Radio controlled aircraft, remote controller and methods for use therewith |
CN204883371U (zh) * | 2015-07-06 | 2015-12-16 | 杨珊珊 | 一种定维飞行的多旋翼飞行器及其控制器 |
CN105589467A (zh) * | 2016-02-29 | 2016-05-18 | 南京航空航天大学 | 一种低成本扩展航姿传感器模块 |
-
2016
- 2016-09-06 CN CN201610805405.1A patent/CN106155077A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150253771A1 (en) * | 2008-02-12 | 2015-09-10 | Katherine C. Stuckman | Radio controlled aircraft, remote controller and methods for use therewith |
CN104635742A (zh) * | 2013-11-13 | 2015-05-20 | 四川豪斯特电子技术有限责任公司 | 一种无人机飞行控制装置 |
CN104020777A (zh) * | 2014-06-17 | 2014-09-03 | 成都华诚智印科技有限公司 | 一种体感跟随式飞行控制***及其控制方法 |
CN104460685A (zh) * | 2014-11-21 | 2015-03-25 | 南京信息工程大学 | 一种四旋翼飞行器的控制***及其控制方法 |
CN204883371U (zh) * | 2015-07-06 | 2015-12-16 | 杨珊珊 | 一种定维飞行的多旋翼飞行器及其控制器 |
CN105589467A (zh) * | 2016-02-29 | 2016-05-18 | 南京航空航天大学 | 一种低成本扩展航姿传感器模块 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106774374A (zh) * | 2017-01-20 | 2017-05-31 | 武汉科技大学 | 一种无人机自动巡检方法及*** |
CN109085843A (zh) * | 2017-06-13 | 2018-12-25 | 徐海东 | 一种四轴无人机控制*** |
CN110082386A (zh) * | 2019-04-19 | 2019-08-02 | 山东省科学院海洋仪器仪表研究所 | 一种尾翼可调式海底沉积物温度探针控制***及控制方法 |
CN110082386B (zh) * | 2019-04-19 | 2022-04-12 | 山东省科学院海洋仪器仪表研究所 | 一种尾翼可调式海底沉积物温度探针控制***及控制方法 |
CN112015193A (zh) * | 2020-08-18 | 2020-12-01 | 江阴市翔诺电子科技有限公司 | 模型飞机控制***及控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104848859B (zh) | 一种三轴惯性稳定平台及其自定位定向的控制方法 | |
US10060741B2 (en) | Topology-based data gathering | |
García Carrillo et al. | Combining stereo vision and inertial navigation system for a quad-rotor UAV | |
CN103853156B (zh) | 一种基于机载传感器的小型四旋翼飞行器控制***及方法 | |
JP5455339B2 (ja) | 時間シフトのオプションを有する統合シミュレーションを用いて装置の動作を制御するための方法およびシステム | |
CN103744430B (zh) | 一种小型无人直升机飞行控制方法 | |
CN107478220A (zh) | 无人机室内导航方法、装置、无人机及存储介质 | |
CN110494360A (zh) | 用于提供自主摄影及摄像的***和方法 | |
US11798426B2 (en) | Autonomous mission action alteration | |
CN106155077A (zh) | 一种四旋翼飞行器控制***及控制方法 | |
CN104950904A (zh) | 矿井应急救援飞行器自主飞行方法 | |
CN102190081B (zh) | 基于视觉的飞艇定点鲁棒控制方法 | |
CN104648685B (zh) | 基于智能手机的四旋翼飞行器指定路径航拍***和方法 | |
CN111061266A (zh) | 一种实时场景分析和空间避障的夜间值守机器人 | |
CN109254587B (zh) | 在无线充电条件下稳定悬停的小型无人机及其控制方法 | |
CN104808231A (zh) | 基于gps与光流传感器数据融合的无人机定位方法 | |
CN110162098A (zh) | 一种矿用无人机 | |
Segales et al. | Implementation of a low cost UAV for photogrammetry measurement applications | |
CN109801484A (zh) | 一种应急通信无人机***及应急通信*** | |
CN109343558A (zh) | 一种旋翼无人机自动校正导航控制*** | |
Dickmanns et al. | Autonomous landing of airplanes by dynamic machine vision | |
Moyano Cano | Quadrotor UAV for wind profile characterization | |
Garratt et al. | Visual control of an autonomous helicopter | |
CN103557875B (zh) | 一种姿态测量***的fpga硬件实现方法 | |
Steiner III | A unified vision and inertial navigation system for planetary hoppers |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20161123 |