一种基于视觉导航的四旋翼无人机的自主飞行系统及控制方法技术方案

本发明专利技术涉及多旋翼无人机技术领域，尤其涉及一种基于视觉导航的自主飞行四旋翼无人机。本发明专利技术采用的技术方案是：一种基于视觉导航的四旋翼无人机的自主飞行系统，其特征在于：包括飞行控制板，所述飞行控制板外接电源模块、驱动模块、高度测量模块和视觉导航模块，所述飞行控制板上设有飞控处理器模块、飞行姿态采集模块、显示模块和通讯模块。本发明专利技术的优点是：本发明专利技术的四旋翼无人机的自主飞行系统及控制方法，扩大了无人机的室内导航能力和应用的范围，同时提高了无人机躲避障碍的能力，以及无人机的机动性、智能性。无人机室内飞行技术对于防恐侦查，室内营救、拾取室内目标等具有重要意义。

【技术实现步骤摘要】
一种基于视觉导航的四旋翼无人机的自主飞行系统及控制方法
本专利技术涉及多旋翼无人机
，尤其涉及一种基于视觉导航的四旋翼无人机的自主飞行系统及控制方法。
技术介绍
在室内环境中，小型无人机往往采用微机电惯性导航装置。微机电惯性导航依靠内部的加速度计测得三个轴向的运动加速度，积分运算后得到无人机位置信息，在短时间内有很高的定位精度。但微机电惯性系统的零漂较严重，随时间的延长，误差积累使得测量精度不断降低，从而逐渐偏离准确值，不宜单独使用。目前室内环境导航常用的是采用测距传感器来获取外界环境信息，如声纳传感器、激光测距仪等。声纳传感器利用发射一列声波与接受发射波的时间间隔来感知周围环境的距离信息。声纳传感器有价格低廉、数据处理简单、实时性好的优点而被广泛使用，但声纳传感器存在测量误差较大，容易受环境因素如温度、湿度和反射声纳材料等影响。声纳传感器在发射声波时，是按着一个散射角发射的扇形区域，无法确定障碍在扇形区域的准确位置。使用多个声纳传感器时，由于室内环境较拥挤可能产生串扰，即一个声纳传感器发射的声波被另一个声纳传感器接受。声波在复杂环境中多次反射造成能量损耗，如毛後等吸收声能量，使反射的声波能量迅速减少，导致返回时的声波信号低于接受的响应阈值，而错误反馈障碍物的距离。根据声纳传感器的特点，感知环境的信息量少、精度不高和可能出现错误距离反馈，因此声纳传感器在室内导航上无法满足精确度的要求。激光测距仪利用发射一列光束和接受光束的时间间隔来感知周围环境的距离信息。由于光束的传输速度快于声波的传输速度，激光测距仪的测量速度更快，激光测距仪的测量速度主要受仪器中机械结构的电机转速限制。激光测距仪发射的光束散射角小，光波的发射性能好，不会有多次反射和错误反射情况，保证了数据的确定性，可以直接读出真实距离。与声纳传感器相比，激光测距仪在测量一倾数据时，可以测量较大角度和较多数据点，更能准确感知环境的距离信息。但是，激光测距仪价格昂贵，特别是测量三维距离信息的激光雷达。对于一般激光测距仪只能提供一个高度平面上一定测量角度的距离信息，激光接受不了镜面反射损失的光束，对于环境中的玻璃或非常光滑表面的物体无法检测，导致信息缺失。在室内环境中的导航，由于大部分障碍物都垂直地面，可以釆用与地面平行的平面距离信息进行导航。激光测距仪具有测量速度快，测量精度高，对环境中的噪声、光照强度不敏感的特点，满足无人机导航需要的实时性和精确性。但在导航中的路径规划缺乏智能性，在复杂楼道多房间导航时，无法比较判断正确目标房间，在定位目标时，无法计算目标位置。因此，应该提供一种新的技术方案解决上述问题。
技术实现思路
本专利技术要解决的技术问题是：针对目前室内导航装置存在的不足，提供一种一种基于视觉导航的四旋翼无人机的自主飞行系统及控制方法。本专利技术通过以下技术方案来实现：一种基于视觉导航的四旋翼无人机的自主飞行系统，包括飞行控制板，所述飞行控制板外接电源模块、驱动模块、高度测量模块和视觉导航模块，所述飞行控制板上设有飞控处理器模块、飞行姿态采集模块、显示模块和通讯模块，所述飞行控制板采用STM32F407飞控处理器模块，用于通过MPU-6050整合的3轴陀螺仪、3轴加速器以及地磁传感器来采集姿态数据并且采取PID控制，调制PWM信号输出不同的占空比信号驱动无刷直流电机，控制飞行姿态；所述飞行姿态采集模块包括加速度传感器和角速度传感器用于对四旋翼无人机进行姿态测量；所述高度测量模块采用US-100超声波传感器用于测量飞行高度，通过测量超声波模块返回的高电平时间，得到高度，再通过低通滤波进行数据平滑处理，得到稳定的高度信息作为反馈，对四旋翼飞行器飞行高度的进行控制；所述视觉导航模块采用K60单片机控制OV7725摄像头，用于处理图像数据，并通过串口将路线信息发送给飞行控制板使其调整飞行路线达到巡线的目的，使四旋翼飞行器自主循迹，在规定区域起降、悬停；所述驱动模块采用无刷电机和电调作为四旋翼无人机的驱动模块，用于实现四旋翼飞行器的稳定运行；所述通讯模块用于实现数据接收和数据发送；所述显示模块用于显示实时的数据输出。一种基于视觉导航的四旋翼无人机的自主飞行的控制方法，包括如下步骤：a)飞行姿态控制飞行控制板通过飞行姿态采集模块获得四旋翼无人机的各种姿态信息，作为反馈量，经过PID控制算法得出无人机4个旋浆上对应的4个电机应有的转速，然后通过PWM定时器接口发送给电调，调整4个电机的转速来实现对其姿态的控制；b)飞行器超声波定高控制定高控制算法采用的是位置式PID控制，定高控制的输出最后与姿态控制的输出叠加到4个电机的控制中，对超声波的数据滤波使用的是低通滤波，采用近三次的平均值，使用欧拉角来校正高度值，高度控制程序每60ms执行一次，把计算出的高度控制输出分成30次叠加到电机控制；c)飞行器自主循迹控制采用OV7725摄像头模块来采集线道信息，安装在飞机的下面正中心的位置，在飞行器上装配US-100超声波传感器来采集高度信息，用K60芯片专门处理图像数据，通过摄像头对实时图像进行采集，得到线道的信息，对当前采集到的图像信息做出判断，从而得到道路的情况，之后将处理完的结果通过串口发送给飞控主控制芯片达到循迹的目的；一般线道图像都由黑线和白色背景构成，在处理时将一帧图像转换成“0”、“1”的信息保存其中0为背景，1为赛道，然后提取黑线中心以得到黑线位置，自主循迹算法分为4步：(3)对图像进行中值滤波；(4)提取每一行的黑线中心点；具体方法，从第一行开始，并且从左往右开始依次寻找白色到黑色的跳变点，记下该点所在的列数X，即为该行黑线的左边界。再继续从右往左寻找白色到黑色的跳变点，记下该点所在的列数Y，即为该行黑线的右边界，那么该行黑线中心点所在的列数＝(X+Y)/2，就这样，从第1行寻找到第30行；(3)把前30行找到的所有中心点所在的列数相加以后求均值，即将前30行所有中心点列数求和然后除以30；(4)由于摄像头被安装在飞机的下面正中心的位置，根据提取到的黑线中心可以得到飞机是否偏离了方向，进而可以根据偏移量适当地调整飞机的飞行角度，使其回到赛道线的正上方。进一步的技术方案：所述四旋翼无人机为四轴飞行器，四轴飞行器配有四个旋浆，四个旋浆两两相对交叉呈十字交叉结构，每个旋浆配有一个无刷直流电机和电调，飞行控制板采调制PWM信号输出不同的占空比信号驱动无刷直流电机，控制飞行姿态。由于上述技术方案的采用，本专利技术与现有技术相比，具有如下优点：本专利技术的四旋翼无人机的自主飞行系统及控制方法，扩大了无人机的室内导航能力和应用的范围，同时提高了无人机躲避障碍的能力，以及无人机的机动性、智能性。无人机室内飞行技术对于防恐侦查，室内营救、拾取室内目标等具有重要意义。附图说明图1是本专利技术飞行器自主飞行系统方框图。图2为飞行器超声波定高控制流程图。图3为飞行器自主循迹控制流程图。其中：1、飞行控制板，2、电源模块，3、驱动模块，4、高度测量模块，5、视觉导航模块，6、飞控处理器模块，7、飞行姿态采集模块，8、显示模块，9、通讯模块。具体实施方式下面结合附图和实施例对本专利技术作进一步说明。如图1所示，一种基于视觉导航的四旋翼无人机的自主飞行系统，包括飞行控制板1，所述飞行控制板本文档来自技高网...

