cyy/go2_rl_robotlab
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

feat: add Go1 training and MuJoCo deployment

Browse Source
This commit is contained in:
youyuan.chen
2026-07-26 00:40:06 +08:00
parent 28b4516d22
commit 0d2afbf2bb
26 changed files with 2378 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

696
resources/go1/boxes.xml Normal file
View File

@@ -0,0 +1,696 @@
<mujoco model="boxes">
<include file="go1.xml" />
<statistic center="0 0 0.1" extent="0.8" />
<visual>
<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="-130" elevation="-20" />
</visual>
<asset>
<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>
<worldbody>
<light pos="0 0 1.5" dir="0 0 -1" directional="true" />
<geom name="floor" size="0 0 0.05" type="plane" material="groundplane" />
<!-- Rough terrain: full coverage with dense bumps -->
<geom pos="0.5 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="0.8 -2.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="1.1 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="1.4 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="1.7 -2.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.0 -2.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.3 -2.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.6 -2.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="2.9 -2.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="3.2 -2.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="3.5 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.8 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="4.1 -2.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="4.4 -2.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="4.7 -2.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="5.0 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.3 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="5.6 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.9 -2.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.2 -2.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="6.5 -2.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.8 -2.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="7.1 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="7.4 -2.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.7 -2.0 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="8.0 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="8.3 -2.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.6 -2.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.9 -2.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="9.2 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="9.5 -2.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="9.8 -2.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="10.1 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="10.4 -2.0 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="10.7 -2.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="11.0 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.3 -2.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.6 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.9 -2.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="12.2 -2.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="12.5 -2.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="12.8 -2.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="13.1 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.4 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.7 -2.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="14.0 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="14.3 -2.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="14.6 -2.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="0.5 -1.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="0.8 -1.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="1.1 -1.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="1.4 -1.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="1.7 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="2.0 -1.7 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="2.3 -1.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.6 -1.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="2.9 -1.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="3.2 -1.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="3.5 -1.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="3.8 -1.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.1 -1.7 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="4.4 -1.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="4.7 -1.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.0 -1.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="5.3 -1.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="5.6 -1.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="5.9 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="6.2 -1.7 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="6.5 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="6.8 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="7.1 -1.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.4 -1.7 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="7.7 -1.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="8.0 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="8.3 -1.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.6 -1.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="8.9 -1.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="9.2 -1.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="9.5 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="9.8 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="10.1 -1.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="10.4 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="10.7 -1.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.0 -1.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.3 -1.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="11.6 -1.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="11.9 -1.7 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="12.2 -1.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="12.5 -1.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="12.8 -1.7 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="13.1 -1.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="13.4 -1.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="13.7 -1.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="14.0 -1.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="14.3 -1.7 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="14.6 -1.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="0.5 -1.4 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="0.8 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="1.1 -1.4 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="1.4 -1.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="1.7 -1.4 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="2.0 -1.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.3 -1.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.6 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="2.9 -1.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.2 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="3.5 -1.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="3.8 -1.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.1 -1.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.4 -1.4 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="4.7 -1.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="5.0 -1.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="5.3 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.6 -1.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.9 -1.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.2 -1.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.5 -1.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="6.8 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="7.1 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="7.4 -1.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.7 -1.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.0 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.3 -1.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.6 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.9 -1.4 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="9.2 -1.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="9.5 -1.4 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="9.8 -1.4 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="10.1 -1.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="10.4 -1.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="10.7 -1.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="11.0 -1.4 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="11.3 -1.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.6 -1.4 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="11.9 -1.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="12.2 -1.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="12.5 -1.4 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="12.8 -1.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="13.1 -1.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="13.4 -1.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="13.7 -1.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="14.0 -1.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="14.3 -1.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="14.6 -1.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="0.5 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="0.8 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="1.1 -1.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="1.4 -1.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="1.7 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="2.0 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="2.3 -1.1 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="2.6 -1.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.9 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="3.2 -1.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="3.5 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="3.8 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="4.1 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="4.4 -1.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="4.7 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="5.0 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="5.3 -1.1 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="5.6 -1.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.9 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="6.2 -1.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.5 -1.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.8 -1.1 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="7.1 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="7.4 -1.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="7.7 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.0 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.3 -1.1 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="8.6 -1.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.9 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="9.2 -1.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="9.5 -1.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="9.8 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="10.1 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="10.4 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="10.7 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="11.0 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="11.3 -1.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.6 -1.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.9 -1.1 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="12.2 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="12.5 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="12.8 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.1 -1.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="13.4 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.7 -1.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="14.0 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="14.3 -1.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="14.6 -1.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="0.5 -0.8 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="0.8 -0.8 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="1.1 -0.8 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="1.4 -0.8 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="1.7 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="2.0 -0.8 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="2.3 -0.8 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="2.6 -0.8 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.9 -0.8 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="3.2 -0.8 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="3.5 -0.8 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="3.8 -0.8 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="4.1 -0.8 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.4 -0.8 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="4.7 -0.8 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="5.0 -0.8 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="5.3 -0.8 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="5.6 -0.8 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="5.9 -0.8 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="6.2 -0.8 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="6.5 -0.8 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="6.8 -0.8 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="7.1 -0.8 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="7.4 -0.8 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="7.7 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.0 -0.8 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.3 -0.8 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.6 -0.8 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="8.9 -0.8 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="9.2 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="9.5 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="9.8 -0.8 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="10.1 -0.8 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="10.4 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="10.7 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.0 -0.8 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.3 -0.8 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="11.6 -0.8 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="11.9 -0.8 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="12.2 -0.8 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="12.5 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="12.8 -0.8 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="13.1 -0.8 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.4 -0.8 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="13.7 -0.8 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="14.0 -0.8 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="14.3 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="14.6 -0.8 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="0.5 -0.5 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="0.8 -0.5 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="1.1 -0.5 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="1.4 -0.5 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="1.7 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="2.0 -0.5 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.3 -0.5 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="2.6 -0.5 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="2.9 -0.5 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="3.2 -0.5 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.5 -0.5 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.8 -0.5 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="4.1 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="4.4 -0.5 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.7 -0.5 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="5.0 -0.5 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="5.3 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.6 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.9 -0.5 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="6.2 -0.5 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="6.5 -0.5 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.8 -0.5 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="7.1 -0.5 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="7.4 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.7 -0.5 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="8.0 -0.5 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.3 -0.5 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.6 -0.5 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="8.9 -0.5 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="9.2 -0.5 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="9.5 -0.5 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="9.8 -0.5 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="10.1 -0.5 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="10.4 -0.5 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="10.7 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="11.0 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="11.3 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="11.6 -0.5 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.9 -0.5 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="12.2 -0.5 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="12.5 -0.5 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="12.8 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="13.1 -0.5 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="13.4 -0.5 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.7 -0.5 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="14.0 -0.5 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="14.3 -0.5 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="14.6 -0.5 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="0.5 -0.2 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="0.8 -0.2 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="1.1 -0.2 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="1.4 -0.2 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="1.7 -0.2 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="2.0 -0.2 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="2.3 -0.2 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.6 -0.2 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="2.9 -0.2 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="3.2 -0.2 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="3.5 -0.2 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="3.8 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="4.1 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="4.4 -0.2 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="4.7 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="5.0 -0.2 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.3 -0.2 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.6 -0.2 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.9 -0.2 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="6.2 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.5 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.8 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="7.1 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="7.4 -0.2 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.7 -0.2 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="8.0 -0.2 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.3 -0.2 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.6 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="8.9 -0.2 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="9.2 -0.2 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="9.5 -0.2 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="9.8 -0.2 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="10.1 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="10.4 -0.2 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="10.7 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.0 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.3 -0.2 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="11.6 -0.2 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.9 -0.2 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="12.2 -0.2 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="12.5 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="12.8 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="13.1 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="13.4 -0.2 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.7 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="14.0 -0.2 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="14.3 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="14.6 -0.2 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="0.5 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="0.8 0.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="1.1 0.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="1.4 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="1.7 0.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.0 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="2.3 0.1 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="2.6 0.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="2.9 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.2 0.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="3.5 0.1 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="3.8 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="4.1 0.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="4.4 0.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.7 0.1 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="5.0 0.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.3 0.1 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="5.6 0.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.9 0.1 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="6.2 0.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="6.5 0.1 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="6.8 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="7.1 0.1 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.4 0.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="7.7 0.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.0 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="8.3 0.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.6 0.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.9 0.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="9.2 0.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="9.5 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="9.8 0.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="10.1 0.1 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="10.4 0.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="10.7 0.1 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.0 0.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.3 0.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.6 0.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.9 0.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="12.2 0.1 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="12.5 0.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="12.8 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.1 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.4 0.1 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="13.7 0.1 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="14.0 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="14.3 0.1 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="14.6 0.1 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="0.5 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="0.8 0.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="1.1 0.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="1.4 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="1.7 0.4 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="2.0 0.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.3 0.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.6 0.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="2.9 0.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.2 0.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="3.5 0.4 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="3.8 0.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="4.1 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.4 0.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="4.7 0.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="5.0 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="5.3 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="5.6 0.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.9 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="6.2 0.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.5 0.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.8 0.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.1 0.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.4 0.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="7.7 0.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.0 0.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="8.3 0.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="8.6 0.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.9 0.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="9.2 0.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="9.5 0.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="9.8 0.4 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="10.1 0.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="10.4 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="10.7 0.4 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.0 0.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="11.3 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="11.6 0.4 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.9 0.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="12.2 0.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="12.5 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="12.8 0.4 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.1 0.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="13.4 0.4 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="13.7 0.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="14.0 0.4 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="14.3 0.4 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="14.6 0.4 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="0.5 0.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="0.8 0.7 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="1.1 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="1.4 0.7 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="1.7 0.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="2.0 0.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.3 0.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="2.6 0.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.9 0.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="3.2 0.7 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="3.5 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="3.8 0.7 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="4.1 0.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="4.4 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="4.7 0.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="5.0 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.3 0.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="5.6 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.9 0.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.2 0.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="6.5 0.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="6.8 0.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="7.1 0.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="7.4 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="7.7 0.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.0 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.3 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.6 0.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="8.9 0.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="9.2 0.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="9.5 0.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="9.8 0.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="10.1 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="10.4 0.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="10.7 0.7 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="11.0 0.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.3 0.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.6 0.7 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="11.9 0.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="12.2 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="12.5 0.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="12.8 0.7 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="13.1 0.7 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="13.4 0.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="13.7 0.7 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="14.0 0.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="14.3 0.7 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="14.6 0.7 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="0.5 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="0.8 1.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="1.1 1.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="1.4 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="1.7 1.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.0 1.0 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="2.3 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="2.6 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.9 1.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="3.2 1.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="3.5 1.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.8 1.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="4.1 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.4 1.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="4.7 1.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="5.0 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="5.3 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="5.6 1.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.9 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="6.2 1.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="6.5 1.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="6.8 1.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="7.1 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="7.4 1.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="7.7 1.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="8.0 1.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.3 1.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.6 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="8.9 1.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="9.2 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="9.5 1.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="9.8 1.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="10.1 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="10.4 1.0 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="10.7 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.0 1.0 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.3 1.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="11.6 1.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="11.9 1.0 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="12.2 1.0 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="12.5 1.0 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="12.8 1.0 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.1 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="13.4 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="13.7 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="14.0 1.0 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="14.3 1.0 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="14.6 1.0 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="0.5 1.3 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="0.8 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="1.1 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="1.4 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="1.7 1.3 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="2.0 1.3 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="2.3 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.6 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.9 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="3.2 1.3 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="3.5 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="3.8 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="4.1 1.3 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="4.4 1.3 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="4.7 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.0 1.3 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="5.3 1.3 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="5.6 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="5.9 1.3 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="6.2 1.3 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="6.5 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="6.8 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="7.1 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="7.4 1.3 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="7.7 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.0 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.3 1.3 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="8.6 1.3 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="8.9 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="9.2 1.3 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="9.5 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="9.8 1.3 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="10.1 1.3 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="10.4 1.3 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="10.7 1.3 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.0 1.3 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="11.3 1.3 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.6 1.3 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="11.9 1.3 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="12.2 1.3 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="12.5 1.3 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="12.8 1.3 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="13.1 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="13.4 1.3 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="13.7 1.3 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="14.0 1.3 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="14.3 1.3 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="14.6 1.3 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="0.5 1.6 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="0.8 1.6 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="1.1 1.6 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="1.4 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="1.7 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="2.0 1.6 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.3 1.6 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="2.6 1.6 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="2.9 1.6 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="3.2 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.5 1.6 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="3.8 1.6 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="4.1 1.6 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="4.4 1.6 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="4.7 1.6 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="5.0 1.6 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.3 1.6 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="5.6 1.6 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="5.9 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="6.2 1.6 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.5 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="6.8 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="7.1 1.6 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="7.4 1.6 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="7.7 1.6 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.0 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.3 1.6 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="8.6 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="8.9 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="9.2 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="9.5 1.6 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="9.8 1.6 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="10.1 1.6 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="10.4 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="10.7 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="11.0 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="11.3 1.6 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.6 1.6 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="11.9 1.6 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="12.2 1.6 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="12.5 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="12.8 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.1 1.6 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="13.4 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.7 1.6 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="14.0 1.6 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="14.3 1.6 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="14.6 1.6 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="0.5 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="0.8 1.9 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="1.1 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="1.4 1.9 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="1.7 1.9 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="2.0 1.9 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="2.3 1.9 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="2.6 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="2.9 1.9 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="3.2 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="3.5 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="3.8 1.9 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="4.1 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="4.4 1.9 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="4.7 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.0 1.9 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="5.3 1.9 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="5.6 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="5.9 1.9 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="6.2 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="6.5 1.9 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="6.8 1.9 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="7.1 1.9 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="7.4 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="7.7 1.9 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="8.0 1.9 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="8.3 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="8.6 1.9 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="8.9 1.9 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="9.2 1.9 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="9.5 1.9 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="9.8 1.9 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="10.1 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="10.4 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="10.7 1.9 0.03" type="box" size="0.15 0.15 0.03" />
<geom pos="11.0 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="11.3 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="11.6 1.9 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="11.9 1.9 0.1" type="box" size="0.15 0.15 0.1" />
<geom pos="12.2 1.9 0.04" type="box" size="0.15 0.15 0.04" />
<geom pos="12.5 1.9 0.08" type="box" size="0.15 0.15 0.08" />
<geom pos="12.8 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="13.1 1.9 0.09" type="box" size="0.15 0.15 0.09" />
<geom pos="13.4 1.9 0.05" type="box" size="0.15 0.15 0.05" />
<geom pos="13.7 1.9 0.07" type="box" size="0.15 0.15 0.07" />
<geom pos="14.0 1.9 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="14.3 1.9 0.06" type="box" size="0.15 0.15 0.06" />
<geom pos="14.6 1.9 0.09" type="box" size="0.15 0.15 0.09" />
</worldbody>
</mujoco>

