一种基于机载传感器的小型四旋翼飞行器控制系统技术方案

本实用新型专利技术涉及四旋翼飞行器的技术领域，更具体地，涉及一种基于机载传感器的小型四旋翼飞行器控制系统。一种基于机载传感器的小型四旋翼飞行器控制系统，包括惯性测量单元模块、微处理器、电调、超声波传感器、光流传感器、摄像头、无线模块、直流无刷电机。本实用新型专利技术融合低成本、轻量的机载传感器系统的信息实时估计飞行器的6自由度飞行姿态，设计了内环姿态控制和外环位置控制的闭环控制策略，在没有全球定位系统（GPS）和室内定位系统的环境下，利用机载传感器系统和微处理器实现了旋翼飞行器的自主垂直起降、室内精确定位、自主悬停、自主追踪航迹点的飞行轨迹控制以及基于领队跟随策略的飞行器编队控制，为实现旋翼飞行器的自主飞行提供了一种可靠、精确、低成本的控制策略。

【技术实现步骤摘要】
—种基于机载传感器的小型四旋翼飞行器控制系统
本技术涉及四旋翼飞行器的
，更具体地，涉及一种基于机载传感器的小型四旋翼飞行器控制系统。
技术介绍
由于小型四旋翼飞行器具有体积小、重量轻、可垂直起飞降落、定点悬停、高机动性等优点，在交通监控、自然灾害监视与救援、环境和污染监测、农林业勘测、应对突发事件等领域具有广阔的应用前景。四旋翼飞行器是一个多变量、强耦合的复杂非线性系统，由于在三维空间中运动，它的飞行姿态和运动轨迹的控制比地面机器人的控制更为困难。受有限负载能力和电源的限制，小型旋翼飞行器根据机载的轻便传感器系统(例如视觉传感器、小型激光测距仪)感知外部环境。同时，由于机载控制板的运算能力有限，难以在机载控制板上进行复杂的视觉和控制算法的运算。因此，如何根据机载小型传感器系统感知外部环境，如何实时规划和控制其运动轨迹以实现小型旋翼飞行器的自主飞行，是非常具有挑战性的问题。当前在微小型旋翼无人机领域的研究工作主要集中在飞行器的自主稳定飞行、自主避障、基于机载视觉的目标识别和跟踪、三维空间的同步自定位与地图创建及多飞行器的协调控制等。美国宾夕法尼亚大学、瑞士苏黎世联邦理工学院、斯坦福大学等机构在小型旋翼飞行器的自主飞行研究领域处于领先地位。宾夕法尼亚大学的GRASP实验室和瑞士联邦理工学院的研究团队研究了室内环境中单个小型旋翼飞行器的自主飞行以及多个小型飞行器的编队飞行与协同合作。在飞行过程中，宾夕法尼亚大学和瑞士联邦理工的研究团队利用Vicon高速动作捕捉系统所提供的旋翼无人机的精确室内全局位置信息，实现了旋翼飞行器的高灵敏度与高精度的飞行姿态控制。在室外环境下，飞行器的位置信息可由全球定位系统系统(GPS)提供实时位置信息。在无GPS信号的环境下，例如在室内环境中，通常由高速、高精度的室内定位系统(如Vicon高速动作捕捉系统、Optitrack运动捕捉系统、基于超宽带技术的无线定位系统等)提供飞行器的实时位置信息，这些高速、高精度室内定位系统的价格非常昂贵，同时，由于飞行器受限于定位系统的有效测量空间，这极大地限制了飞行器自主飞行的性能。实现飞行器自定位的另一种解决方案是使用激光测距仪，但适于小型飞行器的激光测距仪的价格昂贵、更新速率低。光流技术是一种有效的自主定位方案，基于电脑鼠标传感器或CMOS摄像头的光流传感器都已被成功的应用于单个飞行器的自主导航。
技术实现思路
本技术为克服上述现有技术所述的至少一种缺陷，提供一种基于机载传感器的小型四旋翼飞行器控制系统，是基于低成本、轻量的机载传感器的小型四旋翼飞行器的自主飞行控制系统。在无GPS信号环境中，基于机载的传感器和机载的微处理器，实现了飞行器6自由度飞行姿态的实时估计与控制，提供了一种精确、可靠、低成本的小型旋翼飞行器的自主飞行控制策略。为解决上述技术问题，本技术采用的技术方案是:一种基于机载传感器的小型四旋翼飞行器控制系统，其中，包括惯性测量单元模块、微处理器、电调、超声波传感器、光流传感器、摄像头、无线模块、直流无刷电机；所述惯性测量单元模块与微处理器的IIC总线接口相连接；电调与微处理器的PWM 口相连接；超声波传感器与微处理器的I/O 口相连接；光流传感器与微处理器的SPI总线接口相连接；无线模块与微处理器的串口 SCI相连接；直流无刷电机与电调的输出相连接；摄像头与微处理器连接。所述的惯性测量单元模块包括三轴磁力计、三轴加速度计、三轴陀螺仪，所述三轴磁力计、三轴加速度计、三轴陀螺仪同时与微处理器的IIC总线接口相连接。本技术中，基于机载传感器实时估计飞行器的6自由度飞行姿态，包括三个姿态角(俯仰角θ、横滚角Φ、偏航角Ψ)以及在惯性坐标系中的(x，y，z)。融合机载的惯性测量单元模块(包括三轴陀螺仪，三轴加速度计和三轴磁力计)的测量数据，可准确估计飞行器的三个姿态角。采用基于梯度下降法的数据融合算法(Sebastian 0.H.Madgwick, AndrewJ.L.Harrison, Ravi Vaidyanathanj Estimat1n of IMU and MARG orientat1n using agradient descent algorithm, Proc.0f IEEE Conf.Rehabilitat1n Robotics, pp.1-7, Zurich, June2011)，融合惯性测量单元的数据，可精确解算飞行器的姿态角度。飞行器相对地面的高度由超声波传感器测得；光流传感器测得飞行器水平方向的速度信息，对速度进行积分可得到飞行器水平方向的位移。飞行器底部安装了彩色摄像头，可获取地面的视频信息，实时视频信息通过图传模块发送给地面工作站，以实现飞行器对地面的实时监控。通过无线模块，飞行器的各状态传输给地面工作站，同时地面工作站通过无线模块给飞行器发送上层控制指令。本飞行器在无GPS信号环境中，基于机载的传感器和机载的微处理器，实现了飞行器6自由度飞行姿态的实时估计与控制。进一步的，一种应用所述基于机载传感器的小型四旋翼飞行器控制系统的控制方法，其中，包括以下步骤:S1.微处理器读取三轴磁力计、三轴加速度计、三轴陀螺仪的数据，并且将得到的数据进行数据融合解算得到飞行器的姿态信息；微处理器读取超声波传感器和光流传感器的数据，并且将得到的数据转换成对应的位置坐标信息；S2.基于估计得到的飞行器姿态和位置坐标信息，采用PID、ro或PI控制算法，计算出对应微处理器需要输出的PWM信号；S3.微处理器将计算得到的PWM信号输出给电调；S4.电调驱动直流无刷电机，通过控制四个电机的转速。进一步的，所述的步骤SI中，三轴磁力计、三轴加速度计、三轴陀螺仪估计飞行器的三个姿态角，三个姿态角包括俯仰角Θ、横滚角Φ、偏航角Ψ。所述的步骤SI中,超声波传感器测得飞行器相对地面的高度Z，光流传感器测得飞行器水平方向的速度信息，对速度进行积分得到飞行器水平方向的位移，得到飞行器水平方向位置X和I。进一步的，所述的姿态控制频率为400赫兹，位置控制频率为40赫兹，微处理器每2.5毫秒读取三轴磁力计、三轴加速度计、三轴陀螺仪的数据；微处理器每25毫秒读取超声波传感器和光流传感器的数据。飞行器处于悬停或者近似悬停状态时，四旋翼飞行器可近似为线性系统，此时，飞行器的姿态角(Φ，θ，ψ)和位置(x，y，z)可解耦为6个独立状态变量分别进行控制。通过机载传感器系统，微处理器获得飞行器完整的姿态角度和位置信息后，飞行器的自主飞行控制采用内环和外环的闭环控制结构，其中内环控制飞行器的姿态角，外环控制飞行器的位置，内环的姿态控制采用比例微分ro控制算法；外环的位置控制采用比例积分微分PID控制算法。四旋翼飞行器的控制首先是姿态的稳定控制，在姿态稳定控制的基础上实现飞行器的位置控制。因此，内环姿态控制的控制频率远高于外环位置控制的控制频率，以实现飞行器姿态的稳定、快速、准确的控制，进而提高外环位置控制的精度。具体的，控制方法包括飞行器垂直起降和悬停的控制方法、飞行器自主追踪航迹点的控制方法；飞行器垂直起降和悬停的控制方法为:将飞行器姿态期望值设为= 0，Θ d =O,灼=0，水平方向位置设为Xd = O, yd 本文档来自技高网...

