Skip to content

feat(air): evaluate rooftop layouts and baselines / 评价屋顶布局与基线 - #4

Open
cwq319 wants to merge 592 commits into
feat/day2-controllerfrom
feat/day2-evaluation
Open

cwq319 wants to merge 592 commits into
feat/day2-controllerfrom
feat/day2-evaluation

Conversation

@cwq319

@cwq319 cwq319 commented Oct 17, 2026 •

Copy link
Copy Markdown
Owner

本 PR 保留最终评价分支相对控制分支的阶段对比。个人仓库 master 已通过 #5 合入最终实现和中文文档;上游贡献由 OpenHUTB/ros2 的 OpenHUTB#355、OpenHUTB#356、OpenHUTB#383、OpenHUTB#384、OpenHUTB#385 跟进。Ubuntu/Humble Docker 测试、训练权重部署、平面 SLAM、键盘事件与 ROS launch 已完成验证。

Lyzzzz0921 and others added 30 commits November 8, 2026 11:26
* Add standalone Noetic PocketSphinx voice control homework

* Preserve upstream formatting and minimize homework navigation changes

* Fix catkin builds, constrained voice model and command timeout for review
…TB#431)

* Add files via upload

* Add documentation for CARLA parking lot scene generation

Document the process of generating a parking lot scene in CARLA with Python API, including environment requirements and installation steps.

* Add parking lot scene generation documentation

* Update maintainer info and description in setup.py

* Refactor parking lot launch file to include port argument

* Create __init__.py

* Create CARLA parking lot scene generation node

This node connects to CARLA and generates a parking lot scene with specified slots.

* Create carla_parking_lot

* Delete src/ground/ros-bridge/carla_parking_lot/main.py

* Create __init__.py

* Delete src/ground/ros-bridge/carla_parking_lot/carla_parking_lot/carla_parking_lot/carla_parking_lot/__init__.py

* Enhance README with ROS 2 setup and usage details

Updated README to include ROS 2 installation and usage instructions.

* Refactor parking lot node logging and formatting

Updated logging messages and adjusted spacing in the parking lot node.

* feat: add musculoskeletal knee tracking ROS2 package

单关节膝关节肌肉骨骼仿真与 PD 轨迹跟踪控制(MuJoCo + ROS2 Humble),包含模型、控制节点、launch、测试与文档。

* musculoskeletal_knee_tracking.md

docs: add musculoskeletal knee tracking tutorial

* docs: rename tutorial file to musculoskeletal_knee_tracking.md

* docs: register musculoskeletal knee tracking in nav

* docs: move knee tutorial to correct path

* Delete docs/musculoskeletal/docs/musculoskeletal/docs/musculoskeletal/musculoskeletal_knee_tracking.mding.md

* docs: add musculoskeletal knee tracking tutorial

* docs: fix nav link for knee tutorial

* Delete src/mujoco_musculoskeletal_knee_tracking/README.md

* Delete src/mujoco_musculoskeletal_knee_tracking/SUBMISSION_GUIDE.md

* Delete src/mujoco_musculoskeletal_knee_tracking/config/params.yaml

* Delete src/mujoco_musculoskeletal_knee_tracking/docs_musculoskeletal_knee_tracking.md

* Delete src/mujoco_musculoskeletal_knee_tracking/launch/main.launch.py

* Delete src/mujoco_musculoskeletal_knee_tracking/mujoco_musculoskeletal_knee_tracking/__init__.py

* Delete src/mujoco_musculoskeletal_knee_tracking/mujoco_musculoskeletal_knee_tracking/controller.py

* Delete src/mujoco_musculoskeletal_knee_tracking/mujoco_musculoskeletal_knee_tracking/main.py

* Delete src/mujoco_musculoskeletal_knee_tracking/mujoco_musculoskeletal_knee_tracking/model/muscle_knee.xml

* Delete src/mujoco_musculoskeletal_knee_tracking/package.xml

* Delete src/mujoco_musculoskeletal_knee_tracking/setup.cfg

* Delete src/mujoco_musculoskeletal_knee_tracking/setup.py

* Delete src/mujoco_musculoskeletal_knee_tracking/simulate_tracking.py

* Delete src/mujoco_musculoskeletal_knee_tracking/resource/mujoco_musculoskeletal_knee_tracking

* Delete src/mujoco_musculoskeletal_knee_tracking/test/test_tracking.py

* Delete src/mujoco_musculoskeletal_knee_tracking/tracking_metrics.txt

* Delete src/mujoco_musculoskeletal_knee_tracking/validate_model.py

* Delete docs/musculoskeletal/docs_musculoskeletal_knee_tracking.md

* `docs: remove knee nav entry` → Commit directly to master → Commit

Removed knee tracking control documentation from musculoskeletal section.

* Delete docs/ground/carla_parking_lot.md

* Delete src/ground/ros-bridge/carla_parking_lot/README.md

* Delete src/ground/ros-bridge/carla_parking_lot/carla_parking_lot/__init__.py

* Delete src/ground/ros-bridge/carla_parking_lot/carla_parking_lot/parking_lot_node.py

* Delete src/ground/ros-bridge/carla_parking_lot/launch/parking_lot.launch.py

* Delete src/ground/ros-bridge/carla_parking_lot/main.sh

* Delete src/ground/ros-bridge/carla_parking_lot/package.xml

* Delete src/ground/ros-bridge/carla_parking_lot/parking_lot.png

* Delete src/ground/ros-bridge/carla_parking_lot/requirements.txt

* Delete src/ground/ros-bridge/carla_parking_lot/resource/carla_parking_lot

* Delete src/ground/ros-bridge/carla_parking_lot/setup.cfg

* Delete src/ground/ros-bridge/carla_parking_lot/setup.py

* docs: add knee tutorial nav

* feat: add musculoskeletal knee tracking ROS2 package

* docs: add musculoskeletal knee tracking tutorial

* docs: 教程页改名为 knee_tracking.md,统一环境并补运行效果图

* fix: 按评审意见补齐依赖、统一环境、增加无渲染降级

* fix: 让 sim.dt 真正生效,外部参考不再受 duration 限制

* fix: 让 sim.dt 真正生效,外部参考不再受 duration 限制

* Delete src/mujoco_musculoskeletal_knee_tracking/SUBMISSION_GUIDE.md

* Delete src/mujoco_musculoskeletal_knee_tracking/docs_musculoskeletal_knee_tracking.md

* refactor: 模块移动到 src/musculoskeletal/

* Delete src/mujoco_musculoskeletal_knee_tracking/package.xml

* Delete src/mujoco_musculoskeletal_knee_tracking/setup.py

* Delete src/mujoco_musculoskeletal_knee_tracking/setup.cfg

* Delete src/mujoco_musculoskeletal_knee_tracking/README.md

* Delete src/mujoco_musculoskeletal_knee_tracking/requirements.txt

* Delete src/mujoco_musculoskeletal_knee_tracking/simulate_tracking.py

* Delete src/mujoco_musculoskeletal_knee_tracking/validate_model.py

* Delete src/mujoco_musculoskeletal_knee_tracking/tracking_metrics.txt

* Delete src/mujoco_musculoskeletal_knee_tracking/resource/mujoco_musculoskeletal_knee_tracking

* Delete src/mujoco_musculoskeletal_knee_tracking/launch/main.launch.py

* Delete src/mujoco_musculoskeletal_knee_tracking/config/params.yaml

* Delete src/mujoco_musculoskeletal_knee_tracking/mujoco_musculoskeletal_knee_tracking/__init__.py

* Delete src/mujoco_musculoskeletal_knee_tracking/mujoco_musculoskeletal_knee_tracking/main.py

* Delete src/mujoco_musculoskeletal_knee_tracking/mujoco_musculoskeletal_knee_tracking/controller.py

* Delete src/mujoco_musculoskeletal_knee_tracking/mujoco_musculoskeletal_knee_tracking/model/muscle_knee.xml

* docs: 新增膝关节模块运行效果图

* docs: 首页肌肉骨骼人分类新增膝关节模块入口

* chore: 删除旧目录残留的测试文件

* docs: README 代码块去掉 bash 语言标记

* fix: 修正 max_torque 与模型一致,指标口径改为正弦+阶跃两段

* fix: max_torque 改为 17.5,补 limit_low_deg 与 exit_after_duration

* fix: 双向限位、参数单一来源、节点可自动退出

* test: 补充模型集成与限位测试(13 项)

* test: 补充模型集成与限位测试(13 项)

* docs: 更新指标口径与阶跃响应图

* docs: 更新指标口径与阶跃响应图

* Delete src/musculoskeletal/mujoco_musculoskeletal_knee_tracking/tracking_metrics.txt

* Fix formatting for mermaid custom fence

* fix: 默认仿真时长改为常量,README 补全参数表

* test: 力矩一致性改为真正读取模型 gainprm

* docs: 统一相位滞后与重力矩偏差的表述
* feat(musculoskeletal): 新增肌肉驱动下肢关节与步态模块

Create a new branch for this commit and start a pull request

* Add files via upload

* Add files via upload

* Update muscle_leg_gait.md

* Update mkdocs.yml

* docs: 在首页肌肉骨骼人小节新增入口

* fix: 补齐依赖声明与维护者信息,统一运行环境描述

* fix: gif 子命令增加无图形环境降级;QP 去掉单肌肉死分支

* docs: 教程页统一环境描述并补充无图形渲染说明

* fix: 修正 package.xml 描述中的多余标点

* fix: max_act 改为全程峰值,去掉双腿前馈的均摊除法

* fix: 注释与依赖清理,README 同步 L6 新数值

* docs: 修正稳态误差单位,同步 L6 峰值激活与抬脚幅度

* fix: 激活指标改为末态(final_act),去掉前馈均摊除法

* fix: 激活指标改为末态(final_act),去掉前馈均摊除法

* test: 断言字段同步为 final_act

* fix: 清理 package.xml 空行,README 改末态激活

* fix: 清理 package.xml 空行,README 改末态激活

* docs: 峰值激活改为末态激活
* docs(ground): 新增 rostopic 手动驱动文档

- docs/ground/rostopic_cruise.md: CARLA + ROS 桥接后,用 rostopic 发布控制命令驱动车辆(含运行效果图与动图)
- docs/img/ground/: 桥接成功截图、行驶动图、演示视频
- mkdocs.yml / docs/index.md: 地面载具导航与首页新增链接

本文档由大模型辅助编写

* docs(ground): 完善 rostopic 手动驱动文档,新增停止命令与效果动图

- 文档新增制动命令(油门 0、刹车 1)说明
- 新增停止效果动图 cruise_stop_demo.gif(24 km/h 减速至停止)
- 视频素材已转换为动图(英文+下划线命名,位于 docs/img/ground/)

本文档由大模型辅助编写

* docs(ground): 调整停止操作表述(先 Ctrl+C 停止发布,再发布制动命令)

* docs(ground): 将运行效果动图移至行驶命令后展示

* docs(ground): 效果说明补充发布制动命令后车辆减速停下

* docs: 恢复 mkdocs.yml 中注释掉的 bibtex 与 mkdocs-video 插件

* docs: 教程代码块标注 bash,删除未引用的 cruise_demo.mp4

* docs: 清理教程文档多余空行