22
resources/go1/flat.xml Normal file
View File

@@ -0,0 +1,22 @@
<mujoco model="flat">
<include file="go1.xml"/>
<statistic center="1.0 0.7 1.0" extent="0.8"/>
<visual>
<headlight diffuse="0.6 0.6 0.6" ambient="0.1 0.1 0.1" specular="0.9 0.9 0.9"/>
<rgba haze="0.15 0.25 0.35 1"/>
<global azimuth="-140" elevation="-20"/>
</visual>
<asset>
<texture type="skybox" builtin="flat" rgb1="0 0 0" 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>
<worldbody>
<light pos="1 0 3.5" dir="0 0 -1" directional="true"/>
<geom name="floor" size="0 0 0.05" type="plane" material="groundplane"/>
</worldbody>
</mujoco>

198
resources/go1/go1.xml Normal file
View File

@@ -0,0 +1,198 @@
<mujoco model="go1">
<compiler angle="radian" meshdir="meshes" />
<size njmax="500" nconmax="100" />
<option gravity='0 0 -9.806' iterations='50' solver='Newton' timestep='0.002'/>
<default>
<geom contype="1" conaffinity="1" friction="0.6 0.3 0.3" rgba="0.5 0.6 0.7 1" margin="0.001" group="0"/>
<light castshadow="false" diffuse="1 1 1"/>
<motor ctrlrange="-33.5 33.5" ctrllimited="true"/>
<camera fovy="60"/>
<joint damping="0.01" armature="0.01" frictionloss="0.2" />
</default>
<asset>
<mesh name="trunk" file="trunk.stl" />
<mesh name="hip" file="hip.stl" />
<mesh name="thigh_mirror" file="thigh_mirror.stl" />
<mesh name="calf" file="calf.stl" />
<mesh name="thigh" file="thigh.stl" />
</asset>
<worldbody>
<body name="base_link" pos="0 0 0.35">
<inertial pos="0.0116053 0.00442221 0.000106692" quat="0.0111438 0.707126 -0.00935374 0.706938" mass="4.801" diaginertia="0.0447997 0.0366257 0.0162187" />
<freejoint name="root" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="trunk" />
<geom size="0.13 0.04675 0.057" type="box" rgba="0.913725 0.913725 0.847059 1" />
<geom size="0.0005 0.0005 0.0005" pos="-0.01592 -0.06659 -0.00617" type="box" contype="0" conaffinity="0" group="1" rgba="0.8 0 0 0" />
<geom size="0.0005 0.0005 0.0005" pos="-0.01592 -0.06659 -0.00617" type="box" rgba="0.8 0 0 0" />
<site name="imu" pos="0 0 0"/>
<body name="FR_hip" pos="0.1881 -0.04675 0">
<inertial pos="-0.00406411 -0.0193463 4.50733e-06" quat="0.467526 0.531662 -0.466259 0.530431" mass="0.679292" diaginertia="0.00131334 0.00122648 0.000728484" />
<joint name="FR_hip_joint" pos="0 0 0" axis="1 0 0" limited="true" range="-0.802851 0.802851" />
<geom quat="0 1 0 0" type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="hip" />
<geom size="0.046 0.02" pos="0 -0.045 0" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 0" />
<geom size="0.031 0.02" pos="0 -0.07 0" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 0" />
<body name="FR_thigh" pos="0 -0.08 0">
<inertial pos="-0.003468 0.018947 -0.032736" quat="0.999266 0.00067676 -0.0382978 0.000639813" mass="0.898919" diaginertia="0.00542178 0.00514246 0.000998869" />
<joint name="FR_thigh_joint" pos="0 0 0" axis="0 1 0" limited="true" range="-1.0472 4.18879" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="thigh_mirror" />
<geom size="0.1065 0.01225 0.017" pos="0 0 -0.1065" quat="0.707107 0 0.707107 0" type="box" rgba="0.913725 0.913725 0.847059 0" />
<body name="FR_calf" pos="0 0 -0.213">
<inertial pos="0.00455603 0.0009473 -0.147239" quat="0.762045 0.00970173 0.0180098 0.647201" mass="0.218015" diaginertia="0.00399678 0.00398122 3.99428e-05" />
<joint name="FR_calf_joint" pos="0 0 0" axis="0 1 0" limited="true" range="-2.69653 -0.916298" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0 0 0 1" mesh="calf" />
<geom size="0.1065 0.008 0.008" pos="0 0 -0.1065" quat="0.707107 0 0.707107 0" type="box" rgba="0 0 0 0" />
<geom size="0.01" pos="0 0 -0.213" contype="0" conaffinity="0" group="1" rgba="0 0 0 1" />
<geom name="FR" size="0.02" pos="0 0 -0.213" rgba="0 0 0 1" />
<body name="FR_foot" pos="0 0 -0.213" />
</body>
</body>
</body>
<body name="FL_hip" pos="0.1881 0.04675 0">
<inertial pos="-0.00406411 0.0193463 4.50733e-06" quat="0.531662 0.467526 -0.530431 0.466259" mass="0.679292" diaginertia="0.00131334 0.00122648 0.000728484" />
<joint name="FL_hip_joint" pos="0 0 0" axis="1 0 0" limited="true" range="-0.802851 0.802851" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="hip" />
<geom size="0.046 0.02" pos="0 0.045 0" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 0" />
<geom size="0.031 0.02" pos="0 0.07 0" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 0" />
<body name="FL_thigh" pos="0 0.08 0">
<inertial pos="-0.003468 -0.018947 -0.032736" quat="0.999266 -0.00067676 -0.0382978 -0.000639813" mass="0.898919" diaginertia="0.00542178 0.00514246 0.000998869" />
<joint name="FL_thigh_joint" pos="0 0 0" axis="0 1 0" limited="true" range="-1.0472 4.18879" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="thigh" />
<geom size="0.1065 0.01225 0.017" pos="0 0 -0.1065" quat="0.707107 0 0.707107 0" type="box" rgba="0.913725 0.913725 0.847059 0" />
<body name="FL_calf" pos="0 0 -0.213">
<inertial pos="0.00455603 0.0009473 -0.147239" quat="0.762045 0.00970173 0.0180098 0.647201" mass="0.218015" diaginertia="0.00399678 0.00398122 3.99428e-05" />
<joint name="FL_calf_joint" pos="0 0 0" axis="0 1 0" limited="true" range="-2.69653 -0.916298" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0 0 0 1" mesh="calf" />
<geom size="0.1065 0.008 0.008" pos="0 0 -0.1065" quat="0.707107 0 0.707107 0" type="box" rgba="0.913725 0.913725 0.847059 0" />
<geom size="0.01" pos="0 0 -0.213" contype="0" conaffinity="0" group="1" rgba="0 0 0 1" />
<geom name="FL" size="0.02" pos="0 0 -0.213" rgba="0 0 0 1" />
<body name="FL_foot" pos="0 0 -0.213" />
</body>
</body>
</body>
<body name="RR_hip" pos="-0.1881 -0.04675 0">
<inertial pos="0.00406411 -0.0193463 4.50733e-06" quat="0.530431 0.466259 -0.531662 0.467526" mass="0.679292" diaginertia="0.00131334 0.00122648 0.000728484" />
<joint name="RR_hip_joint" pos="0 0 0" axis="1 0 0" limited="true" range="-0.802851 0.802851" />
<geom quat="0 0 0 -1" type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="hip" />
<geom size="0.046 0.02" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 1" />
<geom size="0.046 0.02" pos="0 -0.045 0" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 0" />
<geom size="0.031 0.02" pos="0 -0.07 0" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 0" />
<body name="RR_thigh" pos="0 -0.08 0">
<inertial pos="-0.003468 0.018947 -0.032736" quat="0.999266 0.00067676 -0.0382978 0.000639813" mass="0.898919" diaginertia="0.00542178 0.00514246 0.000998869" />
<joint name="RR_thigh_joint" pos="0 0 0" axis="0 1 0" limited="true" range="-1.0472 4.18879" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="thigh_mirror" />
<geom size="0.1065 0.01225 0.017" pos="0 0 -0.1065" quat="0.707107 0 0.707107 0" type="box" rgba="0.913725 0.913725 0.847059 0" />
<body name="RR_calf" pos="0 0 -0.213">
<inertial pos="0.00455603 0.0009473 -0.147239" quat="0.762045 0.00970173 0.0180098 0.647201" mass="0.218015" diaginertia="0.00399678 0.00398122 3.99428e-05" />
<joint name="RR_calf_joint" pos="0 0 0" axis="0 1 0" limited="true" range="-2.69653 -0.916298" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0 0 0 1" mesh="calf" />
<geom size="0.1065 0.008 0.008" pos="0 0 -0.1065" quat="0.707107 0 0.707107 0" type="box" rgba="0 0 0 0" />
<geom size="0.01" pos="0 0 -0.213" contype="0" conaffinity="0" group="1" rgba="0 0 0 1" />
<geom name="RR" size="0.02" pos="0 0 -0.213" rgba="0 0 0 1" />
<body name="RR_foot" pos="0 0 -0.213" />
</body>
</body>
</body>
<body name="RL_hip" pos="-0.1881 0.04675 0">
<inertial pos="0.00406411 0.0193463 4.50733e-06" quat="0.466259 0.530431 -0.467526 0.531662" mass="0.679292" diaginertia="0.00131334 0.00122648 0.000728484" />
<joint name="RL_hip_joint" pos="0 0 0" axis="1 0 0" limited="true" range="-0.802851 0.802851" />
<geom quat="0 0 1 0" type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="hip" />
<geom size="0.046 0.02" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 1" />
<geom size="0.046 0.02" pos="0 0.045 0" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 0" />
<geom size="0.031 0.02" pos="0 0.07 0" quat="0.707107 0.707107 0 0" type="cylinder" rgba="0.913725 0.913725 0.847059 0" />
<body name="RL_thigh" pos="0 0.08 0">
<inertial pos="-0.003468 -0.018947 -0.032736" quat="0.999266 -0.00067676 -0.0382978 -0.000639813" mass="0.898919" diaginertia="0.00542178 0.00514246 0.000998869" />
<joint name="RL_thigh_joint" pos="0 0 0" axis="0 1 0" limited="true" range="-1.0472 4.18879" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0.913725 0.913725 0.847059 1" mesh="thigh" />
<geom size="0.1065 0.01225 0.017" pos="0 0 -0.1065" quat="0.707107 0 0.707107 0" type="box" rgba="0.913725 0.913725 0.847059 0" />
<body name="RL_calf" pos="0 0 -0.213">
<inertial pos="0.00455603 0.0009473 -0.147239" quat="0.762045 0.00970173 0.0180098 0.647201" mass="0.218015" diaginertia="0.00399678 0.00398122 3.99428e-05" />
<joint name="RL_calf_joint" pos="0 0 0" axis="0 1 0" limited="true" range="-2.69653 -0.916298" />
<geom type="mesh" contype="0" conaffinity="0" group="1" rgba="0 0 0 1" mesh="calf" />
<geom size="0.1065 0.008 0.008" pos="0 0 -0.1065" quat="0.707107 0 0.707107 0" type="box" rgba="0 0 0 0" />
<geom size="0.01" pos="0 0 -0.213" contype="0" conaffinity="0" group="1" rgba="0 0 0 1" />
<geom name="RL" size="0.02" pos="0 0 -0.213" rgba="0 0 0 1" />
<body name="RL_foot" pos="0 0 -0.213" />
</body>
</body>
</body>
</body>
</worldbody>
<actuator>
<motor name="FR_hip" gear="1" joint="FR_hip_joint"/>
<motor name="FR_thigh" gear="1" joint="FR_thigh_joint"/>
<motor name="FR_calf" gear="1" joint="FR_calf_joint"/>
<motor name="FL_hip" gear="1" joint="FL_hip_joint"/>
<motor name="FL_thigh" gear="1" joint="FL_thigh_joint"/>
<motor name="FL_calf" gear="1" joint="FL_calf_joint"/>
<motor name="RR_hip" gear="1" joint="RR_hip_joint"/>
<motor name="RR_thigh" gear="1" joint="RR_thigh_joint"/>
<motor name="RR_calf" gear="1" joint="RR_calf_joint" />
<motor name="RL_hip" gear="1" joint="RL_hip_joint"/>
<motor name="RL_thigh" gear="1" joint="RL_thigh_joint"/>
<motor name="RL_calf" gear="1" joint="RL_calf_joint"/>
</actuator>
<sensor>
<jointpos name="FR_hip_pos" joint="FR_hip_joint"/>
<jointpos name="FR_thigh_pos" joint="FR_thigh_joint"/>
<jointpos name="FR_calf_pos" joint="FR_calf_joint"/>
<jointpos name="FL_hip_pos" joint="FL_hip_joint"/>
<jointpos name="FL_thigh_pos" joint="FL_thigh_joint"/>
<jointpos name="FL_calf_pos" joint="FL_calf_joint"/>
<jointpos name="RR_hip_pos" joint="RR_hip_joint"/>
<jointpos name="RR_thigh_pos" joint="RR_thigh_joint"/>
<jointpos name="RR_calf_pos" joint="RR_calf_joint" />
<jointpos name="RL_hip_pos" joint="RL_hip_joint"/>
<jointpos name="RL_thigh_pos" joint="RL_thigh_joint"/>
<jointpos name="RL_calf_pos" joint="RL_calf_joint"/>
<jointvel name="FR_hip_vel" joint="FR_hip_joint"/>
<jointvel name="FR_thigh_vel" joint="FR_thigh_joint"/>
<jointvel name="FR_calf_vel" joint="FR_calf_joint"/>
<jointvel name="FL_hip_vel" joint="FL_hip_joint"/>
<jointvel name="FL_thigh_vel" joint="FL_thigh_joint"/>
<jointvel name="FL_calf_vel" joint="FL_calf_joint"/>
<jointvel name="RR_hip_vel" joint="RR_hip_joint"/>
<jointvel name="RR_thigh_vel" joint="RR_thigh_joint"/>
<jointvel name="RR_calf_vel" joint="RR_calf_joint" />
<jointvel name="RL_hip_vel" joint="RL_hip_joint"/>
<jointvel name="RL_thigh_vel" joint="RL_thigh_joint"/>
<jointvel name="RL_calf_vel" joint="RL_calf_joint"/>
<jointactuatorfrc name="FR_hip_torque" joint="FR_hip_joint" />
<jointactuatorfrc name="FR_thigh_torque" joint="FR_thigh_joint" />
<jointactuatorfrc name="FR_calf_torque" joint="FR_calf_joint" />
<jointactuatorfrc name="FL_hip_torque" joint="FL_hip_joint" />
<jointactuatorfrc name="FL_thigh_torque" joint="FL_thigh_joint" />
<jointactuatorfrc name="FL_calf_torque" joint="FL_calf_joint" />
<jointactuatorfrc name="RR_hip_torque" joint="RR_hip_joint" />
<jointactuatorfrc name="RR_thigh_torque" joint="RR_thigh_joint" />
<jointactuatorfrc name="RR_calf_torque" joint="RR_calf_joint" />
<jointactuatorfrc name="RL_hip_torque" joint="RL_hip_joint" />
<jointactuatorfrc name="RL_thigh_torque" joint="RL_thigh_joint" />
<jointactuatorfrc name="RL_calf_torque" joint="RL_calf_joint" />
<accelerometer name="Body_Acc" site="imu"/>
<gyro name="Body_Gyro" site="imu"/>
<framepos name="Body_Pos" objtype="site" objname="imu"/>
<framelinvel name="Body_LinVel" objtype="site" objname="imu"/>
<framequat name="Body_Quat" objtype="site" objname="imu"/>
</sensor>
</mujoco>

