Mujoco仿真【xml文件的学习 4】

在学习Mujoco仿真的过程中，mujoco的版本要选择合适。先前我将mujoco的版本升级到了mujoco-3.1.4，在运行act的仿真代码时遇到了问题，撰写了博客：

Aloha机械臂的mujoco仿真问题记录-CSDN博客

下面在进行mujoco仿真时，统一安装如下包的版本：

pip install mujoco==2.3.7

pip install dm_control==1.0.14

好！承接上一篇博客：

Mujoco仿真【xml文件的学习 3】_mujoco打开xml文件-CSDN博客

下面我们继续来学习mujoco仿真中的xml文件，这次以一个实际的案例来学习别人编写好的xml文件，本次的案例为aloha的双臂仿真平台【sim_transfer_cube_scripted】：

其中vx300s_dependencies.xml文件代码：

<mujocoinclude><compiler angle="radian" inertiafromgeom="auto" inertiagrouprange="4 5"/><asset><mesh name="vx300s_1_base" file="vx300s_1_base.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_2_shoulder" file="vx300s_2_shoulder.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_3_upper_arm" file="vx300s_3_upper_arm.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_4_upper_forearm" file="vx300s_4_upper_forearm.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_5_lower_forearm" file="vx300s_5_lower_forearm.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_6_wrist" file="vx300s_6_wrist.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_7_gripper" file="vx300s_7_gripper.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_8_gripper_prop" file="vx300s_8_gripper_prop.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_9_gripper_bar" file="vx300s_9_gripper_bar.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_10_gripper_finger_left" file="vx300s_10_custom_finger_left.stl" scale="0.001 0.001 0.001" /><mesh name="vx300s_10_gripper_finger_right" file="vx300s_10_custom_finger_right.stl" scale="0.001 0.001 0.001" /></asset></mujocoinclude>

这段代码是一个 XML 格式的 Mujoco 模型文件的一部分，用于包含机器人手臂的模型文件和相关配置。以下是对其中各部分的详细解释：

<compiler>：编译器选项，用于设置模型的编译参数。
- angle="radian"：角度单位设置为弧度。
- inertiafromgeom="auto"：惯性矩从几何体自动计算。
- inertiagrouprange="4 5"：定义了惯性矩计算的组范围。
<asset>：模型的资源部分，包含了机器人手臂的各个部件的网格模型文件和相关配置。
- <mesh>：定义了多个网格模型文件，每个文件对应一个机器人手臂的部件，如基座、肩部、上臂等。每个 <mesh> 元素包含以下属性：
  - name：部件名称。
  - file：部件对应的 STL 格式的网格模型文件。
  - scale：模型缩放比例。

这段代码描述了一个包含机器人手臂各个部件模型文件的配置，用于构建机器人手臂的物理模拟环境。

其中vx300s_left.xml与vx300s_right.xml文件类似，我们选用vx300s_left.xml文件代码：


