CuiFrost's Blog
SUR-Nav:结构感知的室内自主探索方法研究Blur image

项目概述#

项目属性内容
项目名称结构感知的自主探索算法研究
项目时间2025.02 – 至今
项目类型ROS2 移动机器人算法科研
我的角色论文核心作者(第一作者)
技术栈ROS2 (Humble)、Linux (Ubuntu 22.04)、C++、Python、Nav2、Gazebo

研究背景与挑战#

问题背景#

在结构化室内环境(如核电巡检仓储物流)中,移动机器人需要自主探索未知区域以构建环境地图。传统前沿点(Frontier-based)探索方法存在以下问题:

  • 单一贪心选择:容易因短视决策导致重复访问与路径震荡
  • 计算开销过高:精准规划评估带来过高计算负担
  • 实时性不足:难以兼顾决策质量与实时性要求

核心挑战#

如何在决策质量与实时性之间取得平衡,成为本研究的核心难题。


我的解决方案:SUR-Nav 方法#

作为论文核心作者,我提出了 SUR-Nav(Structure-aware Utility-driven Robot Navigation)自主探索方法,构建融合结构感知信息增益导航风险的多目标效用模型。

核心创新点#

1. SUR 多目标效用模型#

通过三项关键指标的加权融合,显式量化探索价值:

效用项计算方法作用
结构感知项 (S)基于欧氏距离变换识别拓扑关键位置引导机器人优先探索走廊交叉口、房间入口等关键位置
信息增益项 (U)累积可见未知区域熵值最大化地图信息获取效率
导航风险项 (R)融合路径长度、拥挤度、转弯复杂度避免选择难以到达或高风险的探索目标

效用函数

Utility = w₁ × Structure + w₂ × InformationGain + w₃ × NavigationRisk
plaintext

2. Top-K 两阶段筛选策略#

为解决计算复杂度问题,设计了两阶段筛选策略:

阶段一:粗筛(Coarse Selection)

  • 使用低成本欧氏距离快速压缩候选集
  • 从 N 个候选点中筛选出 Top-K 候选

阶段二:精筛(Fine Selection)

  • 仅对少量 Top-K 候选点执行真实路径规划
  • 计算精确导航成本,选择最优探索目标

复杂度优化

flowchart TB
   A[传统方法] --> B[逐个候选点路径规划]
   B --> C[计算开销高]
   C --> D[SUR-Nav 两阶段筛选]
   D --> E[先粗筛再精筛]
   E --> F[路径规划次数显著下降]

其中 N 为候选点数量,P 为单次路径规划成本,K << N

3. 结构项退化与动态权重调整机制#

针对弱结构化环境(如开阔大厅),设计自适应机制:

  • 结构项退化:当环境结构特征不明显时,结构感知项平滑退化至基线水平
  • 动态权重调整:根据环境特征动态调整三项权重,确保算法在不同环境下的稳定性

技术实现#

系统架构#

基于 ROS 2 (Humble)Nav2 导航栈 构建完整系统:

flowchart TB
   subgraph L1[感知层]
      S1[激光雷达]
      S2[里程计]
      S3[地图构建]
   end

   subgraph L2[决策层]
      D1[SUR模型]
      D2[Top-K筛选]
      D3[目标选择]
   end

   subgraph L3[执行层]
      E1[Nav2导航]
      E2[路径跟踪]
      E3[运动控制]
   end

   L1 --> L2 --> L3

开发环境#

  • 操作系统:Ubuntu 22.04 LTS
  • ROS版本:ROS 2 Humble Hawksbill
  • 导航框架:Nav2
  • 仿真平台:Gazebo + RViz
  • 编程语言:C++(核心算法)、Python(数据处理)
  • 硬件平台:差速驱动机器人 + 360° 激光雷达

实验验证与成果#

实验设置#

在 Gazebo 仿真环境中,使用标准室内场景(办公室、走廊、仓库)进行测试,对比方法包括:

  • 最近距离策略(Nearest):选择距离最近的前沿点
  • 固定权重策略(Fixed-Weight):固定权重的多目标方法
  • SUR-Nav(本文方法):动态权重的结构感知方法

核心实验结果#

对比最近距离策略#

性能指标SUR-Nav最近距离策略提升幅度
探索完成时间1674.7s2003.4s-16.4% ⬇️
路径长度193.1m225.2m-14.3% ⬇️
决策延迟169.5ms204.4ms-17.1% ⬇️
地图完整性99.10%98.75%+0.35% ⬆️
覆盖效率0.614m²/s0.523m²/s+17.4% ⬆️

对比固定权重策略#

性能指标SUR-Nav固定权重策略提升幅度
探索完成时间1674.7s2280.5s-26.6% ⬇️
路径长度193.1m273.1m-29.3% ⬇️
决策延迟169.5ms362.4ms-53.2% ⬇️
试次间波动显著降低较大稳定性大幅提升

实验结论#

  1. 效率提升:相比传统方法,探索完成时间缩短 16.4% ~ 26.6%
  2. 路径优化:路径长度减少 14.3% ~ 29.3%,减少重复探索
  3. 实时性:决策延迟降低 17.1% ~ 53.2%,满足实时性要求
  4. 稳定性:试次间波动显著减小,算法鲁棒性更强

X 因素:洞察与技能迁移#

核心洞察#

  1. 拓扑关键位置引导的重要性

    • 识别结构化室内环境中”走廊交叉口、房间入口”等拓扑关键位置的引导作用
    • 在不引入额外语义模块的前提下,通过几何线索实现关键位置识别
    • 为轻量级自主探索算法设计提供新思路
  2. 决策质量与实时性的平衡艺术

    • Top-K 两阶段策略证明:通过合理的近似计算,可以在不显著损失决策质量的前提下大幅提升实时性
    • 为计算资源受限场景下的机器人决策提供参考方案

技能沉淀#

技能类别具体能力
ROS 2 开发熟练掌握 ROS 2 (Humble) 与 Nav2 导航栈的开发与调试
算法设计多目标优化算法设计、启发式搜索策略、复杂度分析
仿真验证Gazebo 仿真环境搭建、大规模实验设计、数据量化分析
论文写作学术论文结构组织、实验结果呈现、技术贡献提炼

科研能力#

形成完整的科研闭环能力:

flowchart TB
   A[问题定义] --> B[模型构建]
   B --> C[工程实现]
   C --> D[仿真验证]
   D --> E[结果分析]
   E --> F[论文撰写]

可迁移方向#

  • 自主移动机器人:室内服务机器人、巡检机器人
  • 工业巡检:核电巡检、仓储物流、工厂自动化
  • 智能导航:无人驾驶、AGV/AMR 导航

论文发表#

项目内容
论文题目结构感知驱动的室内自主探索方法
作者排名核心作者(第一作者)
投稿期刊《机器人技术与应用》(拟投)
当前状态撰写中,预计 2025 年 Q2 投稿

技术亮点总结#

flowchart TB
   H[SUR-Nav 核心技术亮点]
   A[结构感知引导
识别拓扑关键位置,避免盲目探索] B[两阶段筛选
Top-K 策略降低计算复杂度] C[自适应机制
动态权重调整,适配不同环境] D[显著性能提升
探索效率提升 16-26%
实时性提升 17-53%] H --> A H --> B H --> C H --> D

相关项目#

相关项目关系
定位系统横向项目同属 ROS2 机器人系统开发
智能桌面收纳管家同属智能装备领域

本文最后更新于 2025 年 2 月