BIN
resources/go1/meshes/calf.stl Normal file
View File

Binary file not shown.

BIN
resources/go1/meshes/hip.stl Normal file
View File

Binary file not shown.

BIN
resources/go1/meshes/thigh.stl Normal file
View File

Binary file not shown.

BIN
resources/go1/meshes/thigh_mirror.stl Normal file
View File

Binary file not shown.

BIN
resources/go1/meshes/trunk.stl Normal file
View File

Binary file not shown.

28
resources/go1/stairs.xml Normal file
View File

File diff suppressed because one or more lines are too long

39
resources/go1/stairs_and_slope.xml Normal file
View File

@@ -0,0 +1,39 @@
<mujoco model="stairs_and_slope">
<include file="go1.xml"/>
<statistic center="0 0 0.1" extent="0.8"/>
<visual>
<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="-130" elevation="-20"/>
</visual>
<asset>
<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>
<worldbody>
<light pos="0 0 1.5" dir="0 0 -1" directional="true"/>
<geom name="floor" size="0 0 0.05" type="plane" material="groundplane"/>
<body name="stairs" pos="2 0 0">
<geom name="step_0" type="box" size="0.15 3.0 0.095" pos="0.15 0 0.095" rgba="1 1 1 1"/>
<geom name="step_1" type="box" size="0.15 3.0 0.095" pos="0.45 0 0.285" rgba="1 1 1 1"/>
<geom name="step_2" type="box" size="0.15 3.0 0.095" pos="0.75 0 0.475" rgba="1 1 1 1"/>
<geom name="step_3" type="box" size="0.15 3.0 0.095" pos="1.05 0 0.665" rgba="1 1 1 1"/>
<geom name="step_4" type="box" size="0.15 3.0 0.095" pos="1.35 0 0.855" rgba="1 1 1 1"/>
<geom name="step_5" type="box" size="0.15 3.0 0.095" pos="1.65 0 1.045" rgba="1 1 1 1"/>
<geom name="step_6" type="box" size="0.15 3.0 0.095" pos="1.95 0 1.235" rgba="1 1 1 1"/>
<geom name="step_7" type="box" size="0.15 3.0 0.095" pos="2.25 0 1.425" rgba="1 1 1 1"/>
<geom name="step_8" type="box" size="0.15 3.0 0.095" pos="2.55 0 1.615" rgba="1 1 1 1"/>
<geom name="step_9" type="box" size="0.15 3.0 0.095" pos="2.85 0 1.805" rgba="1 1 1 1"/>
</body>
<!-- 斜坡：从最后一阶末端（X=6）开始，向下倾斜0.4rad，水平长度约4.493m，白色 -->
<geom name="ramp" type="box" size="2.2465 3.0 0.1" pos="7.0465 0 0.95" rgba="1 1 1 1" euler="0 0.4 0"/>
</worldbody>
</mujoco>