<mujocoinclude><body name="vx300s_left" pos="-0.469 0.5 0"><geom quat="0.707107 0 0 0.707107" type="mesh" mesh="vx300s_1_base" name="vx300s_left/1_base" contype="0" conaffinity="0" rgba="0.2 0.2 0.2 1" /><body name="vx300s_left/shoulder_link" pos="0 0 0.079"><inertial pos="0.000259233 -3.3552e-06 0.0116129" quat="-0.476119 0.476083 0.52279 0.522826" mass="0.798614" diaginertia="0.00120156 0.00113744 0.0009388" /><joint name="vx300s_left/waist" pos="0 0 0" axis="0 0 1" limited="true" range="-3.14158 3.14158" frictionloss="50" /><geom pos="0 0 -0.003" quat="0.707107 0 0 0.707107" type="mesh" mesh="vx300s_2_shoulder" name="vx300s_left/2_shoulder" rgba="0.2 0.2 0.2 1"/><body name="vx300s_left/upper_arm_link" pos="0 0 0.04805"><inertial pos="0.0206949 4e-10 0.226459" quat="0 0.0728458 0 0.997343" mass="0.792592" diaginertia="0.00911338 0.008925 0.000759317" /><joint name="vx300s_left/shoulder" pos="0 0 0" axis="0 1 0" limited="true" range="-1.85005 1.25664" frictionloss="60" /><geom quat="0.707107 0 0 0.707107" type="mesh" mesh="vx300s_3_upper_arm" name="vx300s_left/3_upper_arm" rgba="0.2 0.2 0.2 1"/><body name="vx300s_left/upper_forearm_link" pos="0.05955 0 0.3"><inertial pos="0.105723 0 0" quat="-0.000621631 0.704724 0.0105292 0.709403" mass="0.322228" diaginertia="0.00144107 0.00134228 0.000152047" /><joint name="vx300s_left/elbow" pos="0 0 0" axis="0 1 0" limited="true" range="-1.76278 1.6057" frictionloss="60" /><geom type="mesh" mesh="vx300s_4_upper_forearm" name="vx300s_left/4_upper_forearm" rgba="0.2 0.2 0.2 1"/><body name="vx300s_left/lower_forearm_link" pos="0.2 0 0"><inertial pos="0.0513477 0.00680462 0" quat="-0.702604 -0.0796724 -0.702604 0.0796724" mass="0.414823" diaginertia="0.0005911 0.000546493 0.000155707" /><joint name="vx300s_left/forearm_roll" pos="0 0 0" axis="1 0 0" limited="true" range="-3.14158 3.14158" frictionloss="30" /><geom quat="0 1 0 0" type="mesh" mesh="vx300s_5_lower_forearm" name="vx300s_left/5_lower_forearm" rgba="0.2 0.2 0.2 1"/><body name="vx300s_left/wrist_link" pos="0.1 0 0"><inertial pos="0.046743 -7.6652e-06 0.010565" quat="-0.00100191 0.544586 0.0026583 0.8387" mass="0.115395" diaginertia="5.45707e-05 4.63101e-05 4.32692e-05" /><joint name="vx300s_left/wrist_angle" pos="0 0 0" axis="0 1 0" limited="true" range="-1.8675 2.23402" frictionloss="30" /><geom quat="0.707107 0 0 0.707107" type="mesh" mesh="vx300s_6_wrist" name="vx300s_left/6_wrist" rgba="0.2 0.2 0.2 1"/><body name="vx300s_left/gripper_link" pos="0.069744 0 0"><body name="vx300s_left/camera_focus" pos="0.15 0 0.01"><site pos="0 0 0" size="0.01" type="sphere" name="left_cam_focus" rgba="0 0 1 0"/></body><site pos="0.15 0 0" size="0.003 0.003 0.03" type="box" name="cali_left_site1" rgba="0 0 1 0"/><site pos="0.15 0 0" size="0.003 0.03 0.003" type="box" name="cali_left_site2" rgba="0 0 1 0"/><site pos="0.15 0 0" size="0.03 0.003 0.003" type="box" name="cali_left_site3" rgba="0 0 1 0"/><camera name="left_wrist" pos="-0.1 0 0.16" fovy="20" mode="targetbody" target="vx300s_left/camera_focus"/><inertial pos="0.0395662 -2.56311e-07 0.00400649" quat="0.62033 0.619916 -0.339682 0.339869" mass="0.251652" diaginertia="0.000689546 0.000650316 0.000468142" /><joint name="vx300s_left/wrist_rotate" pos="0 0 0" axis="1 0 0" limited="true" range="-3.14158 3.14158" frictionloss="30" /><geom pos="-0.02 0 0" quat="0.707107 0 0 0.707107" type="mesh" mesh="vx300s_7_gripper" name="vx300s_left/7_gripper" rgba="0.2 0.2 0.2 1"/><geom pos="-0.020175 0 0" quat="0.707107 0 0 0.707107" type="mesh" mesh="vx300s_9_gripper_bar" name="vx300s_left/9_gripper_bar" rgba="0.2 0.2 0.2 1"/><body name="vx300s_left/gripper_prop_link" pos="0.0485 0 0"><inertial pos="0.002378 2.85e-08 0" quat="0 0 0.897698 0.440611" mass="0.008009" diaginertia="4.2979e-06 2.8868e-06 1.5314e-06" />
<!--                                    <joint name="vx300s_left/gripper" pos="0 0 0" axis="1 0 0" frictionloss="30" />--><geom pos="-0.0685 0 0" quat="0.707107 0 0 0.707107" type="mesh" mesh="vx300s_8_gripper_prop" name="vx300s_left/8_gripper_prop" rgba="0.2 0.2 0.2 1"/></body><body name="vx300s_left/left_finger_link" pos="0.0687 0 0"><inertial pos="0.017344 -0.0060692 0" quat="0.449364 0.449364 -0.54596 -0.54596" mass="0.034796" diaginertia="2.48003e-05 1.417e-05 1.20797e-05" /><joint name="vx300s_left/left_finger" pos="0 0 0" axis="0 1 0" type="slide" limited="true" range="0.021 0.057" frictionloss="30" /><geom condim="4" solimp="2 1 0.01" solref="0.01 1" friction="1 0.005 0.0001" pos="0.005 -0.052 0" euler="3.14 1.57 0" type="mesh" mesh="vx300s_10_gripper_finger_left" name="vx300s_left/10_left_gripper_finger" rgba="0.2 0.2 0.2 1"/></body><body name="vx300s_left/right_finger_link" pos="0.0687 0 0"><inertial pos="0.017344 0.0060692 0" quat="0.44937 -0.44937 0.545955 -0.545955" mass="0.034796" diaginertia="2.48002e-05 1.417e-05 1.20798e-05" /><joint name="vx300s_left/right_finger" pos="0 0 0" axis="0 1 0" type="slide" limited="true" range="-0.057 -0.021" frictionloss="30" /><geom condim="4" solimp="2 1 0.01" solref="0.01 1" friction="1 0.005 0.0001" pos="0.005 0.052 0" euler="3.14 1.57 0" type="mesh" mesh="vx300s_10_gripper_finger_right" name="vx300s_left/10_right_gripper_finger" rgba="0.2 0.2 0.2 1"/></body></body></body></body></body></body></body></body>
</mujocoinclude>