* docs(img): 压缩桥接截图(1.68MB→257KB)便于 PR 预览渲染

* Revert "docs(img): 压缩桥接截图(1.68MB→257KB)便于 PR 预览渲染"

This reverts commit 8c401c5.

* feat: 教程配套脚本放入 src/ground/rostopic_cruise/,文档增加脚本引用

* docs: 教程增加配套代码位置说明(src/ground/rostopic_cruise/),移除脚本运行引用

* feat: 新增键盘控制小车教程(carla_keyboard_control.md)及效果图/演示视频

* docs: mkdocs.yml 导航加入键盘控制小车教程

* docs: 键盘控制教程第五步效果图前移、修复转义污染并恢复视频标签

* docs: 键盘控制教程新增配套代码章节并入库 carla_manual_control.py

* docs: 键盘控制教程演示视频改为GIF动图(webm不兼容浏览器播放)

* docs: 用新演示视频替换键盘控制教程两张动图

* docs: 键盘控制教程演示动图改为单张(keyboard_control_demo.gif)

* docs: 键盘控制教程补齐各步骤脚本到src目录并更新配套代码表

* docs: 压缩第三步效果图至3MB以内(满足提交规范)

* docs: 键盘控制教程按reviewer意见改用不冲突文件名、w/a/s/d按键与通用路径

* docs: 键盘控制教程mkdocs导航与配套脚本同步w/a/s/d和通用路径

* docs: 键盘控制教程正文更新w/a/s/d按键说明与通用路径

* docs: 按reviewer建议改用文件名carla_keyboard_manual_control.md

* docs: mkdocs导航指向新文件名carla_keyboard_manual_control

* docs: rostopic教程新增其他常用命令(list/echo/type/hz/rosnode/倒车)

* docs: rostopic教程rosnode查看命令补配套脚本并更新代码表

* docs: 移除键盘控制教程,仅保留rostopic教程

* docs: 清理rostopic教程多余空格与列表间空行

* 阿克曼控制教程:新增 rostopic 与 Python 阿克曼消息发布示例及配套代码
- --selftest 注释写“30 项”,实际输出为“通过 36/36”
- --figures 的 --outdir 写成 ../docs/...,从模块目录解析会落到不存在的
  src/air/docs/...,应为 ../../../docs/img/air/uav_semantic_mapping_nav

Co-authored-by: 520731lsh <240148083+520731lsh@users.noreply.github.com>
* docs(ground): 新增 rostopic 手动驱动文档

- docs/ground/rostopic_cruise.md: CARLA + ROS 桥接后,用 rostopic 发布控制命令驱动车辆(含运行效果图与动图)
- docs/img/ground/: 桥接成功截图、行驶动图、演示视频
- mkdocs.yml / docs/index.md: 地面载具导航与首页新增链接

本文档由大模型辅助编写

* docs(ground): 完善 rostopic 手动驱动文档,新增停止命令与效果动图

- 文档新增制动命令(油门 0、刹车 1)说明
- 新增停止效果动图 cruise_stop_demo.gif(24 km/h 减速至停止)
- 视频素材已转换为动图(英文+下划线命名,位于 docs/img/ground/)

本文档由大模型辅助编写

* docs(ground): 调整停止操作表述(先 Ctrl+C 停止发布,再发布制动命令)

* docs(ground): 将运行效果动图移至行驶命令后展示

* docs(ground): 效果说明补充发布制动命令后车辆减速停下

* docs: 恢复 mkdocs.yml 中注释掉的 bibtex 与 mkdocs-video 插件

* docs: 教程代码块标注 bash,删除未引用的 cruise_demo.mp4

* docs: 清理教程文档多余空行

* docs(img): 压缩桥接截图(1.68MB→257KB)便于 PR 预览渲染

* Revert "docs(img): 压缩桥接截图(1.68MB→257KB)便于 PR 预览渲染"

This reverts commit 8c401c5.

* feat: 教程配套脚本放入 src/ground/rostopic_cruise/,文档增加脚本引用

* docs: 教程增加配套代码位置说明(src/ground/rostopic_cruise/),移除脚本运行引用

* feat: 新增键盘控制小车教程(carla_keyboard_control.md)及效果图/演示视频

* docs: mkdocs.yml 导航加入键盘控制小车教程

* docs: 键盘控制教程第五步效果图前移、修复转义污染并恢复视频标签

* docs: 键盘控制教程新增配套代码章节并入库 carla_manual_control.py

* docs: 键盘控制教程演示视频改为GIF动图(webm不兼容浏览器播放)

* docs: 用新演示视频替换键盘控制教程两张动图

* docs: 键盘控制教程演示动图改为单张(keyboard_control_demo.gif)

* docs: 键盘控制教程补齐各步骤脚本到src目录并更新配套代码表

* docs: 压缩第三步效果图至3MB以内(满足提交规范)

* docs: 键盘控制教程按reviewer意见改用不冲突文件名、w/a/s/d按键与通用路径

* docs: 键盘控制教程mkdocs导航与配套脚本同步w/a/s/d和通用路径

* docs: 键盘控制教程正文更新w/a/s/d按键说明与通用路径

* docs: 按reviewer建议改用文件名carla_keyboard_manual_control.md

* docs: mkdocs导航指向新文件名carla_keyboard_manual_control

* docs: rostopic教程新增其他常用命令(list/echo/type/hz/rosnode/倒车)

* docs: rostopic教程rosnode查看命令补配套脚本并更新代码表

* docs: 移除键盘控制教程,仅保留rostopic教程

* docs: 清理rostopic教程多余空格与列表间空行

* 阿克曼控制教程:新增 rostopic 与 Python 阿克曼消息发布示例及配套代码

* 阿克曼控制文档:补充 simple-pid 版本不兼容报错的解决方法
* feat(water): 新增 ROV 多源融合组合导航(EKF)并修正仿真时间戳

- 新增 15 状态误差状态卡尔曼滤波:融合 IMU / DVL / 深度计 / 姿态
- 新增传感器噪声仿真节点与 /rov/odom_fused、/rov/odom_deadreckoning 输出
- 新增一键 launch 与无头自动评测(RMSE / 漂移 / NEES)
- mujoco_sim_node 改用仿真时间打戳并发布 /clock,修复下游积分比例误差
- 文档 docs/water/rov_ekf_navigation.md 与 mkdocs 导航

* docs(water): 补充文件结构与数据流图,修正 LaTeX 公式渲染

- 新增「2. 文件结构」:目录树 + 传感器/EKF 数据流
- \big(...\big) 改为 \left(...\right),避免渲染器报「未识别分隔符」
- 后续章节重新编号

---------

Co-authored-by: DavidLYP <DavidLYP@users.noreply.github.com>
…UTB#455)

* carla 作业五:新增 src/ground/carla_benchmark_suite 四份作业统一整合与性能评价模块

- 统一调度入口:--target 拉起 control/perception/navigation/end_to_end 四份作业,
  '--' 之后参数原样透传,子作业新增参数时本模块无需改动
- 重写性能评价:原版用 np.random.seed(0) 造随机数当指标,与算法无关;
  改为真实训练并回放各模块,量测精度/时延/平滑度/覆盖率等指标
- 指标:感知准确率、控制MSE、横向误差RMSE、规划MSE、建图覆盖率、占据格数、
  导航最近距离、端到端MAE/方向一致率/相关系数、转向AoS与饱和率、推理时延均值与P95
- 新增副本一致性回归测试:nn_models.py 在各功能包内各有一份副本,
  分歧即失败并列出差异文件(历史上因副本漂移导致端到端MAE误测为36.12)
- 指标对比图按组内最大值归一化条长并用点阵标注真实数值,解决小数值指标不可见问题
- 评测全部离线可复现(无需 CARLA 服务端);模块缺失时优雅降级不中断
- 标准 ament_python 功能包:main.* 入口、ROS1/ROS2 双版本 launch、config、
  ROS2 节点(发布指标话题/调度子模块)、单元测试11项
- 文档 docs/ground/carla_benchmark_suite.md,并在老师「自动驾驶示例」页追加拓展章节
- 实测:感知0.9850、控制MSE 0.01893、横向RMSE 0.9608m、规划MSE 0.00610、
  建图覆盖率0.2919、导航1.4539m、端到端MAE 0.10093/一致率0.9500、测试11/11通过

* carla 文档:调整 docs/index.md 与 mkdocs.yml 的插入位置,避免多个作业 PR 逐个合并时冲突

五个作业 PR 原本都在「点云地图创建」同一行之后插入新条目,老师逐个合并时 hw3/hw5 会因同一位置插入而冲突(已实测)。
改为各分支插入到互不相同的锚点行之后,使插入点在文本上不重叠。

* carla 作业五:修正评测假结论(初始航向写死、时间预算不足)并删除死代码

本包是评测套件,自身不连 CARLA,而是导入作业二/三/四的模块真实训练并回放。
审查后发现评测结果本身是错的,且携带一份无人引用的旧公共模块。

1) 删除死代码 carla_common.py
   该文件从未被任何代码 import(全包仅 README 提过一句),
   且保留着作业二修复前的缺陷(20 s 超时、出生朝向逆行、同步模式不恢复)。
   本包既然不连接 CARLA,留着它只会误导使用者,故删除并更新 README 说明。

2) perception 基准的初始航向被写死为 0(+x)
   而 DEMO_ROUTE 首段指向 -x,回放先掉头再追线,横向误差被这段无效机动污染。
   修复:由 wps[0]→wps[1] 方向推导初始航向。

3) perception 基准的时间预算写死 40 s,而轨迹长约 400 m、车速约 7 m/s,
   跑完全程需 55 s 以上——回放在离终点 60 多米处被截断,
   于是 reached_goal 恒为 False。**这不是控制失败,而是预算不足造成的假结论。**
   修复:按轨迹长度推导预算(按 5 m/s 保守估计,限幅 40~180 s)。

4) navigation 基准的初始航向同样写死为 0
   而默认目标在起点左后方,回放开头先背离目标再掉头。
   修复:朝目标方向推导初始航向。

效果(五包共存、真实测量):

  指标              修复前       修复后
  lateral_rmse      44.5946 m    0.2188 m
  reached_goal      False        True
  steer_mean        0.05095      0.02592
  control_mse       0.00350      0.00350

修复前把"控制器完全失效(横向误差 44 m、未到达目标)"的错误结论写进了
评测报告;修复后横向误差 0.22 m 且成功到达终点,与作业二自身实测一致。

同步更新文档与 README 中的全部指标(原记录是修复前的旧值):
  感知准确率 0.9850→0.9875、控制 MSE 0.01893→0.00350、
  横向 RMSE 0.9608→0.2188、占据格 1387→1261、建图覆盖率 0.2919→0.2715、
  导航最近距离 1.4539→1.4251、端到端 MAE 0.10093→0.14361、
  方向一致率 0.9500→0.9300、相关系数 0.9920→0.9896。

新增 4 项回归测试(初始航向×2、时间预算、死代码),测试 11→15 项全部通过。

* fix(作业五): 补 main.* 可执行位、修 launch 空值透传、Noetic 入口改用 main.sh

把老师给作业一提的 3 个同类问题同步修到本模块,其中第 2 条在本模块是真实缺陷:

1. main.py / main.sh / main.bat 补可执行位
   原为 100644。launch/main.launch 用 <node type="main.py"> 让 roslaunch 按
   shebang 直接执行它。已改 100755 并加测试固化。

2. launch 的 --target 空值会让 argparse 直接退出
   本模块 launch 的布尔量用 <node if="$(arg list)"> / if="$(arg benchmark)" 门控,
   这点是对的;但第三个节点写的是 "--target $(arg target) --host $(arg host) --",
   而 target 默认为空串 —— 经 shlex 切分后成了 ["--target", "--host", "127.0.0.1",
   "--"],argparse 见到下一个 token 以 - 开头即以
   "expected one argument" 退出,于是按注释里第一条用法
   `roslaunch carla_benchmark_suite main.launch`(只发布评测)直接失败。
   已把 --target / --save_dir / --out 改为 nargs="?" + const=None,
   并同样把布尔开关改为 nargs="?" + const=True + type=_parse_bool
   (裸写与 true/false/1/0 都接受,非法值明确报错)。

3. Noetic 下 shebang 与 Python 版本冲突(老师第 3 条)
   main.py 首行是 #!/usr/bin/env python3,Noetic 的 python3 是 3.8,装不上
   CARLA 0.9.16 的 cp310+ wheel。roslaunch 只能按 shebang 执行,补了可执行位也
   照样卡在 import carla。已把 Noetic 入口改为 bash main.sh(自动挑 python3.10):
   README 运行段与文档的 roslaunch 用法均已改,并注明「若系统 python3 已是
   3.10+ 也可用 roslaunch」;main.sh 补上了 Noetic 环境的 source。

新增 4 项回归测试:可执行位、布尔带值解析、空 save_dir 不退出、launch 声明的
arg 是否都被节点用到。最后一项又抓出一个真问题:launch 声明了 port 却没有任何
节点用它(--port 在解析器里根本不存在),于是 port:=3000 静默失效、host:= 也
只是被解析后丢掉。已补 --port 参数,并让 host:= / port:= 真正拼进透传给子模块
的参数里。单元测试 19/19 通过。

* docs(作业五): 文档对齐 OpenHUTB/doc 标准——行内公式、页面内跳转、目录关系、IP 来源

把老师已在作业一/二里确认的文档问题同步修到本模块:

1. 行内公式渲染失败
   仓库用 mdx_math,默认 enable_dollar_delimiter=False,`$...$` 不被识别、
   会原样残留成字面文本。6 处行内 `$...$` 已改为 `\(...\)`。

2. 页面内跳转
   按 OpenHUTB/doc 的写法加 <span id> 锚点(build / bench / dispatch /
   conn-check),把新手路线表 2 处「本页 x.y 节」与 5.10 常见问题里的
   「见 5.4 节」改成可点击链接。

3. 补充两处说明
   * 5.4 编译段:说明 ~/ros2_ws 是工作空间根目录、本模块源码在本仓库的
     src/ground/carla_benchmark_suite/ 下,给出目录树与实际路径。
   * 5.6 连接段:说明 192.168.8.1 是宿主机 `ipconfig` 查到的 VMnet8 地址,
     并链接到已有示例的查看步骤。

* fix(作业五): main.sh 的 --launch 分支根本没跑通,改成按 ROS 版本分派

文档 5.8 节和 main.sh 头部都把 `bash main.sh --launch` 列为入口,实际这条分支
是坏的:

    for a in "$@"; do
        if [ "$a" = "--launch" ]; then
            exec ros2 launch carla_benchmark_suite main.launch.py "${@/--launch/}"
        fi
    done

1) 只给 `--launch` 时,`${@/--launch/}` 会把该参数替换成**空字符串**,于是命令
   变成 `ros2 launch <pkg> main.launch.py ""`,ros2 launch 解析不了这个空参数,
   以 Invalid launch argument 失败 —— 也就是文档里最常用的那条命令起不来。
2) 不管装的是 ROS 1 还是 ROS 2 都调 `ros2`,Noetic 上直接 command not found。
3) 其余参数照 CLI 写法(`--host x`)往下传,而 `ros2 launch` 只认 `name:=value`。

改法:先把参数收进数组、把 `--launch` 摘出去,再按 `ROS_VERSION` 分派 ——
ROS 2 走 `ros2 launch <pkg> main.launch.py <name:=value ...>`,
ROS 1 走 `roslaunch <pkg> main.launch <name:=value ...>`,都没有就明确报错退出。

    bash main.sh --launch target:=perception host:=192.168.8.1
    bash main.sh --launch benchmark:=true save_dir:=$HOME/shots

新增一条回归测试卡住这个写法(禁止 ${@/--launch/}、必须同时含 ros2 launch 与
roslaunch、必须按 ROS_VERSION 分派)。单元测试 20/20 通过。

* docs(作业五): 实测数据改成可复现的那一组,并说明复现命令

按 5.5 节的命令
`python3 src/ground/carla_benchmark_suite/main.py --benchmark --save_dir ~/shots
--out ~/shots/report.json`(不带 --epochs / --samples,走各评测项的默认值)实跑,
逐项核对 6.1/6.2 节:

**① 6.1 的标题写错了命令**
原来标的是 `--benchmark --epochs 60 --samples 60`,但表里的数字其实来自**默认参数**
那一组 —— `--epochs 60` 会把三项全设成 60 轮,测出来是另一组值
(感知 0.9850 / 控制 0.01893 / 横向 RMSE 1.0110 / 端到端 MAE 0.10093)。
默认参数下跑出来才是 0.9875 / 0.00350 / 0.2188 / 0.14361,与表里一致。
已把标题改成「即 5.5 节那条 --benchmark 的默认参数」,并写清实际默认轮数
(perception 150 / navigation 60 / end_to_end 40 轮 100 样本,约 100 秒)。

**② 表里过时的数值(旧 -> 新)**

    平均速度        6.9215    ->  7.0380 m/s
    转向 AoS        0.00912   ->  0.01820
    建图覆盖率      0.2919    ->  0.2715
    占据格数        1387      ->  1261
    单步推理时延    0.0412 ms ->  0.0386 ms
    方向一致率      0.9500    ->  0.9300
    相关系数        0.9920    ->  0.9896
    零输出基线 MAE  0.40678   ->  0.40404(网络是基线的 1/2.8,不是 4.0 倍)
    单帧推理时延    2.9311 ms ->  2.3753 ms

6.2 节「横向对比」里引用的数字同步更新;「10 秒左右的行驶覆盖 29%」按作业三
实测改成「6 秒左右覆盖 27%」。

**③ 5.9 节终端输出里的两个时延也更新了**(0.08428 -> 0.03857、
4.34395 -> 2.37534)。时延与机器性能有关,已注明换机器会浮动、其余指标由固定
随机种子决定可逐位复现。

**④ 对比图重新生成**
`carla_bench_metric_summary.png` 用本次运行的输出覆盖(760×420,尺寸未变)。

**⑤ 单元测试数**从「11 项」改成「19 项」。

* docs(作业五): 单元测试数补上刚加的那条 --launch 回归测试

文档里写死的单元测试数还停在上一版:

    docs/ground/carla_benchmark_suite.md   19 -> 20

原因是修 `main.sh --launch` 分支时顺手加了一条
`test_main_sh_launch_dispatches_per_ros_version`(禁止 ${@/--launch/} 那种
会留下空参数的写法、必须同时支持 ros2 launch 与 roslaunch、必须按
ROS_VERSION 分派),但没同步改文档里的数字。实际跑出来是 20 PASS / 0 FAIL。

* fix(作业五): ros2 launch 起来加载不到评测实现,改为包内绝对导入

`benchmark_node.py` 原来用 `spec_from_file_location` 按文件路径加载功能包**根目录**的
`main.py`。但 `setup.py` 只声明 `packages=[package_name]`,包根目录下的文件不会被
安装进 site-packages,`ros2 launch` 之后这条路径必然失效,节点能起来但指标全空
(作业四被同学指出过同一个问题)。

* `main.py` 移进 Python 包(`carla_benchmark_suite/main.py`),包根保留一层薄壳,
  课程要求的 `main.*` 入口不变;
* 节点改为 `from carla_benchmark_suite import main`,源码树与安装后都能导入;
* 实现内的 `_THIS_DIR/_PKG_ROOT/_GROUND_DIR` 跟着多退一层,兄弟功能包定位不受影响;
* 单元测试的静态检查改读包内实现(`_IMPL`),因为 `from ... import *` 不会带出
  下划线开头的函数。

docs(作业五): 补指标对比 gif 动图,并按当前实测重测数字

* 新增 `carla_benchmark_suite/gif_writer.py`(纯 Python GIF 编码器);
* `render_metric_bars` 拆出 `metric_bars_canvas(progress=...)`,`--benchmark --save_dir`
  额外导出 `metric_summary.gif`(10 帧,条形从 0 长到实测值);
* 文档 5 节插入动图,并替换 `carla_bench_metric_summary.png`。

**文档里的 navigation 那组数字已过期**,因为作业三模块后来改过,重新实测后更新:
plan_mse 0.00610 → 0.00788、reg_corr 0.99185 → 0.98865、
occupied_cells 1261 → 1214、known_ratio 0.27145 → 0.26503、
nav_min_dist 1.42510 → 1.41609、latency_mean_ms 0.03857 → 0.02977、
infer_ms_per_frame 2.37534 → 2.23733。perception 与 end_to_end 的精度指标未变。

测试(20 → 23 项,全部通过):
* `test_node_loads_benchmark_from_inside_package`:钉住「实现必须在包内、节点必须
  用包内绝对导入、不得再按文件路径加载」这三条;
* `test_gif_writer_roundtrip`:用按规范独立实现的 LZW 解码器把 GIF 读回逐像素比对;
* `test_metric_bars_canvas_grows_with_progress`:每帧颜色数 ≤256,且条长随
  progress 增长。

验证:
* 只把 `carla_benchmark_suite/` 拷到空目录(模拟安装形态),
  `import carla_benchmark_suite.main` 成功,`BENCHMARKS` 三个键齐全;
* 四个模块放在一起跑 `--benchmark`,数字与更新后的文档逐项一致;
* GIF 已用 Pillow 读回,10 帧、420×760、条长从 10.5% 长到 22.9% 非白像素。

* fix(作业五): 四包齐全后统一指标口径,对比图补指标名

处理 PR OpenHUTB#455 评审(Repeat666,2026-11-07)的 7 条意见:

1. 合并最新 master:carla_mapping_navigation / carla_end_to_end_nn 已随作业三、
   四入库,干净克隆即可 `--benchmark` 复现全部 10 项指标;README、文档、对比图
   三处数字统一为同一次实测(原先 0.2919/0.2715/0.2650 三套并存)。
2. README 测试数 11 项 → 23 项(与实际一致)。
3. 对比图左侧用位图字体标注指标名与单位(percept acc / lat rmse (m) / …),
   指标由 8 项补齐到 10 项,右侧仍标真实数值;新增 bitmap_font.py 副本。
4. 感知/控制 NN 改为**留出集**评估(另生成 120 样本、不同种子、不参与训练),
   汇总表只报留出集,训练集数值作对照 —— 原先用的是训练输入。