581
resources/go1/urdf/go1.urdf Normal file
View File

@@ -0,0 +1,581 @@
<?xml version="1.0" ?>
<robot name="go1_description" xmlns:xacro="http://www.ros.org/wiki/xacro">
<material name="black">
<color rgba="0.0 0.0 0.0 1.0"/>
</material>
<material name="blue">
<color rgba="0.0 0.0 0.8 1.0"/>
</material>
<material name="green">
<color rgba="0.0 0.8 0.0 1.0"/>
</material>
<material name="grey">
<color rgba="0.2 0.2 0.2 1.0"/>
</material>
<material name="silver">
<color rgba="0.913725490196 0.913725490196 0.847058823529 1.0"/>
</material>
<material name="orange">
<color rgba="1.0 0.423529411765 0.0392156862745 1.0"/>
</material>
<material name="brown">
<color rgba="0.870588235294 0.811764705882 0.764705882353 1.0"/>
</material>
<material name="red">
<color rgba="0.8 0.0 0.0 1.0"/>
</material>
<material name="white">
<color rgba="1.0 1.0 1.0 1.0"/>
</material>
<link name="base">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<box size="0.001 0.001 0.001"/>
</geometry>
</visual>
</link>
<joint name="floating_base" type="fixed">
<origin rpy="0 0 0" xyz="0 0 0"/>
<parent link="base"/>
<child link="trunk"/>
</joint>
<link name="trunk">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/trunk.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<box size="0.3762 0.0935 0.114"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="0.011611 0.004437 0.000108"/>
<mass value="4.8"/>
<inertia ixx="0.016130741919" ixy="0.000593180607" ixz="7.324662e-06" iyy="0.036507810812" iyz="2.0969537e-05" izz="0.044693872053"/>
</inertial>
</link>
<joint name="imu_joint" type="fixed">
<parent link="trunk"/>
<child link="imu_link"/>
<origin rpy="0 0 0" xyz="-0.01592 -0.06659 -0.00617"/>
</joint>
<link name="imu_link">
<inertial>
<mass value="0.001"/>
<origin rpy="0 0 0" xyz="0 0 0"/>
<inertia ixx="0.0001" ixy="0" ixz="0" iyy="0.0001" iyz="0" izz="0.0001"/>
</inertial>
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<box size="0.001 0.001 0.001"/>
</geometry>
<material name="red"/>
</visual>
<!-- <collision>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<box size=".001 .001 .001"/>
</geometry>
</collision> -->
</link>
<joint name="FR_hip_joint" type="revolute">
<origin rpy="0 0 0" xyz="0.1881 -0.04675 0"/>
<parent link="trunk"/>
<child link="FR_hip"/>
<axis xyz="1 0 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-0.802851455917" upper="0.802851455917" velocity="50"/>
</joint>
<link name="FR_hip">
<visual>
<origin rpy="3.14159265359 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/hip.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="1.57079632679 0 0" xyz="0 -0.045 0"/>
<geometry>
<cylinder length="0.04" radius="0.046"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="-0.00541 0.00074 6e-06"/>
<mass value="0.510299"/>
<inertia ixx="0.00030528937" ixy="7.788013e-06" ixz="2.2016e-07" iyy="0.000590894859" iyz="1.7175e-08" izz="0.000396594572"/>
</inertial>
</link>
<joint name="FR_hip_fixed" type="fixed">
<origin rpy="0 0 0" xyz="0 -0.08 0"/>
<parent link="FR_hip"/>
<child link="FR_thigh_shoulder"/>
</joint>
<!-- this link is only for collision -->
<link name="FR_thigh_shoulder">
<!-- <collision>
<origin rpy="1.57079632679 0 0" xyz="0 0 0"/>
<geometry>
<cylinder length="0.032" radius="0.041"/>
</geometry>
</collision> -->
</link>
<joint name="FR_thigh_joint" type="revolute">
<origin rpy="0 0 0" xyz="0 -0.08 0"/>
<parent link="FR_hip"/>
<child link="FR_thigh"/>
<axis xyz="0 1 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-1.0471975512" upper="4.18879020479" velocity="28"/>
</joint>
<link name="FR_thigh">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/thigh_mirror.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="0 1.57079632679 0" xyz="0 0 -0.1065"/>
<geometry>
<box size="0.213 0.0245 0.034"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="-0.003468 0.018947 -0.032736"/>
<mass value="0.898919"/>
<inertia ixx="0.005395867678" ixy="-1.02809e-07" ixz="0.000337529085" iyy="0.005142451046" iyz="5.816563e-06" izz="0.00102478732"/>
</inertial>
</link>
<joint name="FR_calf_joint" type="revolute">
<origin rpy="0 0 0" xyz="0 0 -0.213"/>
<parent link="FR_thigh"/>
<child link="FR_calf"/>
<axis xyz="0 1 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-2.69653369433" upper="-0.916297857297" velocity="28"/>
</joint>
<link name="FR_calf">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/calf.stl" scale="1 1 1"/>
</geometry>
<material name="black"/>
</visual>
<collision>
<origin rpy="0 1.57079632679 0" xyz="0 0 -0.1065"/>
<geometry>
<box size="0.213 0.016 0.016"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="0.006286 0.001307 -0.122269"/>
<mass value="0.158015"/>
<inertia ixx="0.003607648222" ixy="1.494971e-06" ixz="-0.000132778525" iyy="0.003626771492" iyz="-2.8638535e-05" izz="3.5148003e-05"/>
</inertial>
</link>
<joint name="FR_foot_fixed" type="fixed" dont_collapse="true">
<origin rpy="0 0 0" xyz="0 0 -0.213"/>
<parent link="FR_calf"/>
<child link="FR_foot"/>
</joint>
<link name="FR_foot">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<sphere radius="0.01"/>
</geometry>
<material name="black"/>
</visual>
<collision>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<sphere radius="0.02"/>
</geometry>
</collision>
<inertial>
<mass value="0.06"/>
<inertia ixx="9.6e-06" ixy="0.0" ixz="0.0" iyy="9.6e-06" iyz="0.0" izz="9.6e-06"/>
</inertial>
</link>
<joint name="FL_hip_joint" type="revolute">
<origin rpy="0 0 0" xyz="0.1881 0.04675 0"/>
<parent link="trunk"/>
<child link="FL_hip"/>
<axis xyz="1 0 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-0.802851455917" upper="0.802851455917" velocity="50"/>
</joint>
<link name="FL_hip">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/hip.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="1.57079632679 0 0" xyz="0 0.045 0"/>
<geometry>
<cylinder length="0.04" radius="0.046"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="-0.00541 -0.00074 6e-06"/>
<mass value="0.510299"/>
<inertia ixx="0.00030528937" ixy="-7.788013e-06" ixz="2.2016e-07" iyy="0.000590894859" iyz="-1.7175e-08" izz="0.000396594572"/>
</inertial>
</link>
<joint name="FL_hip_fixed" type="fixed">
<origin rpy="0 0 0" xyz="0 0.08 0"/>
<parent link="FL_hip"/>
<child link="FL_thigh_shoulder"/>
</joint>
<!-- this link is only for collision -->
<link name="FL_thigh_shoulder">
<!-- <collision>
<origin rpy="1.57079632679 0 0" xyz="0 0 0"/>
<geometry>
<cylinder length="0.032" radius="0.041"/>
</geometry>
</collision> -->
</link>
<joint name="FL_thigh_joint" type="revolute">
<origin rpy="0 0 0" xyz="0 0.08 0"/>
<parent link="FL_hip"/>
<child link="FL_thigh"/>
<axis xyz="0 1 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-1.0471975512" upper="4.18879020479" velocity="28"/>
</joint>
<link name="FL_thigh">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/thigh.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="0 1.57079632679 0" xyz="0 0 -0.1065"/>
<geometry>
<box size="0.213 0.0245 0.034"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="-0.003468 -0.018947 -0.032736"/>
<mass value="0.898919"/>
<inertia ixx="0.005395867678" ixy="1.02809e-07" ixz="0.000337529085" iyy="0.005142451046" iyz="-5.816563e-06" izz="0.00102478732"/>
</inertial>
</link>
<joint name="FL_calf_joint" type="revolute">
<origin rpy="0 0 0" xyz="0 0 -0.213"/>
<parent link="FL_thigh"/>
<child link="FL_calf"/>
<axis xyz="0 1 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-2.69653369433" upper="-0.916297857297" velocity="28"/>
</joint>
<link name="FL_calf">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/calf.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="0 1.57079632679 0" xyz="0 0 -0.1065"/>
<geometry>
<box size="0.213 0.016 0.016"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="0.006286 0.001307 -0.122269"/>
<mass value="0.158015"/>
<inertia ixx="0.003607648222" ixy="1.494971e-06" ixz="-0.000132778525" iyy="0.003626771492" iyz="-2.8638535e-05" izz="3.5148003e-05"/>
</inertial>
</link>
<joint name="FL_foot_fixed" type="fixed" dont_collapse="true">
<origin rpy="0 0 0" xyz="0 0 -0.213"/>
<parent link="FL_calf"/>
<child link="FL_foot"/>
</joint>
<link name="FL_foot">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<sphere radius="0.01"/>
</geometry>
<material name="black"/>
</visual>
<collision>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<sphere radius="0.02"/>
</geometry>
</collision>
<inertial>
<mass value="0.06"/>
<inertia ixx="9.6e-06" ixy="0.0" ixz="0.0" iyy="9.6e-06" iyz="0.0" izz="9.6e-06"/>
</inertial>
</link>
<joint name="RR_hip_joint" type="revolute">
<origin rpy="0 0 0" xyz="-0.1881 -0.04675 0"/>
<parent link="trunk"/>
<child link="RR_hip"/>
<axis xyz="1 0 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-0.802851455917" upper="0.802851455917" velocity="50"/>
</joint>
<link name="RR_hip">
<visual>
<origin rpy="3.14159265359 3.14159265359 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/hip.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="1.57079632679 0 0" xyz="0 -0.045 0"/>
<geometry>
<cylinder length="0.04" radius="0.046"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="0.00541 0.00074 6e-06"/>
<mass value="0.510299"/>
<inertia ixx="0.00030528937" ixy="-7.788013e-06" ixz="-2.2016e-07" iyy="0.000590894859" iyz="1.7175e-08" izz="0.000396594572"/>
</inertial>
</link>
<joint name="RR_hip_fixed" type="fixed">
<origin rpy="0 0 0" xyz="0 -0.08 0"/>
<parent link="RR_hip"/>
<child link="RR_thigh_shoulder"/>
</joint>
<!-- this link is only for collision -->
<link name="RR_thigh_shoulder">
<!-- <collision>
<origin rpy="1.57079632679 0 0" xyz="0 0 0"/>
<geometry>
<cylinder length="0.032" radius="0.041"/>
</geometry>
</collision> -->
</link>
<joint name="RR_thigh_joint" type="revolute">
<origin rpy="0 0 0" xyz="0 -0.08 0"/>
<parent link="RR_hip"/>
<child link="RR_thigh"/>
<axis xyz="0 1 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-1.0471975512" upper="4.18879020479" velocity="28"/>
</joint>
<link name="RR_thigh">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/thigh_mirror.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="0 1.57079632679 0" xyz="0 0 -0.1065"/>
<geometry>
<box size="0.213 0.0245 0.034"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="-0.003468 0.018947 -0.032736"/>
<mass value="0.898919"/>
<inertia ixx="0.005395867678" ixy="-1.02809e-07" ixz="0.000337529085" iyy="0.005142451046" iyz="5.816563e-06" izz="0.00102478732"/>
</inertial>
</link>
<joint name="RR_calf_joint" type="revolute">
<origin rpy="0 0 0" xyz="0 0 -0.213"/>
<parent link="RR_thigh"/>
<child link="RR_calf"/>
<axis xyz="0 1 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-2.69653369433" upper="-0.916297857297" velocity="28"/>
</joint>
<link name="RR_calf">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/calf.stl" scale="1 1 1"/>
</geometry>
<material name="black"/>
</visual>
<collision>
<origin rpy="0 1.57079632679 0" xyz="0 0 -0.1065"/>
<geometry>
<box size="0.213 0.016 0.016"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="0.006286 0.001307 -0.122269"/>
<mass value="0.158015"/>
<inertia ixx="0.003607648222" ixy="1.494971e-06" ixz="-0.000132778525" iyy="0.003626771492" iyz="-2.8638535e-05" izz="3.5148003e-05"/>
</inertial>
</link>
<joint name="RR_foot_fixed" type="fixed" dont_collapse="true">
<origin rpy="0 0 0" xyz="0 0 -0.213"/>
<parent link="RR_calf"/>
<child link="RR_foot"/>
</joint>
<link name="RR_foot">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<sphere radius="0.01"/>
</geometry>
<material name="black"/>
</visual>
<collision>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<sphere radius="0.02"/>
</geometry>
</collision>
<inertial>
<mass value="0.06"/>
<inertia ixx="9.6e-06" ixy="0.0" ixz="0.0" iyy="9.6e-06" iyz="0.0" izz="9.6e-06"/>
</inertial>
</link>
<joint name="RL_hip_joint" type="revolute">
<origin rpy="0 0 0" xyz="-0.1881 0.04675 0"/>
<parent link="trunk"/>
<child link="RL_hip"/>
<axis xyz="1 0 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-0.802851455917" upper="0.802851455917" velocity="50"/>
</joint>
<link name="RL_hip">
<visual>
<origin rpy="0 3.14159265359 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/hip.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="1.57079632679 0 0" xyz="0 0.045 0"/>
<geometry>
<cylinder length="0.04" radius="0.046"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="0.00541 -0.00074 6e-06"/>
<mass value="0.510299"/>
<inertia ixx="0.00030528937" ixy="7.788013e-06" ixz="-2.2016e-07" iyy="0.000590894859" iyz="-1.7175e-08" izz="0.000396594572"/>
</inertial>
</link>
<joint name="RL_hip_fixed" type="fixed">
<origin rpy="0 0 0" xyz="0 0.08 0"/>
<parent link="RL_hip"/>
<child link="RL_thigh_shoulder"/>
</joint>
<!-- this link is only for collision -->
<link name="RL_thigh_shoulder">
<!-- <collision>
<origin rpy="1.57079632679 0 0" xyz="0 0 0"/>
<geometry>
<cylinder length="0.032" radius="0.041"/>
</geometry>
</collision> -->
</link>
<joint name="RL_thigh_joint" type="revolute">
<origin rpy="0 0 0" xyz="0 0.08 0"/>
<parent link="RL_hip"/>
<child link="RL_thigh"/>
<axis xyz="0 1 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-1.0471975512" upper="4.18879020479" velocity="28"/>
</joint>
<link name="RL_thigh">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/thigh.stl" scale="1 1 1"/>
</geometry>
<material name="silver"/>
</visual>
<collision>
<origin rpy="0 1.57079632679 0" xyz="0 0 -0.1065"/>
<geometry>
<box size="0.213 0.0245 0.034"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="-0.003468 -0.018947 -0.032736"/>
<mass value="0.898919"/>
<inertia ixx="0.005395867678" ixy="1.02809e-07" ixz="0.000337529085" iyy="0.005142451046" iyz="-5.816563e-06" izz="0.00102478732"/>
</inertial>
</link>
<joint name="RL_calf_joint" type="revolute">
<origin rpy="0 0 0" xyz="0 0 -0.213"/>
<parent link="RL_thigh"/>
<child link="RL_calf"/>
<axis xyz="0 1 0"/>
<dynamics damping="0" friction="0"/>
<limit effort="33.5" lower="-2.69653369433" upper="-0.916297857297" velocity="28"/>
</joint>
<link name="RL_calf">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<mesh filename="../meshes/calf.stl" scale="1 1 1"/>
</geometry>
<material name="black"/>
</visual>
<collision>
<origin rpy="0 1.57079632679 0" xyz="0 0 -0.1065"/>
<geometry>
<box size="0.213 0.016 0.016"/>
</geometry>
</collision>
<inertial>
<origin rpy="0 0 0" xyz="0.006286 0.001307 -0.122269"/>
<mass value="0.158015"/>
<inertia ixx="0.003607648222" ixy="1.494971e-06" ixz="-0.000132778525" iyy="0.003626771492" iyz="-2.8638535e-05" izz="3.5148003e-05"/>
</inertial>
</link>
<joint name="RL_foot_fixed" type="fixed" dont_collapse="true">
<origin rpy="0 0 0" xyz="0 0 -0.213"/>
<parent link="RL_calf"/>
<child link="RL_foot"/>
</joint>
<link name="RL_foot">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<sphere radius="0.01"/>
</geometry>
<material name="black"/>
</visual>
<collision>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
<sphere radius="0.02"/>
</geometry>
</collision>
<inertial>
<mass value="0.06"/>
<inertia ixx="9.6e-06" ixy="0.0" ixz="0.0" iyy="9.6e-06" iyz="0.0" izz="9.6e-06"/>
</inertial>
</link>
</robot>