这段代码是一个 XML 格式的 Mujoco 模型文件的一部分，用于描述机器人手臂的模型和相关配置。以下是对其中各部分的详细解释：

<mujocoinclude>：用于包含另一个 Mujoco 模型文件的标签，这里包含了机器人手臂的模型和配置信息。
<body>：定义了机器人手臂的主体部分，包括了各个连接部件和其位置信息。
- name="vx300s_left"：机器人手臂的名称。
- pos="-0.469 0.5 0"：机器人手臂的位置。
<geom>：定义了机器人手臂的几何形状，通常用于可视化和碰撞检测。
- quat="0.707107 0 0 0.707107"：指定了几何体的旋转四元数。
- type="mesh"：指定了几何体的类型为网格。
- mesh="vx300s_1_base"：指定了该几何体所使用的网格模型。
- rgba="0.2 0.2 0.2 1"：指定了几何体的颜色。
<inertial>：定义了每个连接部件的惯性参数。
- pos：惯性中心的位置。
- quat：惯性矩阵的旋转四元数。
- mass：部件的质量。
- diaginertia：惯性矩阵的对角线元素。
<joint>：定义了连接部件之间的关节。
- name：关节的名称。
- pos：关节的位置。
- axis：关节的旋转轴。
- limited="true"：表示关节是否有限制。
- range：关节的运动范围。
- frictionloss：关节的摩擦损失。
<site>：定义了站位点，用于可视化和其他用途。
- pos：站位点的位置。
- size：站位点的大小。
- type：站位点的类型。
<camera>：定义了摄像机，用于模拟环境的观察。
- name：摄像机的名称。
- pos：摄像机的位置。
- fovy：摄像机的视场角。
- mode="targetbody"：摄像机的模式，以指定的物体为目标。
<geom>：定义了机器人手臂的各个连接部件的几何形状。
- quat：指定了几何体的旋转四元数。
- type="mesh"：指定了几何体的类型为网格。
- mesh：指定了该几何体所使用的网格模型。
- rgba：指定了几何体的颜色。

