手把手教你用MuJoCo XML构建一个闭链机器人模型（附完整代码）-平芜编程栈

从零构建MuJoCo闭链机器人：XML建模实战指南

闭链结构在仿人机器人、机械臂和四足机器人中极为常见，但许多初学者在MuJoCo中建模时总会遇到各种问题。本文将带你从零开始，用XML构建一个完整的闭链机器人模型，并解释每个关键参数的实际作用。

1. 闭链机器人建模基础

闭链机构的特点是存在运动学闭环，比如并联机械臂或四足机器人的腿部结构。与开链结构相比，闭链建模需要特别注意约束条件的处理。MuJoCo通过<equality>标签实现这一功能，这也是闭链建模的核心所在。

我们先来看一个典型闭链机器人的基本参数配置：

<mujoco model="closed_chain_robot"> <option timestep="0.001" integrator="RK4"/> <worldbody> <!-- 基础平台 --> <body name="base" pos="0 0 0.5"> <geom type="box" size="0.3 0.3 0.05" rgba="0.8 0.8 0.8 1"/> </body> </worldbody> </mujoco>

这个基础框架包含了MuJoCo模型的两个必要部分：<option>用于设置仿真参数，<worldbody>定义物理实体。其中：

timestep决定仿真精度，值越小越精确但计算量越大
integrator指定数值积分方法，RK4在精度和效率间取得较好平衡

2. 构建机器人主体结构

我们以四足机器人的单腿为例，展示如何构建闭链机构。典型的闭链腿由驱动电机、连杆和末端执行器组成。

2.1 定义驱动关节

<body name="base" pos="0 0 0.5"> <geom type="box" size="0.3 0.3 0.05"/> <!-- 髋关节驱动 --> <body name="hip" pos="0.1 0 0"> <joint name="hip_joint" type="hinge" axis="0 0 1"/> <geom type="cylinder" size="0.02 0.05" rgba="0 0 1 1"/> </body> </body>

这里创建了一个旋转关节(hinge)，关键参数包括：

type：关节类型，hinge表示旋转关节
axis：旋转轴方向，(0 0 1)表示绕Z轴旋转
pos：相对于父body的偏移位置

2.2 添加连杆结构

<body name="hip" pos="0.1 0 0"> <joint name="hip_joint" type="hinge" axis="0 0 1"/> <geom type="cylinder" size="0.02 0.05"/> <!-- 大腿连杆 --> <body name="thigh" pos="0 0 -0.1"> <joint name="knee_joint" type="hinge" axis="0 1 0"/> <geom type="capsule" fromto="0 0 0 0 0 -0.3" size="0.02"/> </body> </body>

使用fromto属性可以方便地定义胶囊体(连杆)的起点和终点，比单独指定位置和方向更直观。

3. 实现闭链约束

闭链建模的关键在于使用<equality>约束连接不同分支。以下是实现平行四边形闭链结构的代码：

<worldbody> <!-- 主驱动臂 --> <body name="drive_arm" pos="0 0 0.5"> <joint name="drive_joint" type="hinge" axis="0 0 1"/> <geom type="box" size="0.05 0.2 0.05"/> <!-- 从动臂A --> <body name="arm_A" pos="0 0.2 0"> <joint name="joint_A" type="slide" axis="0 1 0"/> <geom type="box" size="0.05 0.05 0.2"/> </body> <!-- 从动臂B --> <body name="arm_B" pos="0 -0.2 0"> <joint name="joint_B" type="slide" axis="0 1 0"/> <geom type="box" size="0.05 0.05 0.2"/> </body> </body> </worldbody> <equality> <connect body1="arm_A" body2="arm_B" anchor="0 0 0.2"/> </equality>

<connect>约束实现了两个从动臂在指定锚点的连接，形成闭环。主要参数：

body1和body2：要连接的两个body名称
anchor：连接点的全局坐标

4. 驱动系统配置

MuJoCo支持多种驱动模式，闭链机构通常使用力矩控制：

<actuator> <motor name="drive_motor" joint="drive_joint" gear="50" ctrlrange="-1 1"/> </actuator>

关键参数说明：

gear：传动比，放大输出力矩
ctrlrange：控制输入范围，[-1,1]对应最大反向和正向力矩
ctrllimited：是否限制控制输入

5. 完整闭链机器人模型

下面是一个完整的四足机器人单腿闭链模型示例：

<mujoco model="quadruped_leg"> <option timestep="0.001" integrator="RK4"/> <worldbody> <!-- 躯干 --> <body name="torso" pos="0 0 0.6"> <geom type="box" size="0.2 0.3 0.1"/> <!-- 右前腿 --> <body name="rf_hip" pos="0.2 0.15 0"> <joint name="rf_hip_joint" type="hinge" axis="0 0 1"/> <geom type="cylinder" size="0.03 0.05"/> <body name="rf_thigh" pos="0 0 -0.1"> <joint name="rf_knee_joint" type="hinge" axis="0 1 0"/> <geom type="capsule" fromto="0 0 0 0 0 -0.3" size="0.02"/> <body name="rf_calf" pos="0 0 -0.3"> <joint name="rf_ankle_joint" type="hinge" axis="0 1 0"/> <geom type="capsule" fromto="0 0 0 0.1 0 -0.1" size="0.02"/> </body> </body> </body> </body> <!-- 地面 --> <geom name="ground" type="plane" size="5 5 0.1" rgba="0.8 0.8 0.8 1"/> </worldbody> <equality> <connect body1="rf_thigh" body2="rf_calf" anchor="0.05 0 -0.2"/> </equality> <actuator> <motor name="rf_hip_motor" joint="rf_hip_joint" gear="100"/> <motor name="rf_knee_motor" joint="rf_knee_joint" gear="100"/> </actuator> </mujoco>

这个模型展示了：

完整的肢体层次结构
膝关节处的闭链约束
两个关节的驱动配置

6. 调试技巧与常见问题

闭链模型调试时最常见的问题是约束冲突导致仿真不稳定。以下是一些实用技巧：

约束力调整：

<equality> <connect body1="link1" body2="link2" anchor="0 0 0" solref="0.02 1"/> </equality>

solref参数调整约束硬度，第一个值越小约束越"软"

质量属性检查：
- 确保所有body都正确定义了<inertial>属性
- 质量分布不合理会导致仿真数值不稳定
可视化调试：
```
<visual> <global offwidth="1920" offheight="1080"/> </visual>
```
高分辨率可视化有助于发现细微的模型问题
仿真参数优化：
```
<option cone="elliptic" impratio="10" tolerance="1e-8"/>
```
这些高级参数可以改善复杂约束的求解稳定性