5. 删除 launch/main.launch:本包是 ament_python(format 3)包,Noetic 的 catkin
   环境里没有它的 package index,roslaunch 必然找不到;ROS 1 分支改为明确提示
   用 main.sh 直接运行,ROS 2 launch 保留。
6. package.xml 去掉四个非 rosdep key 的 exec_depend,`rosdep install` 不再失败。
7. 根入口 docstring 的 `--module` 改为实际参数 `--target`。

顺带修:副本一致性测试忽略行尾差异(同一内容在不同包内可能以 CRLF/LF 检出,
Windows 工作区会假报分歧)。

实测:23 PASS / 0 FAIL;--benchmark 10 项全部出数。
22wzzw and others added 30 commits November 10, 2026 19:39
* Add files via upload

* Update mkdocs.yml

* Update index.md

---------

Co-authored-by: xingwunian <1377754734@qq.com>
)

* Add files via upload

* Update mkdocs.yml

* Update index.md

* Add files via upload

* docs: 导航里加入换道可行性判定

* Add lane change feasibility section to documentation

---------

Co-authored-by: xingwunian <1377754734@qq.com>
* feat(air): add UAV gimbal stabilization simulation

* fix(air): complete gimbal review requirements

---------

Co-authored-by: xingwunian <1377754734@qq.com>
收敛为可独立复现的垂直定高问题:MuJoCo 测距/速度观测,PPO 输出合成推力,与 PD、恒定推力在 calm/gust/payload 三场景对照;附预训练策略、两条同种子样例、原理与结果文档。
* docs(wind): 真实 AirSim 画面演示动图(150 帧 3.9MB)

* feat(wind): 初始化抗风补偿包

* feat(wind): AirSim 环境封装,含 IMU 滑窗与 simSetWind 注风

* feat(wind): PD 与风速前馈专家策略,前馈系数按实测标定

* feat(wind): 纯 NumPy 两层 MLP 与 Adam

* feat(wind): 样本采集,随机风场与通道标准化

* feat(wind): 训练脚本,L2 正则与验证集留优

* feat(wind): 实飞演示、无补偿对照与 gif 压缩

* feat(wind): ROS 2 节点,订阅 IMU 与位置发布补偿指令

* feat(wind): 四合一入口 collect/train/demo/baseline

* feat(wind): launch 启动配置

* build(wind): ament_python 包描述

* build(wind): 安装脚本与入口点

* build(wind): setup.cfg 脚本目录

* build(wind): ament 资源标记

* docs(wind): 模块 README 含效果对比与复现步骤

* feat(wind): 训练好的补偿网络权重

* feat(wind): 600 条采集样本与标准化参数

* docs(wind): 11 节完整文档含公式流程图与踩坑表

* test(uav): 抗风模块新增 5 条单元测试(形状/范围/权重加载/输入拼接/真实数据相关性)

* docs(uav): 抗风文档补自检命令与数据已标准化的注意事项

* docs(uav): 在 mkdocs 导航与首页登记抗风补偿页面入口

* docs(wind): 说明 CI 触发路径不含本模块,测试需本地手动执行

* fix(docs): 演示动图路径改为 ../img,修复动图无法渲染

---------

Co-authored-by: WZJ6666wudu <WZJ6666wudu@users.noreply.github.com>
补上"采集 -> 训练 -> 评估"链路的最后一步:session.npz -> gesture_mlp.npz。

- gesture_train.py:42 -> 64(ReLU) -> 7(softmax) 两层 MLP,交叉熵 + mini-batch SGD + 动量,
  纯 numpy,不依赖 torch;提供 forward/predict/confidence/train/save/load
- 划分方式对比:time / stratified / random 三种,默认按时间划分,`--compare` 并排打印,
  避免"相邻帧高度相似"造成的指标虚高;同时打印多数类基线(真实样本上 0.722 vs 0.972)
- 稳健性:load() 校验模型里的类别顺序与当前词表一致,词表变了直接报错而不是静默错标;
  数据来自 merge_sessions 时提示 time 划分已不代表采集顺序
- 默认模型写到包内 models/(可用 --out 覆盖),数据路径兼容源码树 / install / rospkg 三种布局
- 文档补"训练与评估"一节 + 真实样本输出与证据图;CMakeLists 把脚本装成可执行的 catkin 程序
- 测试:test_gesture_train_local.py 50/50

基于 OpenHUTB#898(已合并为 441aa96)。
* feat(air): 新增无人机偏航短路径与角速度限幅

* fix(air): 增加偏航角反馈超时保护
* feat(air): add MuJoCo moving-pad landing scene

Add a parameterized quadrotor and mocap landing pad with a reproducible simulation entry point.

* test(air): document and capture landing simulation output

Pin the lightweight runtime dependencies and include MuJoCo-rendered scene and trajectory evidence with run steps.

* feat(air): add keyboard teleoperation to landing simulation

* fix(air): address moving-pad landing review findings

修复首次接触指标、重力补偿、轨迹参数与真实 MuJoCo rollout 数据集;补充 Docker 无头渲染和中英双语复现说明。

* test(air): add rollout and control regression coverage

补充真实 MuJoCo rollout、低空覆盖、固定相位和 episode 隔离测试。

* docs(air): refresh MuJoCo landing evidence

更新实际渲染的 PNG 与 GIF,和首次接触指标保持一致。

---------

Co-authored-by: wxqlp99 <327735173+wxqlp99@users.noreply.github.com>
新增 src/ground/hill_start_assist:12° 坡道上以轮速/轮角增量闭环施加保持力矩,实现松刹车后的防溜车与坡道起步;出生点与落稳逻辑收敛到 spawn.py,由 check_hill.py 与 make_gif.py 共用。

无辅助 3 s 位移 -2.179 m → 有辅助 -0.008 m(99.65%),末俯仰 -12.0°、最小接触 4、起点初速 0.00 m/s;摩擦 ×0.5、timestep 0.001/0.004、额外 +5 kg 下位移稳定在 0.5-0.8 cm。

同步补充 docs/ground/hill_start_assist.md 与对比动图,并在 mkdocs.yml、docs/index.md 双注册;含 README、launch、package.xml、CMakeLists.txt 与 5 项单测。
feat/Turtlebot3 机器人 Gazebo 仿真与键盘控制实验
* feat(air): 新增无人机执行器故障注入模块,为后续神经容错飞行提供数据与评测台

为什么改:

现有 src/air 下的无人机模块(uav_mujoco_sim 底座、航点跟踪、PPO 巡航、DQN 导航等)
全部建立在"飞行器健康"的假设上。一旦某个桨完全失效,几何控制器只能把损失的推力
均摊给其余三桨;实测这样会在 0.64 s 内坠地(最低高度 -109.8 m、触地速度 5.13 m/s),
也就是"必坠且朴素补偿救不回来"。仓库里没有任何模块能复现"带故障的飞行",
神经容错控制器也就没有可训练的数据、也没有可对比的评测台。

本模块补齐这一层,并且刻意不改动 uav_mujoco_sim 底座(底座作者正在提交同源 PR):

- 四种桨故障(完全失效 / 推力衰减 / 卡死 / 渐进退化)+ 三参数 IMU 故障,
  统一折成 T_i^act = g_i(t)·u_i^cmd + b_i(t),带 ramp 过渡与限幅;
- runner 在底座公开 API 上接管控制回路(控制器 → FaultInjector → 四桨推力 → step),
  控制器统一接口 act(quad, p_d, v_d, a_d, yaw_d) -> ndarray(4),便于后续换成神经网络;
- 六个评价指标(是否坠机、坠地延时、触地速度、水平漂移、位置 RMSE、控制能量)
  与 7 故障 × 5 物理场景的用例矩阵(seed 可复现);
- --keyboard 键盘遥控可叠加故障,同时满足任务①(物理仿真 + 键盘遥操作);
- --node / ros2 launch 提供 ROS2 接口:发布 /uav/odom、/uav/status、/uav/fault、
  /uav/health,订阅 /uav/cmd_vel、/uav/goal。

复现(Windows 无 ROS 也能跑,文档在 docs/air/uav_actuator_fault_sim.md):

  python main.py --selftest          # 14/14
  python -m pytest test -q           # 45 passed
  python main.py --eval results/comparison.csv   # 35 条:健康存活率 1.00,单桨失效 0.00
  python main.py --gif  results/fault_comparison.gif

已在 Ubuntu 22.04 + ROS2 Humble 上验证:colcon build 通过,
ros2 launch uav_actuator_fault_sim fault_sim.launch.py 正常启动并干净退出,
/uav/odom 稳定 50 Hz,mkdocs 站点构建通过(首页与导航栏均已加链接)。

* fix(air): 把传感器故障真正接进控制回路,sensor_bias 不再等于健康

审查意见指出 fault.py 里的 SensorFault 只被导出、从未被使用:控制器吃的是仿真真值,
IMU 读数既没被读取也没被篡改,所以 results/comparison.csv 里 sensor_bias 与 healthy
完全一致,这个场景等于死代码。本提交补上闭环:

- FaultInjector 新增 sense_omega():按 onset/ramp 给陀螺加零偏、按 noise_scale 加噪声、
  按 dropout 丢包并沿用上一帧;SensorFault 因此也有了 onset/ramp 参数
- runner 用 _SensedQuad 代理,把"被篡改的角速度 + 由它积分的姿态估计"交给控制器,
  物理推进仍用真实状态;健康时不做积分,基线漂移仍是 0
- metrics 与汇总表补平均水平漂移、平均位置 RMSE,让 IMU 故障在表里看得出来
- selftest 增加"传感器故障"一组 5 项;新增 test/test_sensor.py 15 个用例
- 重新生成 comparison.csv、sensor_bias_sweep.png;文档补公式、机制与零偏-漂移表

现在 0.1 rad/s 零偏悬停 8 s 漂 0.309 m 但不坠机,0.2 rad/s 以上坠机(5.7 s / 4.38 s),
与 healthy 的 0.000 m 区分明显。

验证:python main.py --selftest(19/19)、python -m pytest test -q(60 passed)、
mkdocs build 通过(页面 40687 B)。
* feat(air): add quantitative UAV braking metrics

* fix(air): validate UAV trajectory flags

* docs(air): add Chinese trajectory metrics flow

* docs(air): add Chinese trajectory metrics guide

* docs(air): add trajectory metrics reference page

* docs(air): avoid fixed test total in metrics guide
* feat(air): 新增 AirSim Unity 无人机高度自适应越障实验

- 新增 airsim_height_aware_overfly 模块:逐列恢复障碍顶边,矮墙原地爬升越过、高障碍退回水平绕行
- 越障状态机:3 帧稳定提交、只升不降、6 帧畅通完成、连续两次失败永久解除
- 越障期间先原地爬升再前进,越障后保持高度 5 m 再降回巡航
- 修正 Unity 垂直 FOV 与自下而上深度缓冲区两处坐标问题(顶边高度不再低估)
- 52 项离线测试;2026-11-09 本机两次实飞均越障到点并确认降落
- 新增实验报告、README、证据 CSV/事件日志与录屏,并接入 mkdocs 导航与首页

* docs(air): 修正高度越障 README 的相机高度与实飞状态表述

