Skip to content

feat: 优化ROS关节状态发布逻辑,支持多自由度关节#3199

Closed
Vortex444 wants to merge 46 commits into
OpenHUTB:mainfrom
Vortex444:mujoco
Closed

feat: 优化ROS关节状态发布逻辑,支持多自由度关节#3199
Vortex444 wants to merge 46 commits into
OpenHUTB:mainfrom
Vortex444:mujoco

Conversation

@Vortex444

Copy link
Copy Markdown
Contributor

修改概述:

优化ros关节状态发布逻辑 支持多自由度关节

修改的详细描述

  1. 使用model.jnt_qposadr和model.jnt_dofadr获取每个非自由关节在qpos/qvel中的实际起始索引,替代原有的简单切片[:njnt],解决了自由关节(占用前 7 维)导致的关节数据错位问题。
  2. 记录每个关节的 ID,便于后续区分关节类型。
  3. 针对球关节(3 自由度)、铰链 / 滑动关节(1 自由度)分别处理,确保发布的关节位置 / 速度 / 力矩数据完整且对应正确。

经过了什么样的测试?

  1. ubuntu20.0
  2. Python3

运行效果

动图、视频、截图等
Uploading ScreenShot_2025-12-15_084657_176.png…

@Vortex444 Vortex444 closed this Dec 15, 2025
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.

1 participant