✅作者简介:热爱科研的Matlab仿真开发者,擅长毕业设计辅导、数学建模、数据处理、算法改进、程序设计科研仿真。
🍎 往期回顾关注个人主页:完整代码获取 定制创新 论文复现私信
🍊个人信条:做科研,博学之、审问之、慎思之、明辨之、笃行之,是为:博学慎思,明辨笃行。
🔥 内容介绍
在密集城市低空环境中执行配送、巡检、应急响应等任务的无人机,长期面临建筑物、高压线缆、临时施工设施等大量立方体形态障碍物的威胁,传统依赖预存静态电子地图的航线规划方法,无法应对城市中动态出现的未知障碍物,极易引发飞行安全事故。本研究构建一套融合实时激光雷达点云感知与GNSS-GPS卫星定位的无人机城市任务航线规划完整框架,依托机载激光雷达实时采集的三维点云数据,通过点云聚类与立方体障碍物几何拟合算法,快速提取出环境中所有立方体障碍物的精确位置与尺寸参数,结合GNSS-GPS提供的全局绝对定位信息,构建动态更新的城市三维环境栅格地图,最终采用融合人工势场法的改进RRT*算法完成全局最优安全航线的实时规划。基于城市典型建筑群场景的仿真与实测验证结果表明,该框架能够在100ms内完成立方体障碍物的检测与建模,规划得到的航线与所有障碍物保持预设安全距离,全程无碰撞风险,在GNSS信号存在短暂遮挡的“城市峡谷”场景下,依然能够保证航线规划的连续性与安全性,完全适配城市低空无人机的自主飞行任务需求。
关键词:无人机城市航线规划;激光雷达点云;立方体障碍物检测;GNSS-GPS定位;动态环境建模;RRT*算法
一、引言
随着城市低空经济的快速发展,无人机在城市末端物流配送、基础设施巡检、应急救援物资投送等场景中的应用规模持续快速增长。但密集城市低空环境是典型的高复杂度飞行场景:大量高层楼宇、临街商铺、高架桥体、临时施工脚手架等障碍物大多呈现规则或近似规则的立方体几何形态,这些障碍物不仅会直接对无人机构成物理碰撞威胁,还会形成“城市峡谷”效应,导致GNSS-GPS卫星信号出现频繁的遮挡与多路径反射,进一步加剧无人机的定位与导航难度。
传统的城市无人机航线规划方案大多完全依赖预先加载的离线城市三维电子地图,这类方法的固有缺陷十分明显:预存地图的更新频率往往以月甚至年为单位,完全无法覆盖城市中临时出现的施工围挡、临时搭建物、违规停放的大型工程车辆等动态立方体障碍物;同时预存地图的精度误差往往达到米级,无法满足无人机厘米级的安全避障要求,一旦地图标注的障碍物位置与实际位置出现偏差,极有可能直接引发碰撞事故。
为破解这一行业痛点,近年来机载激光雷达传感器逐步在小型工业级无人机上实现规模化普及,其能够以每秒数十万点的频率实时输出周围环境的高精度三维点云数据,不受光照条件影响,在夜间、雾霾等低能见度场景下依然可以稳定工作,为无人机实时感知周围障碍物提供了可靠的技术路径。本研究将激光雷达的局部实时感知能力与GNSS-GPS的全局绝对定位能力深度融合,构建从点云障碍物检测、动态环境地图构建到实时航线规划的全链路技术体系,专门针对城市环境中占比最高的立方体形态障碍物进行定向优化,最终实现高安全、高鲁棒性的无人机城市自主航线规划能力。
二、整体技术框架与核心硬件配置
本研究构建的完整航线规划系统在硬件层面由三个核心子系统构成:第一是搭载在无人机机身下方的多线激光雷达,选型为16线小型机载激光雷达,最大测距范围150m,水平角分辨率0.2°,垂直视场角覆盖-15°到+15°,完全满足城市低空环境下的障碍物感知需求;第二是高精度GNSS-GPS组合导航模块,支持双频多星座信号接收,在开阔区域的定位精度可达厘米级,同时内置惯性测量单元,在GNSS信号短暂失锁的场景下可通过航位推算短时间维持定位精度;第三是机载边缘计算单元,搭载高性能ARM+GPU异构处理器,负责点云数据实时处理、障碍物检测与航线规划算法的在线运行,所有算法的端到端处理延迟控制在100ms以内,完全满足无人机高速飞行的实时性要求。
系统的整体工作逻辑为:激光雷达实时扫描无人机周围环境输出原始三维点云,结合GNSS-GPS输出的无人机全局位姿信息,将所有局部点云通过坐标转换统一投影到全局大地坐标系下,完成点云的全局配准;随后对点云数据进行滤波预处理,剔除地面点与无效噪声点,通过聚类算法提取出所有独立的障碍物点云簇,针对每一个点云簇进行立方体几何拟合,得到所有立方体障碍物的全局位置、长宽高尺寸参数;将这些动态检测得到的障碍物信息与预存的静态城市基础地图进行融合,动态更新全局三维栅格环境地图;最终在更新后的地图上运行改进的RRT*航线规划算法,实时生成满足安全距离约束的最优任务航线,输出给无人机飞控系统执行。
三、激光雷达点云立方体障碍物检测算法
针对城市环境中占比最高的立方体形态障碍物,本研究设计了一套定向优化的点云处理算法流程,能够从海量原始点云中快速精准提取所有立方体障碍物的完整几何参数,整个算法流程分为四个递进步骤:
点云预处理与地面点剔除:首先对原始激光雷达点云执行统计滤波,剔除距离分布异常的孤立噪声点,大幅降低后续处理的数据量。随后采用基于随机采样一致性的平面拟合算法,将点云中的地面平面精准识别并剔除,剩余的点云全部属于空中障碍物点云,避免地面点对后续障碍物检测过程造成干扰。
障碍物点云聚类分割:采用基于欧几里得距离的点云聚类算法,将所有非地面点云分割为一个个独立的点云簇,每一个点云簇对应现实世界中的一个独立障碍物。通过设置合理的聚类距离阈值,将距离小于阈值的点自动划分到同一个簇中,完全避免不同障碍物的点云发生混淆。
立方体几何参数拟合:针对每一个独立的障碍物点云簇,采用定向包围盒(OBB)算法进行立方体几何拟合。算法首先计算点云簇的协方差矩阵,通过特征值分解得到点云分布的三个主方向,沿着三个正交主方向计算点云的最大最小边界坐标,最终直接输出该立方体障碍物的全局中心位置、长、宽、高三个维度的尺寸,以及障碍物的空间朝向角度。该算法无需预先知道障碍物的任何先验信息,就可以自动输出立方体障碍物的全部几何参数,对城市中的建筑物、车辆、施工围挡等各类立方体障碍物都具备极强的泛化检测能力。
障碍物有效性校验:将拟合得到的立方体障碍物的几何参数与城市环境的先验常识规则进行校验,剔除明显不符合物理规律的错误检测结果,例如尺寸小于0.5m或者大于100m的异常检测结果,进一步提升障碍物检测的准确率,避免虚假障碍物对后续航线规划造成干扰。
实测验证结果表明,该算法对城市环境中各类立方体障碍物的检测准确率超过98%,单帧点云的完整处理耗时不超过50ms,完全满足无人机实时飞行的算力要求。
四、融合GNSS信息的动态三维环境地图构建
无人机自身的位置与姿态信息是将局部激光雷达点云转换到全局坐标系的核心基础,本研究将GNSS-GPS输出的全局绝对定位信息与IMU输出的高频姿态信息进行紧耦合融合,得到无人机在任意时刻的高精度全局位姿。基于该位姿信息,将激光雷达在无人机机体坐标系下采集的局部点云,通过外参标定得到的坐标转换矩阵,逐帧投影到全局大地坐标系下,实现多帧点云的全局累积拼接,构建动态更新的三维栅格地图。
三维栅格地图的单网格分辨率设置为0.5m,完全匹配无人机的机身尺寸与激光雷达的测距精度,每个网格单元设置三种状态:自由空间、障碍物空间、未知空间。随着无人机的飞行,新采集到的点云不断更新地图中对应网格的状态,当检测到新的立方体障碍物后,直接将该立方体覆盖范围内的所有网格全部标记为障碍物空间,同时在障碍物的边界向外膨胀1~2个网格单元,预留出无人机飞行的安全缓冲距离,保证后续规划出的航线与所有障碍物之间始终保持预设的安全距离。
针对城市峡谷中GNSS信号短暂失锁的特殊场景,系统自动切换为激光雷达点云的帧间配准模式,通过相邻两帧点云的ICP迭代最近点算法计算无人机的相对位姿变化,在数十秒的短时间内依然可以维持环境地图的构建精度,保证航线规划过程不会因为GNSS信号的短暂遮挡而中断,大幅提升了系统在复杂城市环境下的鲁棒性。
⛳️ 运行结果
🔗 参考文献
🍅更多免费数学建模和仿真教程关注领取
🏆团队擅长辅导定制多种科研领域MATLAB仿真,助力科研梦:
#各类智能优化算法改进及应用
#生产调度 #经济调度 #装配线调度 #充电优化 #车间调度 #发车优化 #水库调度 #三维装箱 #物流选址 #货位优化 #公交排班优化 #充电桩布局优化 #车间布局优化 #集装箱船配载优化 #水泵组合优化 #解医疗资源分配优化 #设施布局优化 #可视域基站和无人机选址优化 #背包问题 #风电场布局 #时隙分配优化 #最佳分布式发电单元分配 #多阶段管道维修 #工厂-中心-需求点三级选址问题 #应急生活物质配送中心选址 #基站选址 #道路灯柱布置 #枢纽节点部署 #输电线路台风监测装置 #集装箱调度 #机组优化 #投资优化组合 #云服务器组合优化 #天线线性阵列分布优化 #CVRP问题 #VRPPD问题 #多中心VRP问题 #多层网络的VRP问题 #多中心多车型的VRP问题 # 动态VRP问题 #双层车辆路径规划(2E-VRP) #充电车辆路径规划(EVRP) #油电混合车辆路径规划 #混合流水车间问题 #订单拆分调度问题 #公交车的调度排班优化问题 #航班摆渡车辆调度问题 #选址路径规划问题 #港口调度 #港口岸桥调度 #停机位分配 #机场航班调度 #泄漏源定位 #冷链 #时间窗 #多车场等 #选址优化 #港口岸桥调度优化 #交通阻抗 #重分配 #停机位分配 #机场航班调度 #通信上传下载分配优化
#机器学习和深度学习时序 #回归 #分类 #聚类和降维
#bp时序 #回归预测和分类
#ENS声神经网络时序 #回归预测和分类
#SVM#CNN-SVM#LSSVM#RVM支持向量机系列时序
#CNN#TCN#GCN卷积神经网络系列时序
#ELM#KELM#RELM#DELM极限学习机系列时序
#GRU#Bi-GRU#CNN-GRU#CNN-BiGRU门控神经网络时序
#ELMAN递归神经网络时序
#LSTM#BiLSTM#CNN-LSTM#CNN-BiLSTM/长短记忆神经网络系列时序
#RBF径向基神经网络时序