- 相机 0 装在机体原点上方约 0.49 m(simGetCameraInfo 实测),After climb 的 z
  是机体 NED 高度而不是相机高度;6 m 墙顶只比巡航相机高约 0.2–0.5 m,
  与 flight.csv 的 top_height 0.04–0.11 m 一致
- 相应修正墙高换算规则(墙顶 Y ≈ |z| + 0.5~1.0、柱顶 |z| + 4)与验收阈值
- 删除“尚未实飞”的过时表述,改为“高柱/多场景尚未实飞,阈值仅由两次实飞支撑”

* docs(air): 同步预期输出中的 top 读数范围

* fix(air): 越障预算计入相机安装偏移

- top_height 相对相机、radius 相对机体;新增 camera_offset(simGetCameraInfo 实测约 0.49 m),
  在 climb_needed、overfly 预算和 committed 目标中统一相加,避免实际净空少 0.49 m
- 新增 5 项测试:偏移计入 committed、偏移使越障超预算、负偏移拒绝、零偏移保持旧公式
- 文档同步:相机偏移说明、修复前实飞净空约 1.53/1.61 m 的备注、测试数 52 → 57

* docs(air): 修正相机偏移后的阈值为 6.1/1.9/2.6 m

- 柱顶 |z|+4 的 climb_needed 改为约 6.1 m(3.51+0.49+2.1)
- max-climb 4.5 的可越上限为比相机高约 1.9 m,墙顶 > |z|+2.4 判太高
- climb_needed 归零阈值改为顶边低于相机约 2.6 m(0.49+2.1)
- max-climb 下限与 holding 打印值同步为 2.6 m,报告参数说明同步

* docs(air): 实飞状态注明相机偏移修正前数据

- README 顶部同步说明 2026-11-09 两次实飞为偏移修正前采集(净空约 1.53/1.61 m)
- 修正后 committed 约 2.6 m、净空恢复 2.1 m,尚未复飞

* docs(air): 同步首页测试数与 top_height 相对相机的说明

- 首页入口 52 → 57 项测试,并注明 committed 2.6 m/尚未复飞
- README 与报告的 flight.csv 字段说明标注 top_height_m 相对相机
- 模块 docstring 的越障预算补充相机安装偏移

* docs(air): 报告状态注明相机偏移修正后尚未复飞
* feat(ground): 建立视觉车道偏离预警包的骨架与依赖声明

* 为什么:仓库里已有的车道偏离预警完全依赖地图路点,相机没有参与感知。这个模块要把图像接进来,所以先建一个独立的包,不改动原模块。
* 包名沿用 ground 目录下的命令习惯,入口脚本注册 visual_lane_departure_node。
* 运行依赖只有 numpy 与 Pillow,画图用的 matplotlib 单独放在可选项,没装也不影响采集、训练和演示。

* feat(ground): 实现相机内参、世界点投影与横向偏移的纯几何层

* 为什么:投影和偏移符号是最容易写错、也最难在仿真里定位的部分,所以单独抽一层,既不 import carla,也能在没装仿真器的机器上直接测。
* 内参按 CARLA 的水平视场角推,f = (W/2)/tan(fov/2)。
* 投影时 v 轴取负,因为图像坐标向下而相机坐标向上;相机身后的点判为无效。
* 横向偏移用 -dx*sin(yaw)+dy*cos(yaw),与仓库原 LDW 模块同口径,左偏为正。

* feat(ground): 实现数据集采集与五道质量过滤

* 为什么:直接采集的帧里混着大量不可用样本。第一版 593 帧训练出来的横向偏移误差是 0.495 m,逐帧检查发现右侧边界常常是路沿而不是画线,还有些帧自车根本不在地图给出的那条车道里。
* 五道过滤依次是:车道宽、自车相对当前路点的偏移、边界处是否真有白线、两条边界是否都落在画面内、目标偏移是否超过 2 m。
* 白线判定取 6/10/14 m 三处最大值:车道线多为虚线,只看 10 m 那一点会有一半概率落在空档里,被误判成没线。
* 加入过滤后数据集从 1430 帧增到 1989 帧,训练误差从 0.143 m 降到 0.096 m。

* feat(ground): 手写两层全连接网络完成车道边界回归

* 为什么不用现成框架:这个模块只需要一个 26 万参数的回归网络,为了它引入 CUDA 版的深度学习框架,在课程虚拟机上装起来比代码本身还麻烦。纯 NumPy 手写前向反向,训练 17 秒能跑完,还便于逐行解释梯度是怎么传的。
* 输入 4096 维(32×128 灰度),两层隐藏层 64 与 32,输出左右边界两个数。
* He 正态初始化、动量 SGD、MSE 损失,权重存 float32 把体积从 2 MB 压到 960 KB。
* 镜像扩增把样本翻倍:翻转图像的同时交换并取反两个目标,与车道左右对称性一致。

* feat(ground): 增加误差统计与按车速分档的评价指标

* 为什么:只看平均误差会掩盖问题。验证集的平均误差 0.096 m,但中位数 0.076 m、p90 0.208 m、最大 1.914 m,说明误差分布是长尾的,必须把分位数一起报出来才能判断能不能用。
* 按车速分档是为了验证模型有没有学到几何结构:如果只是记住图像纹理,误差应该随速度单调变化,而实测 4–8 与 8–12 两档几乎相同。
* 分档边界右端用 inf 兜底,否则超过最高档的样本会被静默丢弃。

* feat(ground): 实现带滞回的三级车道偏离状态机

* 为什么需要滞回:偏移在阈值附近抖动时,没有滞回的判定会连续产生一串进退事件,对下游控制器来说等同于噪声。
* 阈值与仓库原有的地图版 LDW 完全一致(0.5/0.3 与 0.9/0.65),这样两个模块的输出可以直接逐帧对照,不需要换算。
* 状态机不依赖 ROS,可以离线喂序列测试;事件对照函数用来衡量两路预警的时序一致性。

* feat(ground): 封装 CARLA 连接、相机挂载与探路脚本

* 为什么单独写探路:CARLA 的默认出生点常常在路口,那里没有车道线,直接采集会得到一批没有标签可学的样本,白跑一次八分钟。
* 探路把地图算出的边界投影到图像上存成图,并给出「线亮度得分」——投影点比左右各偏 14 像素处亮多少,数值为正说明投影压在画线上。
* 退出清理先停相机回调、再销毁自车。顺序反了会触发 CARLA 的 destroyed actor 异常并把进程打崩,这个问题排查了很久。

* feat(ground): 增加视觉与地图偏移的在线对照演示

* 为什么演示要同时算两路:这个模块的结论是「视觉能否替代地图」,只有同帧对照才能给出误差,单看视觉输出无法判断对错。
* 演示里加了三件事:预热若干帧避开出生点路口、地图给不出有效车道时跳过该帧、对视觉输出做一阶平滑。三者都会影响统计口径,所以全部写进文档。
* 记录模式把每帧叠上 HUD 存成 PNG,用来合成文档动图。

* feat(ground): 提供 ROS 2 节点与 launch 启动方式

* 为什么把节点做成一层薄封装:核心算法已经在纯 Python 里验证过,节点只负责驱动同步时钟、发布话题,出问题时能快速判断是算法还是通信的问题。
* 发布 offset / offset_map / state / event 四个话题,地图那一路只用于对照。
* launch 里的参数全部按字符串声明,避免 ros2 launch 传浮点数时的类型推断问题。

* feat(ground): 增加统一入口与离线自检

* 为什么保留自检:投影和偏移的符号错误在仿真里表现为「误差莫名其妙」,很难定位。自检用固定的相机位姿和世界点算一遍,把期望值写死,在 Windows 与虚拟机上都跑出同样的 0.076 m,能快速排除几何层的回归。
* 入口提供 probe / collect / train / demo / self-check 五个模式,参数集中在一处,避免文档和代码里的默认值对不上。

* feat(ground): 提交训练好的权重与验证指标

* 为什么把权重入库:别人克隆下来应该能直接跑 --demo 看效果,而不是先花八分钟采一遍数据再训练。权重 960 KB,比一张截图大不了多少。
* 同时提交 models/metrics.json,记录验证集上的误差,方便后续改动时对比是否退化。

* docs(ground): 补充视觉车道偏离预警的环境与运行说明

* 为什么写这么细:这条链路要跨 Windows 与虚拟机两个系统,连接地址、解释器版本、依赖安装任何一步错了都会卡住,而报错信息往往指向不到真正的原因。
* 把踩过的坑单列成表:carla 模块找不到、连接超时、destroyed actor、采不到帧,每条都给出可执行的判断方法。

* docs(ground): 增加视觉车道偏离预警的模块文档

* 文档覆盖几何推导、数据过滤、网络结构、状态机与实验结果,重点是把「视觉估计到底准不准」用数字讲清楚,而不是只放一张动图。
* 结果部分同时给出验证集与在线演示两套数字,并说明两者差异的来源:验证集来自同一批采集帧,演示跑的是之后的一段路。
* 已知限制单独一节,包括路口真值无定义、输入分辨率低、未做跨地图验证。

* docs(ground): 将视觉车道偏离预警接入文档导航与首页

* 为什么改两处:mkdocs 的导航决定左侧目录里能不能点到,首页的清单决定从入口页能不能找到,缺一处都会让模块变成孤儿页面。
* 首页条目写一句结论(直道平均误差 0.075 m 改为当前实测值),让读者不点进去也知道这个模块解决了什么问题。

* docs(ground): 加入视觉车道偏离预警的配图与演示动图

* 为什么动图压到 480 宽、64 色:原始 800x600 逐帧 PNG 合成的 GIF 有 13.8 MB,
  超过仓库对图片 5 MB 的限制,改小后 4.36 MB。
* 投影标注图用来证明内参和位姿的符号都对:绿点压在路面白线上,独立做平移搜索也只有约 1% 画面宽度的残差。
* 输入样本图直接取自训练集,按横向偏移排序,让读者看到网络真正吃进去的是什么。
* 三张统计图由 figures.py 从演示指标生成,文字全为英文,避免 matplotlib 缺中文字形。

* docs(ground): 修正 README 里的输入尺寸与训练参数

* 输入早先从 64x36 改成 32x128,README 里的网络规模和采集说明没跟着改,
  照原文跑会以为参数对不上。
* 训练轮数默认已是 120 轮并自动镜像扩增,删掉示例里写死的 30 轮。
* 补一句采集时五道过滤的丢弃原因,以及仓库内已附训练好的权重与其误差。

* fix(ground): 让 ros2 launch 能找到默认权重

* 原来 setup.py 没把 models 目录装进 share,权重只存在于源码目录,
  用 ros2 launch 从别处启动时 checkpoint 的默认值一定落空。
* 现在 weight 文件随包安装到 share/carla_visual_lane_departure_warning/models,
  节点在给定路径不存在时会去 share 目录再找一次,用绝对路径时按文件名找。
* 找不到 ament 索引的环境(比如直接跑 python 脚本)保持原行为,不会报错。

* fix(ground): 补 setup.cfg,把节点入口装到 lib 目录

* 没有 setup.cfg 时,console_scripts 会被装到 install/<包>/bin 而不是
  install/<包>/lib/<包>,ros2 launch 按后者查找可执行文件,直接报
  libexec directory does not exist。仓库里其他 ground 包都带这个文件。