这段代码描述了一个机器人手臂的模型和配置信息，包括了各个连接部件的几何形状、惯性参数、关节、站位点以及摄像机等元素。

其中scene.xml文件代码：

<mujocoinclude>
<!--    <option timestep='0.0025' iterations="50" tolerance="1e-10" solver="Newton" jacobian="dense" cone="elliptic"/>--><asset><mesh file="tabletop.stl" name="tabletop" scale="0.001 0.001 0.001"/><!-- floor --><texture type="skybox" builtin="gradient" rgb1="0.3 0.5 0.7" rgb2="0 0 0" width="512" height="3072"/><texture type="2d" name="groundplane" builtin="checker" mark="edge" rgb1="0.2 0.3 0.4" rgb2="0.1 0.2 0.3"markrgb="0.8 0.8 0.8" width="300" height="300"/><material name="groundplane" texture="groundplane" texuniform="true" texrepeat="5 5" reflectance="0.2"/></asset><visual><map fogstart="1.5" fogend="5" force="0.1" znear="0.1"/><quality shadowsize="4096" offsamples="4"/>
<!--        <headlight ambient="0.4 0.4 0.4"/>--><headlight diffuse="0.6 0.6 0.6" ambient="0.3 0.3 0.3" specular="0 0 0"/><rgba haze="0.15 0.25 0.35 1"/><global azimuth="140" elevation="-30"/></visual><worldbody><!-- default castshadow = "false" --><light castshadow="true" directional='true' diffuse='.3 .3 .3' specular='0.3 0.3 0.3' pos='-1 -1 1'dir='1 1 -1'/><light directional='true' diffuse='.3 .3 .3' specular='0.3 0.3 0.3' pos='1 -1 1' dir='-1 1 -1'/><light castshadow="true" directional='true' diffuse='.3 .3 .3' specular='0.3 0.3 0.3' pos='0 1 1'dir='0 -1 -1'/><!-- floor --><body name="floor" pos="0 0 -0.001"><geom name="floor" size="0 0 0.01" type="plane" material="groundplane"/></body><body name="table" pos="0 .6 0"><geom group="1" mesh="tabletop" pos="0 0 0" type="mesh" conaffinity="1" contype="1" name="table" rgba="0.2 0.2 0.2 1" /></body><body name="midair" pos="0 .6 0.2"><site pos="0 0 0" size="0.01" type="sphere" name="midair" rgba="1 0 0 0"/></body><camera name="left_pillar" pos="-0.5 0.2 0.6" fovy="78" mode="targetbody" target="table"/><camera name="right_pillar" pos="0.5 0.2 0.6" fovy="78" mode="targetbody" target="table"/><camera name="top" pos="0 0.6 0.8" fovy="78" mode="targetbody" target="table"/><camera name="angle" pos="0 0 0.6" fovy="78" mode="targetbody" target="table"/><camera name="front_close" pos="0 0.2 0.4" fovy="78" mode="targetbody" target="vx300s_left/camera_focus"/></worldbody></mujocoinclude>

这段代码是一个 XML 格式的 Mujoco 模型文件的一部分，用于描述一个模拟环境中的物体、光源和相机等元素。以下是对其中各部分的详细解释：

