基于北斗定位的无人机路面检测系统分析_闫宇航.pdf

116|电子制作 2023 年 2 月实验研究1 设计背景本次设计研究一种基于机器深度图像识别和北斗定位的路面检测报警系统，实现无人机对路面损坏信息以及防护林火灾情况的自主判定并定位损坏以及事故地点位置，上报至终端控制器，为路面检修工作提高效率。本系统的应用场景包括：（1）路面异物检测：在高速公路中，有异物落下或者撞死的动物遗体等物品，道路养护人员不能及时发现及清理1，可以派出本系统的无人机在道路上空进行检查，通过视觉识别，自主判别与汽车模型不相似的异物，并通过实时图传技术上报控制端，提前做出预警。（2）防护林火灾检测：在公路附近存在的防护林容易出现火灾的情况，并且不易发现，通过无人机用红外摄像头在空中进行检测，识别火焰模型，及时地做出预警，发送火灾的消息。（3）公路事故堵塞情况预报：在公路行驶中，可以通过无人机的巡航摄像头视觉检测识别道路上汽车的密度，以此来判断道路中行驶情况，若检测出道路拥堵，可发送拥堵信息传输给后面的往来车辆，避免更大的拥堵情况，使交通情况得到缓解。根据设计需要，由于飞行距离远，回传数据工作量大，实时数据传送可能造成数据堵塞，延迟等系列不利因素，因此无人机在工作时需要自主飞行。在地面工作人员根据地图信息设置好巡航路线的经纬度。即起点，途经点，终点。对指定路段进行巡视识别。此时BDS定位系统显得尤为重要。2 无人机选型 2.1 无人机选型民用无人机可分为固定翼机、单旋桨直升机、多旋翼飞行器等。近年来，四旋翼无人机在农业生产、精细化巡检、国防和社会安全等方面有着广泛使用并发挥了重要的作用。但是根据设计需求，采用旋翼式无人机进行测试时，我们发现其续航里程远远不能达到检测需求标准，尤其以常见的大疆四旋翼航拍无人机为例，通用空中滞留时间一般为20 30 分钟，往返距离也不足 30 公里，更何况无人机还需给摄像头和 BDS 定位模块供电，其续航里程还将会大大下降。通过测试设计比对之后采用固定翼后推式无人机，对于续航里程问题能够得到很大的缓解。一般的固定翼无人机，即使使用纯电动驱动，巡航时间也轻松突破 2 个小时。图 1 固定翼无人机设计图采用固定翼无人机进行实际飞行时，只需通过北斗导航系统沿着指定的路线自主飞行即可，无需飞行人员操控。因此对于遥控距离也没有特定的要求，测试距离可以达到数百公里，完全适用于偏远地区，其次对于高速公路而言，也不存在着 90 度急转弯等特殊路段，固定翼无人机完全可以胜任远距离公路巡检。在本次检测系统设计中就采用了固定翼无人机为主体，树莓派进行图像处理并结合 BDS 定位系统，快速实现异常路面的定位和信息上报。2.2 系统整体搭建无人机的核心飞控和传感器放置在整个机架的中心位置，摄像头放置在中心位置的下方。在实际飞行时，多种传感器实时接收无人机的飞行姿态和位置数据，并传输给控制模块，根据给孔算法，解算出各种控制数据驱动舵机，来调整飞行方向、路线、飞行高度，采用 BDS 定位模块设定巡检路线，使用高度计，标定无人机飞行的高度，空速计计算飞行的速度，三轴加速度传感器+磁场计控制飞行高度以及姿态稳定调整。飞机前部采用摄像头或者激光测距进行自主避障。基于北斗定位的无人机路面检测系统分析闫宇航，金冶纯，徐中林（沧州师范学院，河北沧州，061001）基金项目：河北省大学生科技能力培养项目，项目编号：22E50387D。摘要：本次设计研究的路面检测系统是基于无人机平台和图像处理技术，提出基于北斗定位（BDS）的道路巡检无人机系统的构建方法。通过地面控制无人机沿设定路线自主巡航并采集路面信息，在自主识别过程中完成相应功能，预期功能包括路面异物判断、路面堵塞情况上报、公路防护林失火检测。能够实现路面异物位置以及失火位置的定位、识别、检测，为后期高速公路路面养护提供检测数据和理论依据。关键词：固定翼无人机；BDS系统；路面检测DOI:10.16589/11-3571/tn.2023.03.009wwwele169com|117实验研究2.2.1 姿态解算完成无人机的姿态解算具体办法是将各个位置的方向或加速度传感器得到的数据通过 MCU 计算转换成姿态角，一般有欧拉角表示法、方向余弦矩阵法以及四元数表示法等运算方法。但是三者与机体角速度存在不一样的关系，欧拉角与机体角速度（陀螺仪）是奇异且非线性的关系；旋转矩阵与机体角速度（陀螺仪）是不奇异且维数高的关系；四元数与机体角速度（陀螺仪）是不奇异且维数适中的关系。通过分析计算，最终为了节约 MCU 资源，减少计算量以及避免万向节锁死等问题，设计中采用了四元数表示法进行无人机的姿态解算。四元数表示法不需要考虑坐标换算的中间过程，只需要考虑原始坐标系与无人机实时产生的实际坐标系的关系，即可进行全姿态解算。定义四元数等式：0123Waaia ja k=+具有如下关系：0123cos2sin2cos2cos2aaxayaz=四元数为：22RWcosu sin=+四元数中无人机的定点转动用 W 表示，即认为原始坐标系通过一次转换即可得到机体坐标系。在四组关系中x,y,z 表示方向向量，是原始坐标与实际坐标的变化矩阵。因此，姿态矩阵可由四元数表示为：()()()()()()222201231203130222221203012301232222130223010123 2 22 22 2 NBaaaaa aa aa aa aCa aa aaaaaa aa aa aa aa aa aaaaa+=+再由四元数进行反解得：()()()()1203222201231302230122220123222a aa aarctanaaaaarcsina aa aa aa aarctanaaaa=+=+=+通过上述计算，可得出三姿态的欧拉角，进而完成姿态解算的任务。通过数据分析过程，无人机的自主控制系统可以实现三个姿态角（俯仰角、滚转角、偏航角）的稳定控制，保证闭环姿态系统能够在实际应用中具有期望的动态特性，进而使无人机沿受控的航迹方向飞行。但是，实际飞行环境中会受到来自外界的不确定性因素干扰，如：参数误差、测量噪声等未进行建模因素的动态影响。所以，必须要考虑系统的抗干扰性能。因此在此次设计中，将每一个通道中都引入适当的观测器和控制器对不确定性因素的影响进行估计和补偿，以此来保证四旋翼无人机在干扰条件下依然能够对其设定的理想姿态的有效追踪。其流程如图 2 所示。初始化推进力旋翼转量+-图 2 实际运转流程图2.2.2 控制系统飞行控制系统（Flight control system），无人机的CPU 系统，是无人机的核心部件。其功能是发送各种指令，处理外设传回的数据2，如偏航、悬停，各种姿态变化都是由传感器将无人机的数据传回飞控，再由飞控通过运算和判断下达指令，完成动作和姿态调整。本次的设计中，主控采用 PixHawk 飞行控制器作为主控单元3，IMU（惯性测量单元）作为信息的提供者。搭配树莓派 4B 与摄像头完成图像采集与信息处理。并通过MJPG-streamer 来进行数字图传，以此来辅助客户端。控制系统在整机中的通信如图 3 所示。电源模块检测模块驱动模块控制模块图 3 飞行控制系统3 传输功能 3.1 BDS 定位应用我国自行研制的全球卫星导航系统BDS 导航定位118|电子制作 2023 年 2 月实验研究系统，可提供导航、高精度定位等服务.在数据通信方面，其还具备短报文通信功能，精度可达厘米级别，测速精度0.2m/s。其中 BDS 系统可以通过数据链来完成对移动基准站实时发送的 RTK 差分来修正数据4。通过北斗 RTK 信息和卡尔曼滤波融合 SINS，实时解算在基准站的固定坐标系中无人机的坐标及航向、姿态、速度等参数5，通过这些参数很快计算出无人机和基准站之间的距离，引导无人机完成精确路面裂缝检测作业。利用北斗卫星导航系统的上述导航定位优势，可为路面裂缝精确分类提供高精度的经纬坐标，为后续的路面的精确养护提供精确的经纬度信息，具有重要的社会经济现实意义。在无人机上安装北斗定位部分，选择采用 SKG1223 定位模块获取定位信息，SKG1223 是一款高性能的导航定位模块，支持北斗二号、三号的 B1L/B1C/B2A 三频卫星接收，能够更好地消除高阶电离层延迟的影响，固定在无人机上，在露天的环境中定位更快、精度更高。另外，该模块拥有-162dBm 的跟踪灵敏度，使得模块在信号较弱的山区环境下依然能够提供精准位置服务。BDS定位模块与主控树莓派的通信接口采用 UART 串口方式，并采用 NMEA-0183 协议输出的定位信息6。该协议采用 ASCII 码传输模块定位信号，并通过串口通信将信息传输回主控芯片，最后借助数据传输模块将经过代码解析后的定位信息传送到终端监测中心。系统定位经过验证之后，能够获取精确定位数据，之后可以通过 GIS 软件来绘制我们定位信息的图像，增强数据的可视性。3.2 GPRS/GSM 通信GPRS/GSM 通信方式，广泛应用在物联网/车载/电力环境检测等领域范围，本系统采用 A6 GPRS 模块，其是一款 GPRS 数据传输核心模块，提供串口转 GPRS/短信息/语音通话等信息传输功能，在远程通信的设备端断开网络连接，客户端无法接收数据时，系统将采用 GPRS/GSM 通信的方式进行每次评估检测定位数据以短信形式传输，做到实时传送。图 4 模块图片 图 5 A6 GSM 模块本系统中主控树莓派与 A6 GSM 模块配合实现数据发送。选用 gammu 作为短信发送工具，而 A6 GSM 模块需要进行相关的设置才可正常使用。在树莓派上要彻底禁用串口的 console 登录功能，之后可以执行 GSM 模块的激活步骤，sudo gammu-config，端口写 ttyAMA0，波特率选择 at115200，其余默认。最后保存，此时返回 GSM 模块的相关信息，等待配置完成，就能实现短信的发送。sudo gammu sendsms TEXT“对方手机号码”-text“英文内容”，在手机号码后加一个参数“-unicode”可以实现中文支持。图 6 安装图片通过以上的步骤配置并测试好树莓派 GSM 短信通信功能，随后将树莓派和 GSM 模块安装在无人机主控上方，在实际飞行工作中，需要实时短信发送 GPRS 所采集到的位置信息，保证在信息接收的即时性。3.3 MJPG 实时图传本次设计中，对于远距离传输采用较为新颖的 MJPG-streamer 来 进 行 数 字 图 传。MJPG-streamer 可 以 通 过HTTP 和其他的方式访问 linux 上面的兼容摄像头，并且MJPG-streamer 图像传输流畅度比较高，从而做到远程视频传输的效果。在地面控制端，将遥控、MJPG 实时图传和 BDS 位置通知集成为 APP 形式，便于控制，为地面控制人员及时掌控路面裂缝信息提供可视化的解决方案。系统所需的 APP采用 Qt 软件进行编写，Qt 编写之后的应用，可以多次编译到不同终端平台，如 Windows、MAC、Android、iOS 等。搭建好 Qt 软件所需的环境后，进行构建 APP 测试并进行下一步的 APP 实际创建。首先搭建环境以及硬件设备连接，安装好 MJPG-Streamer，并进行相关代码的分析：Mjpg_streamer.c /*主程序主要运行如下几个部分*/input_init();/*输入相关的初始化*/output_init();/*输出相关的初始化*/input_run();/*运行输入函数，采集输入数据*/output_run();/*输出初函数，把数据收集起来通过网wwwele169com|119实验研究络 socket 发送出去*/完成 PC 端树莓派环境的搭建，Enable（启用）树莓派摄像头，供电开机。启用摄像头支持，然后选择 Interface Options，选择Camera 然后按回车，再次回车，重启树莓派就完成了设置。在接收端可以创建一个.html 文件就可以直接打开网址http:/:/javascript.htm