* package.xml 补上 ament_index_python(节点用它定位 share 下的权重)
  与 python3-pillow(数据集与演示都要用)。

* fix(ground): 节点统计口径与演示对齐并修 Ctrl-C 退出

* 原来节点把每一帧都算进误差统计:路口帧的真值在两条车道间跳,
  停车帧的偏移不随时间变化,两者把 MAE 从 0.2 拉到 0.5,
  与 main.py --demo 的口径对不上。现在话题照常每帧发布,
  统计只计入车道宽合理、偏移不超限、车速不低于 1 m/s 且已过预热期的帧。
* rclpy.shutdown() 在 launch 已收到 SIGINT 的情况下会抛
  RCLError: rcl_shutdown already called,加 rclpy.ok() 判断。
* 新增 settle / min_speed / max_offset 三个参数,都有默认值,
  launch 不传也能正常启动。

* fix(ground): 帧数跑完后让节点自行退出

* 推理循环在后台线程里,跑完 --frames 只是线程结束,主线程仍停在
  rclpy.spin(),节点不会自己退出,rolling 起来要手动 Ctrl-C 才停。
* 在线程的 finally 里补一次 rclpy.shutdown(),并用 rclpy.ok() 判重,
  避免与 launch 的 SIGINT 重复关闭。

* docs(ground): 补充 launch 的实测输出与统计口径

* 验收时用 frames:=200 跑通了整条 launch 链路,把终端输出记进文档,
  读者能对照判断自己跑出来的结果算不算正常。
* 写明节点与 main.py --demo 的统计口径一致,以及为什么路口帧要排除。

* fix(docs): 修正导航条目缩进,恢复 mkdocs 构建

* 新增的那一行用了 2 个空格,同级条目都是 4 个,导致 mkdocs 在解析
  mkdocs.yml 时报 expected <block end>, but found '-',本地 serve 直接起不来。
* 改成与相邻条目一致的缩进。

* docs(ground): 精简开篇并把行内公式改成 \( \) 写法

* 开头那段「对应课程任务」加两段铺垫属于背景叙述,读者点进来是想知道
  这个模块怎么用、准不准,删掉只留一句功能描述。
* 行内公式原先写成 $...$,但仓库的 mdx_math 只对 $$ 块和 \( \) 生效,
  单美元符号会原样显示在页面上,30 处全部改成 \( \)。

* fix(ground): 车道偏移真值改用垂距,放开 max-offset,按 |e| 分档报精度

* 真值原来取「前方 10 m 边界中点」,弯道上这段弧的横向位移会整段算进偏移量:
  车摆在车道正中时,30 个路点里有 8 个超过 0.9 m,真值自己就先报 depart_enter。
  改成自车所在位置到中心线的垂距(dataset.lane_offset),采集过滤、在线演示和
  ROS 节点统一按这个口径。
* --max-offset 默认从 0.8 放宽到 1.6:0.8 比 depart_enter 还小,大偏移的帧全被
  算成 skipped,统计里只剩好做的样本。
* metrics 增加 evaluate_offsets 和按 |e| 分档(0.3/0.6/0.9/1.2/1.6 m),
  报告同时给出各档 MAE 与 RMSE。
* 网络回归目标仍是 10 m 处的边界,弯道上的视觉偏差要重训才能消掉,README 和
  教程已写明这个口径差异。

* fix(ground): 训练目标从 10 m 前瞻改成 5 m

上次采集出来的左右边界均值是 -2.32 / +1.13 m,车跟着车道中心开,标签却整体偏了
0.6 m:10 m 外的车道中心相对自车横向轴已经偏出一段弧,这段曲率位移被当成偏移学
进了网络。改成 5 m 后曲率项缩到约四分之一,和在线真值(垂距)的口径也对得上。

这次只改标签定义,权重需要重新采集与训练。

* feat(ground): 采集支持 --sway,主动左右摆采集大偏移样本

自动驾驶只会让车贴车道中心跑,采出来的标签几乎全是 ±1.75 m 的双边界,偏移恒等于
0。上一版验证集 MAE 只有 0.040 m,可在线摆动到 ±0.9 m 时预测还卡在 0 附近,MAE
0.529 m——网络学到的是「永远居中」,不是偏移。

采集循环里加和 --demo 同一套闭环摆动:先探出转向符号,再按正弦目标做比例控制,
每一拍都施加(被 --every 跳过的帧也不撒手),偏移覆盖到 ±sway。

* fix(ground): 车道宽改用地图值,采集支持强制变道

* 宽度过滤原来用「投影后的左右边界间距」,车一转向、一压线,投影间距就被拉长,
  摆动采集时 4000 帧里有 3930 帧被判成宽度异常,只剩 3 帧。改用 waypoint.lane_width。
* 采集加 --lane-change:车始终开在车道里,靠交通管理器的强制变道把偏移扫过
  0 -> ±1.75 -> 0,比强行摆动稳,也不会开上路肩。
* paint_score 在边界落到画面外时会取空切片,加个提前返回,避免 RuntimeWarning。

* fix(ground): 采集先落盘再清理,避免清理崩溃丢数据

变道采集跑完 4000 帧、留下 1821 帧之后,finally 里销毁 actor 时 CARLA 的 C++ 层
抛 trying to operate on a destroyed actor 并 abort,进程直接退出,np.savez 没来得及
执行,采到的数据全丢。Python 的 try/except 捕不到 C++ abort,只能把落盘提到清理之前。

* fix(ground): 汇总先输出再清理,避免 CARLA 清理崩溃吞掉报告

变道演示跑完 300 帧后,finally 里销毁 actor 时 CARLA 直接 abort,进程带着 demo 的
统计报告一起退出,数据全在内存里没打出来。把汇总和落盘都提到清理之前,清理崩了
也不影响已经产出的结果。

* docs(ground): 同步 5 m 标签与变道采集的实测数字

* 采集改为 --lane-change,4000 帧保留 2030 帧;训练目标改成 5 m 后左右边界均值不再
  对称(-1.98 / +1.49),说明标签里终于有非零偏移
* 验证集若干数字更新:MAE 0.122 m、p50 0.042 m、p90 0.265 m
* 在线变道演示换成 256 帧的真实结果:MAE 0.317 m,并补一张按 |e| 分档的表
* 事件对照改为匹配 0 / 误报 7 / 漏报 4,并说明跨线段是当前短板
* README 的采集与演示命令补上 --lane-change

* chore(ground): 更新用 5 m 标签重训的权重

20 次以上的失败尝试都出在采集侧:自动驾驶让车永远贴车道中心,标签几乎恒为 0,
网络学成「永远输出 0」。这版权重用 --lane-change 采集的 2030 帧重训,验证集横向
偏移 MAE 0.122 m(p50 0.042、p90 0.265),在线变道演示 0.317 m。
metrics.json 由同一次训练写出,source 指向 data/lane_dataset.npz。
* feat(air): 新增无人机载荷重心配平监测

* docs(air): 补充载荷重心 VM 实测截图

---------

Co-authored-by: Leclerc666 <917646819leclerc@gmail.com>
Co-authored-by: xingwunian <1377754734@qq.com>
* feat(ground):新增Carla小车在雨雾天气下的自适应感知降级策略

* feat(ground):新增Carla小车在雨雾天气下的自适应感知降级策略

* feat(ground):新增Carla小车在雨雾天气下的自适应感知降级策略

* feat(ground):新增Carla小车在雨雾天气下的自适应感知降级策略
* Create README.md

* Update README.md

* Create 1

* Add files via upload

* Delete docs/img/figure8_sim/1

* Create main.py

* Create figure8_sim.launch

* Create rviz_config.rviz

* Add files via upload

* Update figure8_sim.launch

* Update figure8_sim.launch

* Update README.md

* Update main.py

* Update CMakeLists.txt

* Update README.md

* Update package.xml

* Update figure8_sim.launch
* Create README.md

* Add files via upload

* Create robot_odom_sim

* Delete src/robot_odom_sim

* Create CMakeLists

* Delete src/robot_odom_sim directory

* Create CMakeLists

* Add files via upload

* Rename CMakeLists to CMakeLists.txt

* Create main.py

* Add files via upload

* Delete docs/auto_circle_sim directory

* Update README.md

* Delete src/auto_circle_sim directory

* Create robot_odom.launch

* Update CMakeLists.txt

* Update README.md

* Update package.xml

* Update README.md

* Update package.xml

* Implement velocity timeout and fix TF frame

Add timeout protection for velocity commands and update TF tree.

* Create robot_odom.rviz

* Add 'rviz' to launch directory installation

* Update robot_odom.launch

* Update README.md
…#1180)

* feat(ground): 新增 scene_object_layouter 包

* test(ground): 新增 scene_object_layouter 离线回归

* docs(ground): 在「生成对象」页面补上自主实现章节
* 肌肉骨骼人形机器人避障演示图

* Delete ROS Noetic Humble Gazebo 11-2026-10-13-23-27-40.png

* 小海龟边界感知自主避障(Turtlesim Boundary Avoidance)

* Delete ROS Noetic Humble Gazebo 11-2026-10-16-08-39-38.png

* feat: 基于串级PID的四旋翼航点定点悬停与抗风扰仿真

新增 src/air/quad_cascade_pid_hover_wind 模块:纯 Python 6 自由度四旋翼刚体动力学(四元数积分、电机一阶响应、推力/反扭矩混控),位置-姿态-角速率串级 PID 闭环,含恒定风、半正弦阵风与湍流扰动模型;提供一键实验、CSV 记录、真实运行图表/GIF 与 docs 页面。

* fix: 按评审意见修复四旋翼串级PID仿真的9项问题

- package.xml/setup.py 维护者改为真实姓名与邮箱,补 ament_index_python/python3-pil exec_depend
- 期望姿态改用 atan2 精确解算,去除小角度近似
- 混控限幅后按“保持总推力、等比缩放力矩”做推力重分配
- controller_node 改用固定步长 dt;nav_info 按时间间隔限频发布
- logger_node 删除冗余 /nav_info 空订阅
- position_pid 的 xy 增加小积分项(ki=0.3)消除风扰稳态误差
- results/ 运行产物移出版本库,新增包级 .gitignore
- main.py 的 LD_LIBRARY_PATH 改为前置追加而非覆盖
- config_loader 顶层导入 numpy;wrap_angle 改用 fmod;旋翼力矩计算向量化
- 文档统一 Python 3.10,指标按新实验更新,新增2项测试(15 passed)

* fix(air): 清理 _reallocate 冗余形参、修正 run_info.json status 顺序

- _reallocate 移除未使用的 thrusts 形参,调用处去掉多余的 np.clip;
  注释改为‘保持总推力、力矩等比缩放’,与实际算法一致(无伪逆)。
- logger_node.finish 中先置 self.status='finished' 再写 run_info.json,
  避免 run_info.json 的 status 与 status.json 的 finished 自相矛盾。
- test_thrust_reallocation_reduces_wrench_error 同步适配新签名,仅传 u。
- pytest 15 passed。

* fix(air): 第三轮评审——死代码、可行域对齐、限幅与幂等性