【技术保护点】
一种基于视觉导航的四旋翼无人机的自主飞行系统，其特征在于：包括飞行控制板，所述飞行控制板外接电源模块、驱动模块、高度测量模块和视觉导航模块，所述飞行控制板上设有飞控处理器模块、飞行姿态采集模块、显示模块和通讯模块，所述飞行控制板采用STM32F407飞控处理器模块，用于通过MPU‑6050整合的3轴陀螺仪、3轴加速器以及地磁传感器来采集姿态数据并且采取PID控制，调制PWM信号输出不同的占空比信号驱动无刷直流电机，控制飞行姿态；所述飞行姿态采集模块包括加速度传感器和角速度传感器用于对四旋翼无人机进行姿态测量；所述高度测量模块采用US‑100超声波传感器用于测量飞行高度，通过测量超声波模块返回的高电平时间，得到高度，再通过低通滤波进行数据平滑处理，得到稳定的高度信息作为反馈，对四旋翼飞行器飞行高度的进行控制；所述视觉导航模块采用K60单片机控制OV7725摄像头，用于处理图像数据，并通过串口将路线信息发送给飞行控制板使其调整飞行路线达到巡线的目的，使四旋翼飞行器自主循迹，在规定区域起降、悬停；所述驱动模块采用无刷电机和电调作为四旋翼无人机的驱动模块，用于实现四旋翼飞行器的稳定运行；所述通讯模块用于实现数据接收和数据发送；所述显示模块用于显示实时的数据输出。...

