Repository navigation
feat(water): 新增 ROV 六推进器推力分配(ROS 1/catkin)模块 - #1154
Conversation
|
水域载具现有实验多从键盘控制、轨迹跟踪和感知出发,缺少把上层 力/力矩指令落到推进器上的分配环节;推进器饱和与单推进器故障时 会发生什么,也没有可复现的对比实验。 - 新增 src/water/rov_thruster_allocation_ros1:allocation.py 用推进器 布置矩阵的伪逆做最小二乘分配,支持 clamp/scale 两种饱和策略和单 推进器故障重构;main.py 订阅 /rov/wrench,发布 /rov/thruster_cmd 与 /rov/wrench_achieved;包含 launch、参数文件和离线验证脚本。 - 新增 docs/water/rov_thruster_allocation_ros1.md:布局与分配矩阵推导、 饱和/故障策略、话题接口、ROS 与离线运行、三张结果图和指标表。 - 首页与 mkdocs 导航加入口。 评审修复: - main.launch 移到 launch/main.launch,与 CMakeLists.txt 的 install(DIRECTORY launch config ...) 匹配; - package.xml 升级为 format="3",补充 <exec_depend>python3-numpy</exec_depend>; - 本地测试移到包内 test/ 目录; - master 已合入同名的 ROS 2 包 rov_thruster_allocation,为避免覆盖, ROS 1/catkin 实现更名为 rov_thruster_allocation_ros1; - 分支重建到最新 master,解决 docs/index.md 等文件冲突。 验证:离线验证在 Windows + Python 3.12 实际运行,正常任务分配残差约 1e-13%、最大推力 29.5 N;过载时 clamp 残差 82.56%、scale 残差 55.92%; T2 故障残差 15.15%。本地测试 42 项通过;mkdocs build 通过。ROS 端 未在本机实机验证(没有 ROS 与 ROV 仿真器),需在 Noetic + 仿真器上复验。
1b68453 to
f4716c6
Compare
|
已按评审意见修改并重新推送:
另外:当前 master 已合入一个同名的 ROS 2/ament 包 分支已重建到最新 master,PR 现在 |
修改目的与内容
水域载具现有实验多从键盘控制、轨迹跟踪和感知出发,缺少把上层「力/力矩指令」落到「各推进器推力」上的分配环节。推进器饱和、单推进器故障时会发生什么,也没有可复现的对比实验。本 PR 新增
rov_thruster_allocation,把这一层单独拆出来讲清楚。src/water/rov_thruster_allocation/:allocation.py由推进器布置构造 6×N 分配矩阵,用伪逆做最小二乘分配,支持clamp/scale两种饱和策略和单推进器故障重构;main.py订阅/rov/wrench,发布/rov/thruster_cmd与/rov/wrench_achieved;含main.launch、config/params.yaml、README.md和离线验证脚本。wrench_timeout(0.5 s)没有新的期望 wrench 时推进器归零;节点退出时同样归零。docs/water/rov_thruster_allocation.md:推进器布置、分配矩阵推导、伪逆、饱和与故障策略、话题接口、ROS 与离线运行步骤、三张结果图和指标表。docs/index.md与mkdocs.yml导航加入口。tests/test_rov_thruster_allocation_local.py:不依赖 ROS 的矩阵、分配、饱和、故障和工程文件检查。已知限制:只考虑几何分配,不含推进器非线性、死区和效率差异;布局横滚不可控(矩阵秩为 5);故障诊断本身不在本实验范围内;本机没有 ROS 与 ROV 仿真器,ROS 端实际运行尚未验证。
测试环境与结果
python src/water/rov_thruster_allocation/offline_sim.pypython tests/test_rov_thruster_allocation_local.pypython -m mkdocs buildpython -m mkdocs serve --dev-addr 127.0.0.1:8003 --livereloadcp -r src/water/rov_thruster_allocation ~/catkin_ws/src/ && cd ~/catkin_ws && catkin_make && source devel/setup.bash && roslaunch rov_thruster_allocation main.launchclamp残差 82.56%、水平力方向偏差 13.57°;scale残差 55.92%、比例 0.441、方向保持;mkdocs build通过(27.25 秒),新页面、导航和三张图片均返回 200;main.py在 ROS 中与 ROV 仿真器/实车的联调、catkin_make编译、main.launch启动。运行效果
正常任务下的推进器指令(上:4 个水平推进器,下:2 个垂直推进器):
正常工况下期望与可达 wrench(四个可控分量):
饱和与故障场景的相对残差:
三张图由
offline_sim.py在本机实际运行生成;ROS 端接入仿真器/实车后的效果待另一台机器复验后补充。提交前检查
git diff与 PR 页面均只有本模块的 15 个文件;分支基于最新 master,无冲突。)main.py、main.launch、package.xml、CMakeLists.txt已提供,依赖与安装路径已检查;但 README 的 ROS 运行步骤未在本机执行,因为本机没有 ROS,待另一台机器验证。)大模型使用声明