1. compute() 删除被 _reallocate 覆盖的死代码 thrusts = self.mixer @ u。
2. _reallocate 可行域改为 [k_f*min_omega^2, k_f*max_omega^2](当前
   [0.128, 3.872] N),与 thrust_to_omega 的转速裁剪对齐,避免重分配
   结果在接近下界时被再次改写导致总推力/力矩偏离。
3. _desired_attitude 姿态限幅由 ±0.5 rad(28.6°)放宽到 ±0.6 rad
   (34.4°),大于实测最大滚转/俯仰 31.0°/31.1°,消除限幅与文档
   实测数据的不自洽。
4. 期望竖直加速度下限统一为模块常量 MIN_FZ = 1e-3,compute 与
   _desired_attitude 两处一致(原 compute 用 1.0 无明确物理依据)。
5. logger_node finish() 增加幂等保护:status 已为 finished 时直接
   返回,避免 KeyboardInterrupt 路径重写 trajectory.csv/json。
6. test_controller.py fixture 改为直接从 config/params.yaml 加载增益,
   消除与实参的漂移(原 fixture 的 ki 仍为旧值 (0.0, 0.0, 0.4))。

测试:PYTHONPATH=. python3 -m pytest test/ -q → 15 passed。

* 按第四轮评审意见收敛参数来源与说明

- test_controller 改用 config_loader.build_params 构造机体参数,params.yaml
  中 quadcopter 段(mass/arm_length/k_f 等)改动会同步进测试,不再固定用
  QuadParams 默认值
- _reallocate 注释补充边界情况:thrust_des < 4*min_thrust 时 base 会被下限
  抬高,"保持总推力"不再严格成立,偏差上限即该下限
- 根 .gitignore 忽略 main.py 在仓库根创建的 build_quad_ws/,避免误提交
* Create main.py

* Delete src/gazebo_robot_steering/scrippts directory

* Add main script for Gazebo robot steering

* Add files via upload

* Create robot_steering.launch

* Create README.md for Gazebo robot steering

Add README for Gazebo robot steering project with setup instructions and usage steps.

* Add files via upload

* Delete docs/gazebo_robot_steering/mmexport1793981641466(1).gif

* Add files via upload

* Add files via upload

* Delete src/gazebo_robot_steering/robot_steering.launch

* Create robot_steering.launch

* Update CMakeLists.txt

* Update README.md

* Update package.xml

* Update main.py
* feat(ground): 新增 TurtleBot3 高精度定位与重定位(AMCL 式粒子滤波),含 2D 轻量版效果动图

* docs(ground): 添加高精度定位与重定位页面、首页链接与导航条目,动图入库 docs/img/ground

* fix(ground): 2D 重定位脚本 stdout 精简为 GIF 路径 + 末帧验收指标

- sim_2d_relocalization.py: stdout 仅打印 GIF 绝对路径,随后打印末帧
  key=value 验收指标 (state/err_amcl/err_odom/particle_spread/neff),
  便于不看图的复现者与 CI 核对;指标仍绘制在动图帧内,不再刷过程杂项;
- README 与 docs 运行节补充 stdout 语义说明,代码块去掉 bash 标记。

* fix(ground): OpenHUTB#771 按评审改入口名 main.py、修图片路径、补 ament 包并统一帧数

---------

Co-authored-by: zqhuang76 <zqhuang76@users.noreply.github.com>
* feat(humanoid_h1_walk): 新增 Unitree H1/H1_2 神经网络行走控制模块

课程任务「物理仿真 + 运动控制」:用 PPO 训练好的端到端策略驱动双足人形
行走、转向、后退,速度指令来自 /cmd_vel 或键盘。

- 机型:Unitree H1(10 自由度)、H1_2(12 自由度),此前仓库中未出现过
- 策略:LSTM(64) + FC(32) + ELU + FC(10/12),50 Hz 推理,纯 CPU
- ROS 2:sim_node(MuJoCo 物理 + 观测)与 policy_node(推理)拆分,
  话题 /joint_states、/odom、/humanoid/obs、/cmd_vel、/humanoid/joint_targets