<mujocoinclude>：Mujoco 模型文件的包含标签，用于将其他文件的内容包含到当前文件中。
<asset>：模型的资源部分，定义了模型中使用的各种资产，如网格、纹理和材质。
- <mesh>：指定了一个网格文件作为桌面，定义了它的名称和缩放比例。
- <texture>：定义了两种类型的纹理：
  - "skybox"：用于模拟天空的渐变效果。
  - "2d"：用于地面的棋盘格纹理，包括颜色、尺寸和边缘标记。
- <material>：定义了地面的材质，引用了前面定义的地面纹理，并设置了反射率和纹理重复参数。
<visual>：模型的可视化部分，用于定义模拟环境中的视觉效果。
- <map>：定义了雾化效果的参数，包括起始和结束位置以及力度。
- <quality>：设置了阴影和抗锯齿的参数。
- <headlight>：设置了头灯的参数，包括漫反射、环境光和高光。
- <rgba>：设置了雾化效果的颜色。
- <global>：设置了全局光照的方向。
<worldbody>：模型的世界部分，定义了模拟环境中的物体、光源和相机等元素。
- <light>：定义了三个光源，包括其类型、漫反射和高光等参数。
- <body>：定义了模拟环境中的物体，包括桌面和悬空的物体。
  - 桌面：由一个平面几何体组成，使用前面定义的地面材质。
  - 悬空的物体：这里只是一个站位点，未指定具体的几何形状。
- <camera>：定义了多个摄像机，包括其位置、视场角和模式等参数。其中，mode="targetbody" 表示摄像机会以指定的物体为目标，视角随之调整。

这个模型文件描述了一个简单的模拟环境，其中包括一个桌面、一个悬空的物体和多个摄像机，用于模拟不同视角的变化。

其中bimanual_viperx_ee_transfer_cube.xml文件代码：

<mujoco><include file="scene.xml"/><include file="vx300s_dependencies.xml"/><equality><weld body1="mocap_left" body2="vx300s_left/gripper_link" solref="0.01 1" solimp=".25 .25 0.001" /><weld body1="mocap_right" body2="vx300s_right/gripper_link" solref="0.01 1" solimp=".25 .25 0.001" /></equality><worldbody><include file="vx300s_left.xml" /><include file="vx300s_right.xml" /><body mocap="true" name="mocap_left" pos="0.095 0.50 0.425"><site pos="0 0 0" size="0.003 0.003 0.03" type="box" name="mocap_left_site1" rgba="1 0 0 1"/><site pos="0 0 0" size="0.003 0.03 0.003" type="box" name="mocap_left_site2" rgba="1 0 0 1"/><site pos="0 0 0" size="0.03 0.003 0.003" type="box" name="mocap_left_site3" rgba="1 0 0 1"/></body><body mocap="true" name="mocap_right" pos="-0.095 0.50 0.425"><site pos="0 0 0" size="0.003 0.003 0.03" type="box" name="mocap_right_site1" rgba="1 0 0 1"/><site pos="0 0 0" size="0.003 0.03 0.003" type="box" name="mocap_right_site2" rgba="1 0 0 1"/><site pos="0 0 0" size="0.03 0.003 0.003" type="box" name="mocap_right_site3" rgba="1 0 0 1"/></body><body name="box" pos="0.2 0.5 0.05"><joint name="red_box_joint" type="free" frictionloss="0.01" /><inertial pos="0 0 0" mass="0.05" diaginertia="0.002 0.002 0.002" /><geom condim="4" solimp="2 1 0.01" solref="0.01 1" friction="1 0.005 0.0001" pos="0 0 0" size="0.02 0.02 0.02" type="box" name="red_box" rgba="1 0 0 1" /></body></worldbody><actuator><position ctrllimited="true" ctrlrange="0.021 0.057" joint="vx300s_left/left_finger" kp="200"  user="1"/><position ctrllimited="true" ctrlrange="-0.057 -0.021" joint="vx300s_left/right_finger" kp="200"  user="1"/><position ctrllimited="true" ctrlrange="0.021 0.057" joint="vx300s_right/left_finger" kp="200"  user="1"/><position ctrllimited="true" ctrlrange="-0.057 -0.021" joint="vx300s_right/right_finger" kp="200"  user="1"/></actuator><keyframe><key qpos="0 -0.96 1.16 0 -0.3 0 0.024 -0.024  0 -0.96 1.16 0 -0.3 0 0.024 -0.024  0.2 0.5 0.05 1 0 0 0"/></keyframe></mujoco>