【技术保护点】
一种基于机载传感器的小型四旋翼飞行器控制系统，其特征在于，包括惯性测量单元模块、微处理器（4）、电调（5）、超声波传感器（6）、光流传感器（7）、摄像头（8）、无线模块（9）、直流无刷电机（10）；所述惯性测量单元模块与微处理器（4）的IIC总线接口相连接；电调（5）与微处理器（4）的PWM口相连接；超声波传感器（6）与微处理器（4）的I/O口相连接；光流传感器（7）与微处理器（4）的SPI总线接口相连接；无线模块（9）与微处理器（4）的串口SCI相连接；直流无刷电机（10）与电调（5）的输出相连接；摄像头（8）与微处理器（4）连接。

【技术特征摘要】
1.一种基于机载传感器的小型四旋翼飞行器控制系统，其特征在于，包括惯性测量单元模块、微处理器(4)、电调(5)、超声波传感器(6)、光流传感器(7)、摄像头(8)、无线模块(9)、直流无刷电机(10)； 所述惯性测量单元模块与微处理器(4)的IIC总线接口相连接；电调(5)与微处理器(4)的PWM 口相连接；超声波传感器(6)与微处理器(4)的I/O 口相连接；光流传感器(7)与微处理器(4)的SPI总线接口...

【专利技术属性】
技术研发人员：成慧，陈有生，
申请(专利权)人：中山大学，
类型：新型
国别省市：广东;44