- 入口:main.py --demo/--gui/--test/--compare/--gif/--ros
- 权重:weights/*.pt 共 284 KB,随仓库提供,无需联网下载

实测(本机 Windows,MuJoCo 3.16 + torch 2.14 CPU):
  h1   最低骨盆 1.00 m,前进 3.28 m,vx RMSE 0.101,CoT 0.34
  h1_2 最低骨盆 1.00 m,前进 2.52 m,vx RMSE 0.099,CoT 0.33
与上游 humanoid-walk 的 3.3 m / 2.5 m 一致,说明 ROS 双节点拆分未改变策略行为。

顺带修掉两个跨平台坑:MuJoCo mj_loadXML 与 torch.jit.load 在 Windows 下
按窄字符 fopen,绝对路径含中文会失败;已改为模型复制到临时 ASCII 目录、
权重读成字节流,中文工作区可直接运行。

文档:docs/humanoid/humanoid_h1_walk.md(含两机型动图、指标曲线、FAQ),
mkdocs 构建本页无 warning,公式以 script[type="math/tex; mode=display"] 输出。

* style(humanoid_h1_walk): 修正 flake8 告警(超长行、未使用变量)

flake8 --max-line-length=99 全通过;顺带把 rmse 抽成小函数、指标表头拆行。

* docs(humanoid_h1_walk): 补 Ubuntu/MuJoCo 3.3.7 实测与 ROS 2 链路验证

- 自检表加入 Ubuntu 22.04 + MuJoCo 3.3.7 结果,说明两个 MuJoCo 版本
  接触求解差异导致步幅相差约 10%,判定阈值两平台均通过
- 新增 6.5 节:colcon build、ros2 launch、/joint_states 49.999 Hz、
  /odom 与策略 0.50 ms/帧的实测输出
- README 同步补 6.4 实测小节

* chore(humanoid_h1_walk): 动图压到 5 MB 以内,符合 PR 模板要求

288×216 / 18 fps,两张动图 3.2 MB、3.3 MB(原 5.8/5.9 MB 超模板上限);
record_gif.py 默认参数同步调整。

* fix(humanoid_h1_walk): 补提交策略权重,解除 *.pt 全局忽略

PR OpenHUTB#971 复核指出:config/robots.yaml 引用的 weights/*.pt 不在提交里,
任何人 clone 后构造 Walker 都会 FileNotFoundError,模块实际跑不起来。

根因是仓库根 .gitignore 第 50 行有全局 `*.pt`,其他模块都加了白名单例外
(humanoid_ppo_locomotion、lidar_autoencoder_repair),本模块漏了。

- .gitignore 增加 !src/humanoid/humanoid_h1_walk/weights/*.pt
- 入库 h1_motion.pt(139,345 B)、h1_2_motion.pt(146,127 B),
  与上游 unitree_rl_gym deploy/pre_train/{h1,h1_2}/motion.pt 一致
- walker.py:缺 torch 时抛出带安装指引的 ImportError,不再只报 ModuleNotFoundError
- setup.py / package.xml:说明 torch 为运行时依赖但不写进 install_requires
  (避免 pip 拉 200 MB+ CUDA 版),README 已给 CPU 版安装命令

验证:干净克隆本分支后直接跑 scripts/smoke_walk.py 通过。

* fix(humanoid_h1_walk): 修复 package.xml 非法注释导致包不被识别

上一提交在 package.xml 里加的说明注释含 "pip install torch --index-url ...",
而 XML 注释中不允许出现 "--",catkin_pkg 解析直接报
"not well-formed (invalid token)"。

后果比注释本身严重:colcon 识别不出 ament_python 构建类型,退化成通用
python 包,于是不生成 share/<pkg>/hook/ament_prefix_path.dsh,
`source install/setup.bash` 后 AMENT_PREFIX_PATH 里没有本包,
`ros2 pkg prefix` / `ros2 launch` 全部报 Package not found。

- 注释改为不含连续双横线,指向 README 的安装命令
- 校验:ElementTree 解析通过;colcon list 恢复为 (ros.ament_python);
  install 下重新出现 ament_prefix_path 钩子,ros2 launch 正常起两节点

* docs(humanoid_h1_walk): 补权重校验信息与干净克隆复现记录

回应 PR OpenHUTB#971 复核意见,让审核员能自行核对提交内容:

- README / 文档页:给出两个 .pt 的精确字节数与 SHA-256,并说明与上游
  unitree_rl_gym@276801e4 的 deploy/pre_train/{h1,h1_2}/motion.pt 字节一致
- 文档页目录树注明 52 MB / 75 个 STL 全部被 scene.xml 引用(无冗余网格)
- 6.5 节补「从远端干净克隆复跑」的完整输出:colcon list 为
  (ros.ament_python)、ros2 pkg prefix 指向 install 前缀、weights 被 setup.py
  的 glob 安装进 share、robot:=h1_2 起两节点、/joint_states 49.99~50.00 Hz
- README 补一条排查提示:若 colcon 把包识别成 (python),说明 package.xml
  解析失败,此时不会生成 ament_prefix_path 钩子,launch 会报 Package not found

---------

Co-authored-by: non-compliant-nickname <non-compliant-nickname@users.noreply.github.com>
* Add files via upload

* Add files via upload

* Update mkdocs.yml

* Update index.md

* Add files via upload

* Add files via upload

* Add files via upload

* Add files via upload

* Update cmd_vel_guard_node.py

* Update cmd_vel_guard_node.py
* feat(air): 建立 uav_nn_perception_navigation 包骨架

声明 rospy/sensor_msgs/tf2_ros 等依赖,配置编译与安装规则,
补充模块说明文档。

* feat(air): 实现 AirSim 桥接节点

统一管理 AirSim 连接,完成三件事:
- 订阅 /uav/cmd_vel,按偏航角把机体速度旋到 NED 世界系后下发
- 以目标高度保持方式发送速度,避免无升降指令时下沉
- 发布 /uav/odom 与 odom->base_link 变换,完成 NED 到 ENU 转换
- 客户端调用加锁串行化,规避 msgpackrpc 多线程竞争

* feat(air): 新增键盘遥控节点

W/S 前后、A/D 左右、R/F 升降、Q/E 转向、空格急停,
通过 /uav/cmd_vel 下发 Twist 速度指令。

* feat(air): 新增统一入口 main.py

通过 --mode 参数分发到 teleop/perception/slam/end2end 等各功能节点,
便于后续按任务逐步扩展。

* feat(air): 补充键盘遥控启动文件与 AirSim 传感器配置

teleop.launch 一键启动桥接与键盘节点;
settings.json 配置多旋翼与 40 米量程激光雷达。

* feat(air): 新增激光雷达特征提取模块

把点云按视场角分成 12 个扇区,每扇区取最近点距离并按量程归一化;
再拼接目标相对量(距离、方位角正余弦、高度差)共 16 维。
训练与部署共用同一份实现,避免两边不一致。

* feat(air): 新增激光雷达感知节点

从 AirSim 读取 lidar_1 点云,发布两路数据:
- /uav/lidar/scan:标准 LaserScan,供 RViz 显示与 gmapping 建图
- /uav/lidar/features:12 维扇区距离,供控制节点推理

旋转式雷达每帧只返回一小段扫描,节点内累积 1 秒点云后再拼接成完整一圈;
建图扫描还支持从深度相机反投影生成(scan_source:=depth)。

* docs(air): 补充感知节点的话题与参数说明

* fix(air): 修正 LaserScan 左右镜像与多帧点云拼接

- extract_scan 角度取负:AirSim y 向右 -> ROS 逆时针为正,避免地图左右镜像
- 新增 transform_points_to_frame,把各帧点云按采集位姿转到当前机体系再拼接,
  解决无人机平移/转向时地图错位拖影
- 8 项单元测试覆盖角度约定与坐标变换

* feat(air): 新增神经网络控制器训练脚本

采用模仿学习:先用势场法专家在仿真中飞行采集 (雷达特征, 速度指令) 样本,
再训练三层 MLP 拟合专家策略。

- 专家策略:目标吸引力 + 障碍斥力,按最大速度 3 m/s 截断
- 特征标准化:按训练集均值方差归一化,随权重一并保存
- 数据打乱后按 85/15 划分训练集与验证集
- 碰撞状态下的样本自动丢弃,避免加入不可执行的样本

* feat(air): 添加训练好的 MLP 控制器权重

24 回合 x 120 步共 2880 个样本训练,验证损失 0.0026,权重 24 KB。
经标准状态比对,网络输出与专家策略几乎一致。

* docs(air): 补充神经网络控制器的训练说明与结果

* feat(air): 新增神经网络轨迹跟踪控制节点

订阅 /uav/lidar/features、/uav/odom 与 /uav/goal,加载训练好的 MLP,
按 16 维输入实时回归速度指令并发布到 /uav/cmd_vel。
控制律完全由网络给出,不含任何人工规则;数据未齐时保持静默,避免干扰起飞。

* feat(air): 新增感知与控制联调启动文件

perception.launch 一键启动桥接、雷达感知、神经网络控制与目标点发布,
便于验证「传感器感知 -> 神经网络 -> 运动控制」完整链路。

* docs(air): 补充神经网络自主飞行实测数据

* feat(air): 为神经网络控制器增加安全兜底与多场景评估

- 新增 safety_shield.py:NaN/Inf 悬停、传感器过期悬停、速度与偏航限幅、
  前向 1.2 m / 侧向 0.9 m 障碍屏蔽、0.5 m 硬悬停、偏航抖振阻尼
- trajectory_control.py 接入安全层,保留 safety_enabled 开关用于对照实验
- 新增 eval_multi_target.py:10 组起终点对的闭环评估,输出 CSV/JSON/逐步轨迹
- train_control.py 增加专家偏差统计(验证集 + 分布外扰动),写入 train_metrics.json
- 修正训练采集与评估脚本的机体系->世界系速度转换(与 airsim_bridge 一致)
- CMake:被 import 的模块改用 install(FILES),补 19 项单元测试

* docs(air): 补充多场景闭环验证与专家偏差数据

- eval_multi_target.py 支持 --pairs-file 自定义航线与 --inject-fault 故障注入
- 提交 10 组闭环结果(安全层开/关)、NaN 注入对照与汇总 JSON
- models/train_metrics.json:验证集与分布外扰动的网络-专家偏差统计
- README 补充 10 组逐条结果、对照组与偏差分析
* docs: add drone keyboard teleop guide

* docs(air_teleop): add simulator setup instructions

* docs(air_teleop): fix PowerShell simulator download command

* docs(air_teleop): consolidate duplicate teleop guide
* 火焰识别运行效果图

因本机虚拟机环境未接入图像数据源,未能实时获取图像数据,但节点本身的逻辑与通信机制已通过编译与运行验证。

* Flame Recognition Running Effect Diagram

因本机虚拟机环境未接入图像数据源,未能实时获取图像数据,但节点本身的逻辑与通信机制已通过编译与运行验证。

* Flame Recognition Running Effect Diagram

因本机虚拟机环境未接入图像数据源,未能实时获取图像数据,但节点本身的逻辑与通信机制已通过编译与运行验证。

* Create Flame_Smoke_Detection_Alarm.md

* 机器人自主避障与SLAM建图仿真图

原方案采用Carla仿真平台,受虚拟机性能限制无法部署Carla,因此选用Gazebo仿真环境与TurtleBot3机器人替代,完成图像感知、键盘遥控、SLAM建图以及自主避障功能验证。

* Create README.md

* Delete Autonomous Obstacle Avoidance Simulation of TurtleBot3 in Gazebo.png

* Delete Figure 2. TurtleBot3 Real-time SLAM Mapping in Gazebo and RViz.png

* Delete README.md

* Delete docs/README.md

* Create README.md

* Create fire_detect

* Delete src/chap5/fire_detect

* Vision Detection Node Startup Log

* Delete docs/Vision Detection Node Startup Log.png

* Delete Flame Recognition Running Effect Diagram.png

* Delete 火焰识别运行效果图.png

* Create privacy_mask_node.py

* Create __init__.py

* Create privacy_mask.launch.py

* Create privacy_mask

* Create package.xml

* Create setup.cfg

* Create setup.py

* Delete docs/Flame_Smoke_Detection_Alarm.md

* Create task_description.md

* Create demo

* Delete docs/demo

* Delete docs/task_description.md

* Create README.md

* Add files via upload

* Update README.md

* Update privacy_mask_node.py

* Update privacy_mask_node.py

* Update privacy_mask.launch.py

* Update setup.py

* Delete docs/task_description.md/privacy_mask_demo.gif

* Update README.md

* YOLOv8n行人检测结果

* YOLOv8n行人检测结果

* 高斯模糊隐私脱敏输出

* 高斯模糊隐私脱敏输出

* 原始输入图像

* Update README.md

* test.png

* Update setup.py

* Update privacy_mask_node.py

* Update package.xml

* Update README.md

* Update privacy_mask_node.py

* Update privacy_mask.launch.py

* Update setup.py

* Update setup.cfg

* Update package.xml

* Update package.xml

* Rename YOLOv8n行人检测结果.png to raw_input.png

* Rename raw_input.png to yolo_detection_result.png

* Rename 原始输入图像.png to raw_input.png

* Rename 高斯模糊隐私脱敏输出.png to masked_output.png

* Update README.md

* 补齐模型权重、文档迁移与导航入口

- resource 增加 yolov8n.pt,打包后离线可直接运行
- 文档迁移到 docs/privacy_mask,效果图改英文名,并把 3 MB 以上的图压缩到 1.8 MB
- 重写文档:修正分割模型与检测模型表述不一致、目录树格式与命令块语言标记
- mkdocs.yml、docs/index.md、docs/chapter/chap5.md 增加导航入口
- setup.py 维护者信息与 package.xml 对齐
- 还原根 README.md 的无关改动

* 同步主分支最新导航结构,解决与主分支的冲突

mkdocs.yml 与 docs/index.md 采用主分支最新版本,仅追加第 5 章子页面入口。

* 临时:恢复纯主分支版本用于定位冲突

* 同步主分支最新导航结构,解决与主分支的冲突

mkdocs.yml 与 docs/index.md 采用主分支最新版本,仅追加第 5 章子页面入口。

* revert: 还原根 README.md 的无关改动

* 清理冲突残留并修正文档与入口

- mkdocs.yml 删除冲突标记残留与重复的第 5 章条目
- docs/chapter/chap5.md 删掉冲突残留与重复标题,改为在主分支章节页追加模块入口,链接修正为 ../privacy_mask/README.md
- 新增 privacy_mask/main.py,console_scripts 指向 privacy_mask.main:main
- package.xml 去掉 TODO 注释,维护者信息补全
- blur_kernel 增加奇数校验,main() 同时捕获 cv2.error

* 将许可证改为 AGPL-3.0,与随包分发的 YOLOv8n 权重保持一致

- package.xml / setup.py 的 license 由 Apache-2.0 改为 AGPL-3.0
- docs/privacy_mask/README.md 增加许可证说明章节

* Update setup.py

* Update deploy_page.yml

* 修复评审问题:还原部署工作流、权重改为运行时获取

- 还原 .github/workflows/deploy_page.yml 为 master 原文(此前被误清空)
- 删除 resource/yolov8n.pt 二进制,文档改为官方下载链接/自动下载两种方式
- docs/privacy_mask/README.md 目录树补 main.py、许可证说明改为依赖 ultralytics
- setup.py maintainer 与 package.xml 统一

* 修复评审问题:launch 参数生效、发布频率与模糊强度

- launch 增加 DeclareLaunchArgument/OpaqueFunction,image_path/model_path/blur_kernel/publish_period 可命令行覆盖
- 节点启动时缓存 JPEG 编码,定时器仅刷新时间戳,实测可达设定频率
- blur_kernel 默认 0 表示按包围盒短边自适应,提升脱敏强度
- 移除过程性注释,新增 publish_period 合法性校验
- 文档同步参数说明与限制,删除与 resource/test.png 重复的 raw_input.png

* fix(docs): 恢复主分支第 6-10 章导航条目

解决冲突时误用了旧版 mkdocs.yml,导致主分支第 6/7/8/9 章结构与第 10 章入口丢失;
现以主分支最新导航为基础,仅保留第 5 章子目录与行人隐私脱敏入口。
同时修正章节页中权重随包安装的过期描述。

* test: 替换测试图片为干净的街景行人照片

原 test.png 是含 rqt_image_view 窗口与系统提示条的桌面截图,不适合作为测试输入;
改为 Ultralytics 官方示例图(810x1080,多名行人,无 UI 元素),同时把仓库体积从 1.7 MB 降到约 140 KB。

* test: 补充 flake8 代码风格检查

- 新增 test/test_flake8.py,使 package.xml 中声明的测试依赖与实际测试目录一致
- 移除未使用的 ament_copyright、ament_pep257 声明(包内无对应测试,且中文 docstring 与版权头不满足其默认校验)

* docs: 鏇存柊鏁堟灉鍥句负鏂版祴璇曞浘鐗囩殑瀹炴満缁撴灉

- 妫€娴嬬粨鏋滃浘鏀逛负鍩轰簬 resource/test.png锛堣鏅浜虹収鐗囷級鐨?YOLOv8n 杈撳嚭
- 鑴辨晱缁撴灉鍥炬敼涓哄悓涓€杈撳叆缁忚妭鐐瑰彂甯冨埌 /image_masked/compressed 鐨勫浘鍍廯n- 涓ゅ紶鍥惧潎宸茶鎺夌獥鍙f爣棰樻爮涓庡伐鍏锋爮锛屼粎淇濈暀鍥惧儚鍐呭

* fix(privacy_mask): ?? flake8 ??????????????

- ??????launch?setup.py ????????????,?? Q000;
- setup.py ?? UTF-8 BOM;
- README ? 5 ??????? yolov8n.pt ?? resource/ ? colcon build ? ???,
  ?????????????? 40-60s??????;
- README ???? test/ ? yolov8n.pt,?????????

* style(privacy_mask): __init__.py ???????????? W391 blank line at end of file

* style(privacy_mask): ???? flake8 ??(D400 ? I100)

- ?? docstring ??????????,?? 9 ? D400;
- ? ament_flake8 ? google ????? import,?? node ? test ? 1 ? I100;
- __init__.py ??????????,?? W391?
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.