Skip to content

(water): 水下多波束声呐 SLAM 占据栅格建图与自主避障导航 - #151

Open
Syysean wants to merge 8 commits into
OpenHUTB:masterfrom
Syysean:rov_sonar_slam_navigation
Open

Syysean wants to merge 8 commits into
OpenHUTB:masterfrom
Syysean:rov_sonar_slam_navigation

Conversation

@Syysean

@Syysean Syysean commented Oct 3, 2026

Copy link
Copy Markdown
Contributor

修改概述:
实现水下机器人 (ROV) 多波束声呐 SLAM 占据栅格建图与基于 Neural A* 的自主避障导航系统,并修复了上一个 PR 文档中的两处细节

close #148

修改的详细描述

  1. 修复上一 PR 文档细节:修复了 docs/water/rov_trajectory_tracking.md 第 76 行数学公式中的反斜杠转义问题,并在运行指南前补充了前置环境安装与依赖配置的提示框
  2. 新增声呐 SLAM 占据栅格建图功能:实现 sonar_slam_node.py,基于 72 束前视声呐与里程计,运用贝叶斯对数几率更新生成 20m×20m 的占据栅格地图,广播 /map 话题与 TF2 坐标变换树,支持保存为 PGM 图像与 YAML 元数据文件
  3. 新增神经网络规划与自主导航系统:实现 neural_path_planner.py 与 autonomous_navigation_node.py,包含基于神经引导场的 Neural A* 全局路径规划与 76 维局部动态避障策略,并提供与经典 A* 和 DWA 算法的对比评测
  4. 完善任务三配套工程与文档:新增 task3.launch.py、测试脚本 test_task3.py、参考地图资产以及开发文档 docs/water/rov_sonar_slam_navigation.md,并在 setup.py、package.xml 和 mkdocs.yml 中完成注册

经过了什么样的测试?

  1. 操作系统:Windows 11 (WSL2 Ubuntu 22.04 LTS)
  2. Python 版本:3.10
  3. 基础校验:
    • 语法编译:python -m py_compile 脚本校验通过
    • 节点构建:colcon build --packages-select rov_mujoco 顺利构建
    • 任务测试:运行 python3 src/water/rov_mujoco/main.py --test3,三大子项测试顺利通过
    • 回归测试:--test1 与 --test2 功能正常,无破坏性影响
    • 文档校验:python -m mkdocs build 构建成功,公式与导航链接均正常渲染

运行效果(动图、视频、图片、链接等)

修改所对应的前后效果(代码/网页):
image

文档中已配置任务三对应的演示动图与封面图(docs/img/water/rov_sonar_slam_navigation.gif 与 .png)

所使用具体的大模型声明:deepseek

- 使用 subprocess.run 替代 os.system,避免 POSIX 环境下状态码截断导致外部退出码为 0
- 执行测试与 launch 前提前检查文件是否存在,缺失时提示并以非0状态码退出
- 补充 --test/--test1 命令行选项,直接运行任务一单元测试
- 修复 OpenHUTB#140
Comment thread docs/water/rov_sonar_slam_navigation.md
Comment thread docs/water/rov_sonar_slam_navigation.md
Comment thread docs/water/rov_sonar_slam_navigation.md
Comment thread docs/water/rov_sonar_slam_navigation.md
Comment thread docs/water/rov_sonar_slam_navigation.md
Comment thread docs/water/rov_sonar_slam_navigation.md
Comment thread docs/img/water/rov_sonar_slam_navigation.gif
@Syysean
Syysean requested a review from donghaiwang October 9, 2026 05:04

This branch has not been deployed

No deployments
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

水下机器人多波束声呐 SLAM 建图与自主避障导航规划

2 participants