这段代码是一个完整的 Mujoco 模型文件，描述了一个模拟环境中的物体、关节、动作控制器等元素。让我们逐个解释其中的内容：

<include file="scene.xml"/> 和 <include file="vx300s_dependencies.xml"/>：引用了其他两个 XML 文件，将它们的内容包含到当前文件中。
<equality>：定义了两个关节的约束，使得两个物体固定在一起。
- <weld>：将两个物体通过关节连接在一起，设置了约束参数如刚度和阻尼等。
<worldbody>：模型的世界部分，定义了模拟环境中的各种物体。
- <include file="vx300s_left.xml" /> 和 <include file="vx300s_right.xml" />：引用了两个 XML 文件，将机器人的左臂和右臂的模型包含进来。
- <body mocap="true" name="mocap_left" pos="0.095 0.50 0.425"> 和 <body mocap="true" name="mocap_right" pos="-0.095 0.50 0.425">：定义了两个虚拟的 mocap 体，用于捕捉运动数据。
- <body name="box" pos="0.2 0.5 0.05">：定义了一个名为 box 的物体，用于模拟一个红色的盒子。
  - <joint name="red_box_joint" type="free" frictionloss="0.01" />：定义了盒子的关节类型为自由关节，并设置了摩擦损耗。
  - <inertial pos="0 0 0" mass="0.05" diaginertia="0.002 0.002 0.002" />：定义了盒子的惯性属性，包括质量和惯性张量。
  - <geom condim="4" solimp="2 1 0.01" solref="0.01 1" friction="1 0.005 0.0001" pos="0 0 0" size="0.02 0.02 0.02" type="box" name="red_box" rgba="1 0 0 1" />：定义了盒子的几何形状和纹理颜色等属性。
<actuator>：定义了动作控制器，用于控制机器人的手指关节的运动。
- <position ctrllimited="true" ctrlrange="0.021 0.057" joint="vx300s_left/left_finger" kp="200" user="1"/> 和 <position ctrllimited="true" ctrlrange="-0.057 -0.021" joint="vx300s_left/right_finger" kp="200" user="1"/>：控制左臂机器人手指的位置。
- <position ctrllimited="true" ctrlrange="0.021 0.057" joint="vx300s_right/left_finger" kp="200" user="1"/> 和 <position ctrllimited="true" ctrlrange="-0.057 -0.021" joint="vx300s_right/right_finger" kp="200" user="1"/>：控制右臂机器人手指的位置。
<keyframe>：定义了一个关键帧，指定了各个关节的位置。
- <key qpos="0 -0.96 1.16 0 -0.3 0 0.024 -0.024 0 -0.96 1.16 0 -0.3 0 0.024 -0.024 0.2 0.5 0.05 1 0 0 0"/>：指定了各个关节的位置信息，用于模拟开始时的初始状态。
- qpos：这个属性定义了关节的位置。它包含了多个数值，每两个数值代表一个关节的位置信息。在这个关键帧中，一共有六个关节，因此包含了 6*2=12 个数值。
- 这些数值代表了每个关节的位置或方向。例如，0 -0.96 1.16 0 -0.3 0 描述了左臂的一组关节位置，0.024 -0.024 描述了右臂手指的位置，0.2 0.5 0.05 描述了盒子的位置，1 0 0 0 描述了盒子的方向。