【技术特征摘要】
1.一种基于视觉导航的四旋翼无人机的自主飞行系统，其特征在于：包括飞行控制板，所述飞行控制板外接电源模块、驱动模块、高度测量模块和视觉导航模块，所述飞行控制板上设有飞控处理器模块、飞行姿态采集模块、显示模块和通讯模块，所述飞行控制板采用STM32F407飞控处理器模块，用于通过MPU-6050整合的3轴陀螺仪、3轴加速器以及地磁传感器来采集姿态数据并且采取PID控制，调制PWM信号输出不同的占空比信号驱动无刷直流电机，控制飞行姿态；所述飞行姿态采集模块包括加速度传感器和角速度传感器用于对四旋翼无人机进行姿态测量；所述高度测量模块采用US-100超声波传感器用于测量飞行高度，通过测量超声波模块返回的高电平时间，得到高度，再通过低通滤波进行数据平滑处理，得到稳定的高度信息作为反馈，对四旋翼飞行器飞行高度的进行控制；所述视觉导航模块采用K60单片机控制OV7725摄像头，用于处理图像数据，并通过串口将路线信息发送给飞行控制板使其调整飞行路线达到巡线的目的，使四旋翼飞行器自主循迹，在规定区域起降、悬停；所述驱动模块采用无刷电机和电调作为四旋翼无人机的驱动模块，用于实现四旋翼飞行器的稳定运行；所述通讯模块用于实现数据接收和数据发送；所述显示模块用于显示实时的数据输出。2.一种基于视觉导航的四旋翼无人机的自主飞行的控制方法，其特征在于：包括如下步骤：a)飞行姿态控制飞行控制板通过飞行姿态采集模块获得四旋翼无人机的各种姿态信息，作为反馈量，经过PID控制算法得出无人机4个旋浆上对应的4个电机应有的转速，然后通过PWM定时器接口发送给电调，调整4个电机的转速来实现对其姿态的控制；a)飞行器超声波定高控制定高控制算法采用的是位置式PID控制，定高控制的输出最后与姿态控制的输出叠加到4个电机的控制中，对超声波的数据滤...

【专利技术属性】
技术研发人员：刘小军，温宏愿，刘增元，周香珍，牛绿原，冯冲，张朋，
申请(专利权)人：南京理工大学泰州科技学院，
类型：发明
国别省市：江苏,32