一种多旋翼无人机环境自主监测控制系统及方法
【专利摘要】本发明公开了一种多旋翼无人机环境自主监测控制系统及方法，该系统包括多旋翼无人机、地面通信转换系统和移动终端，多旋翼无人机包括无人机控制系统和无人机动力系统；无人机控制系统用于控制多旋翼无人机的运行状态，包括上升、悬停、避障和下落，在运行过程中对空气中的污染物进行多维度自动监测，并将采集到的数据发送出去；地面通信转换系统用于接收无人机采集到的数据，发送给移动终端，并接收来自移动终端的控制指令，发送给无人机。本发明能在无人机姿态平稳的条件下，保证测量精度，实现多维度、不同污染物的浓度检测。
【专利说明】
-种多旋翼无人机环境自主监测控制系统及方法
技术领域
[0001] 本发明设及无人机和无线传感领域，尤其设及一种多旋翼无人机环境自主监测控 制系统及方法。
【背景技术】
[0002] 近年来，环境问题备受关注，需要对大气中的污染物的进行实时监测并且采集数 据，W便于分析与改善措施的制定等。目前，随着科技的日益发展，利用无人机来监测环境 逐渐普及。无人机的控制和信息采集传送是监测系统的关键技术之一。现有的环境监测无 人机项目大多是使用特定的遥控器进行无线控制，对于采集到的数据由存储卡进行存储。
[0003] 采用特定的遥控器进行无人机控制，增加了系统的开发成本且不便于携带，在高 空采集地点不稳定，容易发生偏移，不能对无人机姿态进行完美的控制，其控制精度与可信 度也会受到人为因素的影响。利用存储卡存储无人机采集到的数据图像信息，并不能在无 人机飞行的过程中实时分析环境数据，也就不便于依照环境情况调整无人机的飞行路线， 会增加监测的工作量。
【发明内容】
[0004] 本发明要解决的技术问题在于针对现有技术中人工控制无人机采集数据容易产 生误差偏移的缺陷，提供一种能够自动控制无人机进行环境监测的多旋翼无人机环境自主 监测控制系统及方法。
[0005] 本发明解决其技术问题所采用的技术方案是：
[0006] 本发明提供一种多旋翼无人机环境自主监测控制系统，包括多旋翼无人机、地面 通信转换系统和移动终端，多旋翼无人机包括无人机控制系统和无人机动力系统，其中：
[0007] 无人机控制系统包括主控模块、姿态控制模块、无线收发模块和污染物测量模块， 用于控制多旋翼无人机的运行状态，包括上升、悬停、避障和下落，在运行过程中对空气中 的污染物进行多维度自动监测，并将采集到的数据发送出去；
[000引地面通信转换系统用于根据不同的通信方式，包括在线和离线模式，接收无人机 采集到的数据，发送给移动终端，并接收来自移动终端的控制指令，发送给无人机；
[0009] 移动终端用于对无人机进行功能设定，并接收和显示无人机的监测数据。
[0010] 进一步地，本发明的无人机控制系统还包括与主控模块相连的图像采集模块、避 障模块和导航模块。
[0011] 进一步地，本发明的地面通信转换模块包括蓝牙模块和无线收发模块。
[0012] 进一步地，本发明的姿态控制模块包括主控MCU、六轴数字传感器和=轴数字磁力 计。
[0013] 本发明提供一种多旋翼无人机环境自主监测控制方法，包括W下步骤：
[0014] S1、移动终端向无人机发送路径指令和控制指令，控制无人机移动至初始坐标，由 无人机姿态估计与姿态控制系统读取传感器的值，进行姿态解算，得到无人机的横滚、俯 仰、航向运些姿态角，进而通过串级PID算法、数字滤波算法等调整无人机的姿态，消除干扰 信号并控制无人机保持平衡；
[0015] S2、无人机实时监测当前位置空气中的污染物数据，采集超声波传感器的值进行 高度PID控制，并根据路径指令自动移动至下个位置进行监测，移动过程中对障碍物进行检 测并避障；
[0016] S3、无人机将采集到的监测数据通过无线发送给移动终端，完成路径上所有点的 监测后，自动返回。
[0017] 进一步地，本发明的步骤Sl中姿态解算的方法具体为：
[0018] 根据姿态传感器巧螺仪测量的无人机在x、y、z轴方向上的角速度，解算得到四元 数在短时间内的增量，通过积分得到无人机在某一时刻的四元数值，从而计算出此时刻无 人机机体的欧拉角。
[0019] 进一步地，本发明的步骤Sl中通过双PID控制调整无人机的姿态的方法具体为：
[0020] 外环输入为欧拉角角度设定值，并与当前机体姿态解算得到的欧拉角测量值比 较，差值经过外环PID控制器输出内环的目标角速度信号，并与当前姿态传感器得到的角速 度值比较，差值经过内环PID控制器计算，输出为给到电调的PWM信号，电调输出电流通过旋 翼电机控制无人机的机身角度进行飞行，然后姿态传感器检测下一次机身的角度与角速度 值，进行下一次串级PID控制。其中内、外环PID控制W较短的时间间隔循环。
[0021] 进一步地，本发明的步骤Sl中获取无人机坐标的方法具体为:使用卡尔曼滤波器 将速度位置信息与GI^信息融合，得到准确的无人机的导航信息。
[0022] 进一步地，本发明的步骤S2中通过定高控制算法调整无人机的姿态的方法具体 为：
[0023] 控制器输入为高度设定值，并与实际测量高度值比较，差值经过高度PID控制器， 输出为P歷控制信号，与姿态控制输出的P歷信号相加控制旋翼电机，从而控制无人机机体 的高度;然后经过20ms，超声波传感器测量下一次机体实际高度，进行下一次高度控制;控 制算法中，将预先设定高度分300次逐渐增加共6s传入高度设定值，控制无人机上升的速 度，保证其一键起飞的稳定性;超声波传感器每20ms检测一次无人机高度，高度PID控制器 在实际微分项中加入加速度积分得到的速度，设置一定的系数比，W防止无人机在一键起 飞时的速度偏高，由于积分误差的存在，在到达预设高度后去掉速度融合项。
[0024] 进一步地，本发明的步骤S3中无人机将采集到的监测数据通过无线发送给移动终 端的方法具体包括：
[0025] 在线状态，移动终端直接利用wifi、gprs，通过向云服务器发送指令实现对无人机 控制，并通过云服务器监控储存无人机地理位置、污染物测量数据、图像信息，由移动终端 通过wifi、gprs无线信号向云服务器发送数据请求读取并显示数据；
[0026] 离线状态，利用地面通信转换端作为无人机与移动终端的通信中转站，地面通信 转换端包括无线收发模块和蓝牙模块，移动终端对无人机的控制信息由蓝牙模块传输至通 信转换端内，再由无线收发模块转送至无人机主控忍片；同样，无人机的位置信息、污染物 测量数据和图像采集信息通过通信转换端传回移动终端，用于后续的分析。
[0027] 本发明产生的有益效果是:本发明的多旋翼无人机环境自主监测控制系统，在多 旋翼无人机的自主导航与自主悬停性能的基础上，完成某一维度的气体测量后，控制无人 机完成自主上升，到达指定地点悬停，自主测量、避障、下落等任务，全程无人操作，并且能 在无人机姿态平稳的条件下，保证测量精度，实现多维度、不同污染物的浓度检测，对于监 测结果可W通过实时传回移动终端进行读取显示，便于依照监测环境的情况调整无人机的 飞行路线，可W减少监测的工作量;该系统可W提高无人机的控制精度，实现环境气体的高 精度自动监测。
【附图说明】
[0028] 下面将结合附图及实施例对本发明作进一步说明，附图中：
[0029] 图1是本发明实施例的多旋翼无人机环境自主监测控制系统的结构图；
[0030] 图2是本发明实施例的多旋翼无人机环境自主监测控制系统的控制系统框图；
[0031] 图3是本发明实施例的多旋翼无人机环境自主监测控制系统的Amlroid终端的结 构框图；
[0032] 图4是本发明实施例的多旋翼无人机环境自主监测控制系统的姿态控制的算法示 意图；
[0033] 图5是本发明实施例的多旋翼无人机环境自主监测控制系统的高度控制的算法示 意图；
[0034] 图中，1-控制系统，10-主控忍片，11-姿态控制系统，12-导航系统，13-无线收发模 块，14-避障模块，15-图像采集模块，16-污染物测量模块，2-地面通信转换系统，S-Amlroid 终端，110-六轴数字传感器，111-S轴数字磁力计，112-主控MCU，4-无人机动力系统，40-电 调，41-无刷电机，42-螺旋奖，43-电池，30-无人机飞行坐标设定，31-航行轨迹，32-自动归 位，33-监控区域图像，34-空气质量分析，35-云服务器，36-电池电量显示，37-蓝牙。
【具体实施方式】
[0035] 为了使本发明的目的、技术方案及优点更加清楚明白，W下结合附图及实施例，对 本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用W解释本发明，并不 用于限定本发明。
[0036] 如图1所示，本发明实施例的多旋翼无人机环境自主监测控制系统，包括多旋翼无 人机、地面通信转换系统和移动终端，多旋翼无人机包括无人机控制系统和无人机动力系 统，其中：
[0037] 无人机控制系统包括主控模块、姿态控制模块、无线收发模块和污染物测量模块， 用于控制多旋翼无人机的运行状态，包括上升、悬停、避障和下落，在运行过程中对空气中 的污染物进行多维度自动监测，并将采集到的数据发送出去；
[0038] 地面通信转换系统用于根据不同的通信方式，包括在线和离线模式，接收无人机 采集到的数据，发送给移动终端，并接收来自移动终端的控制指令，发送给无人机；
[0039] 移动终端用于对无人机进行功能设定，并接收和显示无人机的监测数据。
[0040] 无人机控制系统还包括与主控模块相连的图像采集模块、避障模块和导航模块。 地面通信转换模块包括蓝牙模块和无线收发模块。姿态控制模块包括主控MCU、六轴数字传 感器和S轴数字磁力计。无人机动力系统包括多组与主控MCU相连的旋翼模块，每组旋翼模 块均包括依次相连的电调、无刷电机和螺旋奖。
[0041] 如图2所示，在本发明的另一个具体实施例中，多旋翼无人机环境自主监测控制系 统，由多旋翼无人机，无线通信端和Amlroid终端S大部分组成，多旋翼无人机主要由控制 系统和动力系统两部分组成，控制系统W微处理器为主控忍片实现整机控制，主要包括姿 态控制系统、导航系统、无线收发模块、避障模块、图像采集模块和大气污染物测量模块;动 力系统主要由电调、无刷电机、螺旋奖和航模电池组成。
[0042] 无线通信端，按照系统的在线与离线模式，具有两种不同的通信方式，第一种是在 线状态下，An化Oid终端直接利用wifi、gprs，通过向云服务器发送指令实现对无人机控制， 并通过云服务器监控储存无人机地理位置、污染物测量数据、图像信息，由Amlroid通过所 述Wif i、gprs无线信号向云服务器发送数据请求读取并显示数据;第二种是离线状态下，利 用地面通信转换端作为无人机与Amlroid终端的通信中转站，所述地面通信转换端包括无 线收发模块和蓝牙模块，后两者之间有相应的数据转换模块，所述无线收发模块负责无人 机与地面转换端的通信，所述地面转换端内的蓝牙模块与Amlroid终端实现蓝牙通信，即 Android终端对无人机的控制信息由蓝牙模块传输至通信转换端内，再由无线收发模块转 送至无人机主控忍片；同样，无人机的位置信息、污染物测量数据和图像采集信息通过通信 转换端传回Amlroid终端，便于后续的分析。
[0043] 如图3所示，Andriod终端，能够实现对无人机的坐标设定、自动归位控制，接收并 显示环境监测数据、监控区域图像、航行轨迹W及无人机电池电量，并根据污染物测量数据 分析不同高度的污染程度，测量数据图像W及分析情况可W同步保存至Amlroid终端SD卡 W及云服务器中，所述云服务器，在系统使用在线模式时，可W实时接收从无人机发来的位 置信息、不同高度污染物测量的数据、图像信息，并存储在云服务器中，Amlroid终端验证用 户信息后，通过无线信号向云服务器发送数据请求信号，云服务器判别请求信号的类型之 后向Amlroid终端发送所需的数据。
[0044] 如图2所示，姿态控制系统，用六轴数字传感器和=轴数字磁力计相融合，运用串 级PID控制实现多旋翼无人机的平衡控制W及其他所需的计算。多旋翼无人机使用六轴数 字传感器110和=轴数字磁力计111相融合进行姿态估计，所述六轴数字传感器内部集成= 轴加速度计和S轴巧螺仪，能W 200Hz的频率提供所需加速度和巧螺仪数据，S轴数字磁力 计能W50化的频率提供所需地磁方向数据，从而得到准确的无人机姿态，便于进行姿态解 算。
[0045] 导航系统12使用现代导航技术。采用新一代低功耗、高精度的GPS模块，且支持中 国北斗导航。多旋翼无人机的速度位置信息通过多旋翼无人机控制系统的姿态估计器得 到。使用卡尔曼滤波器将速度位置信息与GPS信息融合，可得到准确的无人机的导航信息。 然后根据导航信息和无人机设定的飞行信息对多旋翼无人机进行定位，所述定位信息可W 在导航地图上实时显示。
[0046] 无线收发模块13,对应于系统使用离线模式时启用，可工作于免许可证的2.4G ISM频段，大功率、高灵敏度、数据传输距离远，且重量只有十几克。分别安装于多旋翼无人 机和地面通信转换端内，用于两者之间的远程通信，多旋翼无人机的主控系统只需使用SPI 接口与该无线模块连接，即可进行数据的收发。
[0047] 地面通信转换系统2如图1所示，是系统离线模式下的通信方式，所述地面通信转 换端作为无人机与Amlroid终端的通信中转站，包括无线收发模块和蓝牙模块。离线模式下 Amlro id终端向无人机发送指令的步骤如下：
[0048] 步骤一：在Android终端设定对无人机的控制信息，由蓝牙模块发送至通信转换 端；
[0049] 步骤二：由通信转换端内的蓝牙转无线模块将步骤一接收到的信息发送至无人机 的无线收发模块；
[0050] 步骤无人机微处理器主控忍片读取无线收发模块的信息控制无人机。
[0051 ] 无人机的监测信息传回Amlroid终端按照上述步骤逆向执行，An化Oid终端与无人 机的通信可W实时进行。
[0052] 通信转换端在线模式下的通信主要是利用wifi、gprs模块接入internet,运用云 服务器实现Amlroid终端和无人机的互相通信，上述S者在数据传输过程中W数据帖的形 式进行收发数据，所述数据帖的内容包括帖头、功能字、长度、数据、校验位等。帖头主要是 判别数据帖的发送端;功能字主要是发送端为获得指定数据而特意设定的标志位;长度即 数据帖中数据的长度;数据是实际接收端要处理的数据;校验位主要是为了防止在无线数 据收发过程中出现数据帖丢失而使接收端接收到错误数据，所述校验位通过特定算法，确 保了 Amlroid终端、无人机与云服务器之间数据传输的准确性，增强了抗干扰性。
[0053] 避障模块14,在多旋翼无人机飞行时受到天气条件的影响比较大时启用，当风力 高于3级时，由于风力的影响，无人机会发生飘移的情况，可能导致其与建筑物发生碰撞。所 W需要安装测距系统用来测量无人机距离障碍物的距离。超声波模块的特点必须符合探测 角度足够大、测量距离的范围适中的要求。由于无人机机体不大，能近距离飞抵线路附近， 选用的测试距离为6-10米。超声波发射、接收W及无人机主控忍片控制=个部分组成了超 声波测距模块。超声波测距模块由主控忍片进行控制并W级联的方式进行联接。在无人机 的左、右、前=个方位上分别安装了超声波测距模块，一旦=个超声波收发模块同时开启， 控制板就会将测得的=个方位的距离信息发送给控制系统，控制系统随即对=个方位距离 信号进行提取分析W判别无人机是否与障碍物过于接近。
[0054] 图像采集模块15,是为了记录所监控区域的大气污染信息而使用高清摄像头来采 集大气的图像，同时将图像信息通过地面通信转换系统2或者云服务器传输到Amlroid终端 3, W便检测人员实时了解现场大气的情况与周围环境，并将多旋翼无人机传来的图像使用 Amlroid终端的SD卡或者云服务器进行存储，方便测量人员的后期检查和处理。
[0055] 大气污染物测量模块16,通过使用相应的传感器，可W实现对大气污染物（W PM2.5、PM10为主的颗粒物，W二氧化硫为主的硫氧化合物，W二氧化氮为主的氮氧化合物 等等)和大气中的有害气体进行精准检测。关于传感器的安装可W选择多个不同功能的传 感器也可W只安装单个传感器，实现对大气中不同类型的污染物进行有选择性的监测。
[0056] 传感器使用配套的微处理器对数字电路模块检测到的信号进行分析，然后通过串 口与无人机主控忍片相连，输出测得的污染物浓度，通过地面通信转换系统2或者云服务器 传回Amlroid终端进行分析显示。所述传感器要尽可能小型化、便于维护，降低机体重量和 使用成本。
[0057] 本发明的多旋翼无人机的动力系统4如图2所示，使用电调40、=相无刷电机41、螺 旋奖42和航模电池43。无刷电机由于取消了电刷和换向器组成的机械接触结构，没有换向 火花和机械摩擦，具有效率高、无电磁干扰、寿命长、运行可靠等优势，使用与无刷电机配套 的电调和螺旋奖，可W保证动力系统的良好性能。多旋翼无人机的电池要求具有大电流放 电能力，同时还需体积小、重量轻，选择航模电池。
[005引 An化Oid终端3,是每一个人随身携带的移动产品，可W是装有An化Oid系统的手机 或者PC机，但并不仅限于此。由操作者在所述Amlroid终端进行无人机的指令发送，并根据 所接收信息实时调整无人机的飞行。其主要实现的功能如图3所示：
[0059] An化Oid终端通过无人机飞行坐标设定模块30设置无人机所要监测区域的经缔度 W及空间坐标，可W显示无人机的油口大小W及方向舱相对位置，对于无人机的飞行速度， 飞行时间，飞行高度也会有相应的坐标显示。
[0060] 航行轨迹31，可W在地图上实时显示无人机所监测区域的航行轨迹，可W结合监 测区域空气质量的分布情况，由无人机飞行坐标设定模块30相应改变监测位置坐标，实现 实时分析，灵活测量。
[0061] 自动归位模块32可W在无人机监测完毕使无人机自动平稳返回。
[0062] 监控区域图像模块33内可W查看无人机监测区域的大气图像及其周围环境。
[0063] 空气质量分析模块34,可W对蓝牙接收到的大气污染的数据信息进行处理分析， 对比国家空气质量的分析标准，显示所监测区域的空气质量。
[0064] 云服务器35,用于在线模式下实时储存无人机的航行轨迹、监控区域图像和污染 物测量情况等。用户可W登录查看。
[0065] 电池电量显示模块36,用来显示多旋翼无人机飞行过程中的电量余额。
[0066] 蓝牙模块37与通信转换模块2进行连接，用于在离线模式下向无人机发送控制指 令，同时将无人机监测到的图像信息、航行轨迹和大气污染物的数据信息返回Amlroid控制 终端并由SD卡进行存储。
[0067] 本发明实施例的多旋翼无人机环境自主监测控制方法，包括W下步骤：
[0068] S1、移动终端向无人机发送路径指令和控制指令，控制无人机移动至初始坐标，由 无人机姿态估计与姿态控制系统读取传感器的值，进行姿态解算，得到无人机的横滚、俯 仰、航向运些姿态角，进而通过串级PID算法、数字滤波算法等调整无人机的姿态，并控制无 人机保持平衡；
[0069] S2、无人机实时监测当前位置空气中的污染物数据，采集超声波传感器的值进行 高度PID控制，并根据路径指令自动移动至下个位置进行监测，移动过程中对障碍物进行检 测并避障；
[0070] S3、无人机将采集到的监测数据通过无线发送给移动终端，完成路径上所有点的 监测后，自动返回。
[0071] 步骤Sl中姿态解算的方法具体为：
[0072] 根据姿态传感器巧螺仪测量的无人机在x、y、z轴方向上的角速度，解算得到四元 数在短时间内的增量，通过积分得到无人机在某一时刻的四元数值，从而计算出此时刻无 人机机体的欧拉角。最终所得欧拉角是用来描述刚体在=维空间上坐标轴的旋转角度。定 义=个旋转角：
[0073] 横滚角Rol:绕y轴旋转的夹角，逆时针方向为正；
[0074] 俯仰角Pit:绕X轴旋转的夹角，逆时针方向为正；
[0075] 航向角Yaw:绕Z轴旋转的夹角，逆时针方向为正。
[0076] 机体坐标系b即可看做由地理坐标系g通过在S个坐标轴上旋转欧拉角而得到。定 义旋转角度丫为无人机上一点A绕机身外一定点0转动，向量OA为初始位置向量，经过时间t 转动角度运动到点B，A与B位于同一平面。
[0077] 由四元数Q的定义可知：
[007引 0(日0.日1.日2.日3) = ao+aii+日21.+日浊(1)
[0079]
狂）
[0080] 其中9〇、心92、93为实数，1〇、4是相互正交的单位向量。
[0081] 对四元数Q求导可得：
[0082]
(3)
[0083] 然后根据哥氏定理可知：
[0084] (4)
[0085]
[0086] 巧）
[0087]
[0088] (6)
[0089]
[0090] (7)
[0091]
[0092] 提）
[0093]
[0094] 饼
[00M]由于无人机运载体上姿态传感器巧螺仪测量的角速度即为机体坐标系运动的角 速度。且：
[0096] (10)
[0097]
[009引 （11)
[0099]由四元数的乘法公式可得：
[0100] (12)
[0101]故可W根据姿态传感器巧螺仪测量的无人机在x、y、z轴方向上的角速度，解算得 到四元数在短时间内的增量，通过积分得到无人机在某一时刻的四元数值，四元数值与无 人机飞行时改变的欧拉角的关系如下：
[0102；
(城
[0103] 其中：0、e、a分别代表无人机的=个旋转角，四元数值与无人机飞行时的欧拉角关 系推导在此不做介绍。
[0104] 根据式（12)和式（13)可计算出此时刻无人机机体的欧拉角。由此可知，当得到四 旋翼无人机的四元数的值，便可解算得到无人机的横滚、俯仰、航向运些姿态角，从而控制 无人机的运动。
[0105] 但是由于姿态解算过程中存在积分运算，当巧螺仪检测的角速度信号存在误差 时，随着积分的作用，误差会越来越大，可能导致得到的角度信号失真。运时就需要一种能 长期相信的传感器提供角度信号，运就是加速度计的作用。机体坐标系b中x、y、z轴方向上 所受到的实际加速度与重力加速度在机体坐标系b中=个轴上投影的加速度相比较，得到 二者姿态误差，然后将该误差积分经过与巧螺仪得到的数据进行互补滤波，纠正巧螺仪的 积分误差。从而得到稳定可信赖的姿态角数据。互补滤波过程中，互补滤波系数可W控制对 巧螺仪与加速度计各自的相信程度，如果完全按照运个姿态误差将巧螺仪的积分误差补 偿，则完全信任加速度计。由于加速度计上噪声的影响，互补滤波系数需根据实际情况而 定。
[0106] 步骤Sl中通过串级PID算法控制调整无人机的姿态的方法具体为：
[0107] 串级PID控制是对单回路PID控制质量的提升，是四旋翼无人机的姿态控制的核 屯、。当控制系统存在多个影响因素对输出量有影响时，单回路PID控制不能很好的达到系统 控制要求。串级PID将所有影响因素考虑到控制回路，能有效实现控制性能，提高系统的动 态响应速度和稳定性。
[0108] 图4为四旋翼无人机的串级PID控制结构图。外环输入为欧拉角角度设定值，并与 当前机体欧拉角测量值比较，差值经过外环PID控制器输出内环的目标角速度信号，并与当 前姿态传感器得到的角速度值比较，差值经过内环PID控制器计算，输出为给到电调的PWM 信号，电调输出电流通过旋翼电机控制无人机的机身角度进行飞行，然后姿态传感器检测 下一次机身的角度与角速度值，进行下一次串级PID控制。其中内、外环PID控制W较短的时 间间隔循环。
[0109] 步骤Sl中通过数字滤波算法调整无人机的姿态的方法具体为：
[0110] 采用数字滤波算法中的一阶低通滤波，计算量小，适用性强。一阶模拟低通滤波器 为硬件RC滤波，根据电路推导可得其微分方程，则一阶数字低通滤波用差分方程来表示其 微分方程，便可得到其公式为：
[0111] Yn=aXXn+(l-a) XYn-I (14)
[0112] 其中Yn为本次滤波的输出值;a为滤波系数，其值通常远小于l;Xn为本次采样输入 值;Yn-I为Yn前一次的滤波输出值。
[0113] 此算法的滤波系数a与截止频率f的关系为：
[0114]
(15)
[0115] 其中JT为圆周率，T为输入值的采样间隔时间。
[0116] 由上式可知，该算法滤波的输出值Yn更倾向于相信上次滤波的输出值Yn-I,而本次 滤波的采样值Xn对本次滤波输出值的影响相对较小，运就在一定程度上滤除了本次滤波中 高频信号的干扰。当输入变量低频变化时，运种滤波算法效率是相当高的，且滤波效果好。 但是，运种滤波算法不能有效滤除高于1/2采样频率的干扰信号，故运种干扰信号需要采取 其他合适的滤波算法。但对于本系统的应用，一阶低通滤波完全满足控制系统对滤波性能 的要求。
[0117] 步骤Sl中获取无人机坐标的方法具体为：使用卡尔曼滤波器将速度位置信息与 GPS信息融合，得到准确的无人机的导航信息。
[0118] 步骤S2中通过定高控制算法调整无人机的姿态的方法具体为：
[0119] 图5为四旋翼无人机的高度控制结构图。控制器输入为高度设定值，并与实际测量 高度值比较，差值经过高度PID控制器，输出为HVM控制信号，与姿态控制输出的HVM信号相 加控制旋翼电机，从而控制无人机机体的高度。然后经过20ms，超声波传感器测量下一次机 体实际高度，进行下一次高度控制。控制算法中，将预先设定高度分300次逐渐增加共6s传 入高度设定值，控制无人机上升的速度，保证其一键起飞的稳定性;超声波传感器每20ms检 测一次无人机高度，高度PID控制器在实际微分项中加入加速度积分得到的速度，设置一定 的系数比，W防止无人机在一键起飞时的速度偏高，由于积分误差的存在，在到达预设高度 后去掉速度融合项。
[0120] 步骤S2中无人机进行自动移动和监测的方法具体为：
[0121] 无人机按照预定的路线完成自主上升，到达指定地点悬停、自主测量、避障、下落 任务，W及将返回的测量数据和图像进行分析，并在移动终端显示所监测区域的图像、飞行 器的航行轨迹、航模电池电量余额W及空气质量，相应的监测信息也会同步发送至云服务 器中，在监测完毕可使飞行器自动归位。
[0122] 步骤S3中无人机将采集到的监测数据通过无线发送给移动终端的方法具体包括：
[0123] 在线状态，移动终端直接利用wifi、gprs，通过向云服务器发送指令实现对无人机 控制，并通过云服务器监控储存无人机地理位置、污染物测量数据、图像信息，由移动终端 通过wifi、gprs无线信号向云服务器发送数据请求读取并显示数据；
[0124] 离线状态，利用地面通信转换端作为无人机与移动终端的通信中转站，地面通信 转换端包括无线收发模块和蓝牙模块，移动终端对无人机的控制信息由蓝牙模块传输至通 信转换端内，再由无线收发模块转送至无人机主控忍片；同样，无人机的位置信息、污染物 测量数据和图像采集信息通过通信转换端传回移动终端，用于后续的分析。
[0125] 应当理解的是，对本领域普通技术人员来说，可W根据上述说明加 W改进或变换， 而所有运些改进和变换都应属于本发明所附权利要求的保护范围。
【主权项】
1. 一种多旋翼无人机环境自主监测控制系统，其特征在于，包括多旋翼无人机、地面通 信转换系统和移动终端，多旋翼无人机包括无人机控制系统和无人机动力系统，其中： 无人机控制系统包括主控模块、姿态控制模块、无线收发模块和污染物测量模块，用于 控制多旋翼无人机的运行状态，包括上升、悬停、避障和下落，在运行过程中对空气中的污 染物进行多维度自动监测，并将采集到的数据发送出去； 地面通信转换系统用于根据不同的通信方式，包括在线和离线模式，接收无人机采集 到的数据，发送给移动终端，并接收来自移动终端的控制指令，发送给无人机； 移动终端用于对无人机进行功能设定，并接收和显示无人机的监测数据。2. 根据权利要求1所述的多旋翼无人机环境自主监测控制系统，其特征在于，无人机控 制系统还包括与主控模块相连的图像采集模块、避障模块和导航模块。3. 根据权利要求1所述的多旋翼无人机环境自主监测控制系统，其特征在于，地面通信 转换模块包括蓝牙模块和无线收发模块。4. 根据权利要求1所述的多旋翼无人机环境自主监测控制系统，其特征在于，姿态控制 模块包括主控MCU、六轴数字传感器和三轴数字磁力计。5. -种权利要求1所述多旋翼无人机环境自主监测控制系统的控制方法，其特征在于， 包括以下步骤： 51、 移动终端向无人机发送路径指令和控制指令，控制无人机移动至初始坐标，由无人 机姿态估计与姿态控制系统读取传感器的值，进行姿态解算，得到无人机的横滚、俯仰、航 向这些姿态角，进而通过串级PID算法、数字滤波算法等调整无人机的姿态，消除干扰信号 并控制无人机保持平衡； 52、 无人机实时监测当前位置空气中的污染物数据，采集超声波传感器的值进行高度 PID控制，并根据路径指令自动移动至下个位置进行监测，移动过程中对障碍物进行检测并 避障； 53、 无人机将采集到的监测数据通过无线发送给移动终端，完成路径上所有点的监测 后，自动返回。6. 根据权利要求5所述的多旋翼无人机环境自主监测控制方法，其特征在于，步骤Sl中 姿态解算的方法具体为： 根据姿态传感器陀螺仪测量的无人机在x、y、z轴方向上的角速度，解算得到四元数在 短时间内的增量，通过积分得到无人机在某一时刻的四元数值，从而计算出此时刻无人机 机体的欧拉角。7. 根据权利要求5所述的多旋翼无人机环境自主监测控制方法，其特征在于，步骤Sl中 通过双PID控制调整无人机的姿态的方法具体为： 外环输入为欧拉角角度设定值，并与当前机体姿态解算得到的欧拉角测量值比较，差 值经过外环PID控制器输出内环的目标角速度信号，并与当前姿态传感器得到的角速度值 比较，差值经过内环PID控制器计算，输出为给到电调的PWM信号，电调输出电流通过旋翼电 机控制无人机的机身角度进行飞行，然后姿态传感器检测下一次机身的角度与角速度值， 进行下一次串级PID控制。其中内、外环PID控制以较短的时间间隔循环。8. 根据权利要求5所述的多旋翼无人机环境自主监测控制方法，其特征在于，步骤Sl中 获取无人机坐标的方法具体为:使用卡尔曼滤波器将速度位置信息与GPS信息融合，得到准 确的无人机的导航信息。9. 根据权利要求5所述的多旋翼无人机环境自主监测控制方法，其特征在于，步骤S2中 通过定高控制算法调整无人机的姿态的方法具体为： 控制器输入为高度设定值，并与实际测量高度值比较，差值经过高度PID控制器，输出 为PWM控制信号，与姿态控制输出的PWM信号相加控制旋翼电机，从而控制无人机机体的高 度;然后经过20ms，超声波传感器测量下一次机体实际高度，进行下一次高度控制;控制算 法中，将预先设定高度分300次逐渐增加共6s传入高度设定值，控制无人机上升的速度，保 证其一键起飞的稳定性;超声波传感器每20ms检测一次无人机高度，高度PID控制器在实际 微分项中加入加速度积分得到的速度，设置一定的系数比，以防止无人机在一键起飞时的 速度偏高，由于积分误差的存在，在到达预设高度后去掉速度融合项。10. 根据权利要求5所述的多旋翼无人机环境自主监测控制方法，其特征在于，步骤S3 中无人机将采集到的监测数据通过无线发送给移动终端的方法具体包括： 在线状态，移动终端直接利用wif i、gprs，通过向云服务器发送指令实现对无人机控 制，并通过云服务器监控储存无人机地理位置、污染物测量数据、图像信息，由移动终端通 过wifi、gprS无线信号向云服务器发送数据请求读取并显示数据； 离线状态，利用地面通信转换端作为无人机与移动终端的通信中转站，地面通信转换 端包括无线收发模块和蓝牙模块，移动终端对无人机的控制信息由蓝牙模块传输至通信转 换端内，再由无线收发模块转送至无人机主控芯片；同样，无人机的位置信息、污染物测量 数据和图像采集信息通过通信转换端传回移动终端，用于后续的分析。
【文档编号】G01N33/00GK105955302SQ201610444996
【公开日】2016年9月21日
【申请日】2016年6月20日
【发明人】张清勇, 牟意红, 孙帅, 柳石林
【申请人】武汉理工大学