MimicGen


介绍

MimicGen 的作用是用来解决数据不足的问题,可用通过简单的示教少数轨迹或人物,就可以合成大量的测试数据

环境搭建

代码运行

1. 生成任务:

python generate_training_configs.py
python generate_training_configs.py --config_dir /tmp/configs --dataset_dir /tmp/datasets --output_dir /tmp/experiment_results

会生成一堆配置文件

2. 训练数据:

python /path/to/robomimic/scripts/train.py --config /path/to/mimicgen_envs/exps/paper/core/coffee_d0/image/bc_rnn.json

会生成一组pt文件,择优选择最好的即可;

3. 生成数据:

python run_trained_agent.py --agent /path/to/model.pth --n_rollouts 50 --horizon 400 --seed 0 --dataset_path /path/to/output.hdf5 --dataset_obs

生成后缀为 hdf5 的数据集

4. 可视化数据

python playback_dataset.py --dataset ./mug_cleanup_o1.hdf5 --use-actions --render_image_names agentview --video_path ./vis_object_cleanup_o1.mp4

实现将 hdf5 文件中的轨迹可视化

Q&A

  1. 如何实现少量数据生成大量数据的–尚未找到相关代码;
  2. 利用robomimic 中的 train 的目的是什么;
  3. 如何将自己特定的场景作为输入;

Appendix

1. 数据解析

利用 robomimic 中的 get_dataset_info.py 分析下官方给定数据集的详细信息,首先看下 source 里面的数据,这个数据也是后期我们需要提供的原始数据:

#source/coffee,hdf5
total transitions: 2082
total trajectories: 10
traj length mean: 208.2
traj length std: 12.75774274705365
traj length min: 193
traj length max: 232
action min: -1.0
action max: 1.0

==== Filter Keys ====
filter key first_10 with 10 demos

==== Env Meta ====
{
    "env_name": "Coffee_D0",
    "env_version": "1.4.1",
    "type": 1,
    "env_kwargs": {
        "has_renderer": false,
        "has_offscreen_renderer": true,
        "ignore_done": true,
        "use_object_obs": true,
        "use_camera_obs": true,
        "control_freq": 20,
        "controller_configs": {
            "type": "OSC_POSE",
            "input_max": 1,
            "input_min": -1,
            "output_max": [
                0.05,
                0.05,
                0.05,
                0.5,
                0.5,
                0.5
            ],
            "output_min": [
                -0.05,
                -0.05,
                -0.05,
                -0.5,
                -0.5,
                -0.5
            ],
            "kp": 150,
            "damping": 1,
            "impedance_mode": "fixed",
            "kp_limits": [
                0,
                300
            ],
            "damping_limits": [
                0,
                10
            ],
            "position_limits": null,
            "orientation_limits": null,
            "uncouple_pos_ori": true,
            "control_delta": true,
            "interpolation": null,
            "ramp_ratio": 0.2
        },
        "robots": [
            "Panda"
        ],
        "camera_depths": false,
        "camera_heights": 84,
        "camera_widths": 84,
        "reward_shaping": false,
        "camera_names": [
            "agentview",
            "robot0_eye_in_hand"
        ],
        "render_gpu_device_id": 0
    }
}

==== Dataset Structure ====
episode demo_0 with 200 transitions
    key: actions with shape (200, 7)
    key: dones with shape (200,)
    key: obs
        observation key agentview_image with shape (200, 84, 84, 3)
        observation key object with shape (200, 57)
        observation key robot0_eef_pos with shape (200, 3)
        observation key robot0_eef_pos_rel_pod with shape (200, 3)
        observation key robot0_eef_pos_rel_pod_holder with shape (200, 3)
        observation key robot0_eef_quat with shape (200, 4)
        observation key robot0_eef_quat_rel_pod with shape (200, 4)
        observation key robot0_eef_quat_rel_pod_holder with shape (200, 4)
        observation key robot0_eef_vel_ang with shape (200, 3)
        observation key robot0_eef_vel_lin with shape (200, 3)
        observation key robot0_eye_in_hand_image with shape (200, 84, 84, 3)
        observation key robot0_gripper_qpos with shape (200, 2)
        observation key robot0_gripper_qvel with shape (200, 2)
        observation key robot0_joint_pos with shape (200, 7)
        observation key robot0_joint_pos_cos with shape (200, 7)
        observation key robot0_joint_pos_sin with shape (200, 7)
        observation key robot0_joint_vel with shape (200, 7)
    key: rewards with shape (200,)
    key: states with shape (200, 47)
# core/coffe_preparate.hdf5
total transitions: 689273
total trajectories: 1000
traj length mean: 689.273
traj length std: 48.51659995300578
traj length min: 591
traj length max: 760
action min: -1.0
action max: 1.0

==== Filter Keys ====
no filter keys

==== Env Meta ====
{
    "env_name": "CoffeePreparation_D0",
    "env_version": "1.4.1",
    "type": 1,
    "env_kwargs": {
        "has_renderer": false,
        "has_offscreen_renderer": true,
        "ignore_done": true,
        "use_object_obs": true,
        "use_camera_obs": true,
        "control_freq": 20,
        "controller_configs": {
            "type": "OSC_POSE",
            "input_max": 1,
            "input_min": -1,
            "output_max": [
                0.05,
                0.05,
                0.05,
                0.5,
                0.5,
                0.5
            ],
            "output_min": [
                -0.05,
                -0.05,
                -0.05,
                -0.5,
                -0.5,
                -0.5
            ],
            "kp": 150,
            "damping": 1,
            "impedance_mode": "fixed",
            "kp_limits": [
                0,
                300
            ],
            "damping_limits": [
                0,
                10
            ],
            "position_limits": null,
            "orientation_limits": null,
            "uncouple_pos_ori": true,
            "control_delta": true,
            "interpolation": null,
            "ramp_ratio": 0.2
        },
        "robots": [
            "Panda"
        ],
        "camera_depths": false,
        "camera_heights": 84,
        "camera_widths": 84,
        "render_gpu_device_id": 0,
        "reward_shaping": false,
        "camera_names": [
            "agentview",
            "robot0_eye_in_hand"
        ]
    }
}

==== Dataset Structure ====
episode demo_0 with 673 transitions
    key: actions with shape (673, 7)
    key: dones with shape (673,)
    key: obs
        observation key agentview_image with shape (673, 84, 84, 3)
        observation key object with shape (673, 86)
        observation key robot0_eef_pos with shape (673, 3)
        observation key robot0_eef_pos_rel_pod with shape (673, 3)
        observation key robot0_eef_pos_rel_pod_holder with shape (673, 3)
        observation key robot0_eef_quat with shape (673, 4)
        observation key robot0_eef_quat_rel_pod with shape (673, 4)
        observation key robot0_eef_quat_rel_pod_holder with shape (673, 4)
        observation key robot0_eef_vel_ang with shape (673, 3)
        observation key robot0_eef_vel_lin with shape (673, 3)
        observation key robot0_eye_in_hand_image with shape (673, 84, 84, 3)
        observation key robot0_gripper_qpos with shape (673, 2)
        observation key robot0_gripper_qvel with shape (673, 2)
        observation key robot0_joint_pos with shape (673, 7)
        observation key robot0_joint_pos_cos with shape (673, 7)
        observation key robot0_joint_pos_sin with shape (673, 7)
        observation key robot0_joint_vel with shape (673, 7)
    key: rewards with shape (673,)
    key: states with shape (673, 62)

数据对比

文件名sourcecore
demo数量101000
trajs1010
轨迹采样点不定600-800不定
点表示未知未知

轨迹点实例:

ipdb> f['data']['demo_4']['actions'][1]
    >> array([-0.00477523,  0.25546803, -0.08610821, -0.00303893,  0.03876611, -0.02707935, -1.])
ipdb> len(f['data']['demo_4']['actions'])
    >> 711

轨迹点示例如下:
在这里插入图片描述

请添加图片描述
数据对照:
请添加图片描述

数据解析

hdf5 数据结构如下:
数据域如下

		-data
    		--  attr: env_args
		    --  attr: total
			--  demo_0 # n 组
	   			--- attr: model_file
			    --- arrt: num_samples # 676
				--- actions # 676 * 7
				--- dones # 0/1
	   		    --- rewards # 0/1
		  	    --- states # 676 * 62
				--- obs
					---- agentview_image
					---- object # 676 * 86
   					---- robot0_eef_pos # 676 * 3
   					---- robot0_eef_pos_rel_pod # 676 * 3
   					---- robot0_eef_pos_rel_pod_holder # 676 * 3
   					---- robot0_eef_quat
   					---- robot0_eef_quat_rel_pod
   					---- robot0_eef_quat_rel_pod_holder
   					---- robot0_eef_vel_ang
   					---- robot0_eef_vel_lin
   					---- robot0_eye_in_hand_image
   					---- robot0_gripper_qpos
   					---- robot0_gripper_qvel
   					---- robot0_joint_pos
   					---- robot0_joint_pos_cos
   					---- robot0_joint_pos_sin
   					---- robot0_joint_vel
		-mask
			-- first_10
重点数据示例:

env_args的内容如下:
在这里插入图片描述demo/model_file的内容如下:

<mujoco model="base">\n  
	<compiler angle="radian" meshdir="meshes/" autolimits="true" />\n  
	<option impratio="20" density="1.2" viscosity="2e-05" cone="elliptic" />\n  
	<size njmax="5000" nconmax="5000" />\n  <visual>\n    
	<map znear="0.001" />\n  
	</visual>\n 
	 <default />\n  
	 <asset>\n   
	  <texture type="skybox" builtin="gradient" rgb1="0.9 0.9 1" rgb2="0.2 0.3 0.4" width="256" height="1536" />\n   
	   <texture type="2d" name="texplane" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/arenas/../textures/light-gray-floor-tile.png" />\n  
	   <texture type="cube" name="tex-ceramic" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/arenas/../textures/ceramic.png" />\n    <texture type="cube" name="tex-steel-brushed" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/arenas/../textures/steel-brushed.png" />\n    <texture type="2d" name="tex-light-gray-plaster" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/arenas/../textures/light-gray-plaster.png" />\n    <texture type="cube" name="textable" builtin="flat" rgb1="0.5 0.5 0.5" width="512" height="3072" />\n    <texture type="cube" name="coffee_pod_tex-ceramic" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/objects/../textures/ceramic.png" />\n    <texture type="cube" name="coffee_machine_body_tex-ceramic" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/objects/../textures/ceramic.png" />\n    <texture type="cube" name="coffee_machine_lid_tex-ceramic" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/objects/../textures/ceramic.png" />\n    <texture type="cube" name="coffee_machine_base_tex-ceramic" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/objects/../textures/ceramic.png" />\n    <texture type="cube" name="CabinetObject_redwood" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/textures/red-wood.png" />\n    <texture type="cube" name="CabinetObject_ceramic" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/textures/ceramic.png" />\n    <texture type="cube" name="CabinetObject_lightwood" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/textures/light-wood.png" />\n    <texture type="2d" name="mug_tex-3143a4ac" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/../../../textures/ceramic.png" />\n    <material name="floorplane" texture="texplane" texuniform="true" texrepeat="2 2" specular="0" shininess="0" reflectance="0.01" />\n    <material name="table_ceramic" texture="tex-ceramic" specular="0.2" shininess="0" />\n    <material name="table_legs_metal" texture="tex-steel-brushed" shininess="0.8" reflectance="0.8" />\n    <material name="walls_mat" texture="tex-light-gray-plaster" texuniform="true" texrepeat="3 3" specular="0.1" shininess="0.1" />\n    <material name="table_mat" texture="textable" />\n    <material name="robot0_Face636_001" shininess="0.45" rgba="0.901961 0.921569 0.929412 1" />\n    <material name="robot0_Part__Feature017_001" shininess="0.45" />\n    <material name="robot0_Part__Feature018_001" shininess="0.45" />\n    <material name="robot0_Part__Feature019_001" shininess="0.45" />\n    <material name="robot0_Part__Feature022_001" shininess="0.45" rgba="0.901961 0.921569 0.929412 1" />\n    <material name="robot0_Part__Feature023_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Shell001_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Shell002_001" shininess="0.45" rgba="0.901961 0.921569 0.929412 1" />\n    <material name="robot0_Shell003_001" shininess="0.45" rgba="0.901961 0.921569 0.929412 1" />\n    <material name="robot0_Shell009_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Shell010_001" shininess="0.45" rgba="0.901961 0.921569 0.929412 1" />\n    <material name="robot0_Shell_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Feature_001" shininess="0.45" />\n    <material name="robot0_Part__Feature024" shininess="0.45" />\n    <material name="robot0_Part__Feature001_010_001_002" shininess="0.45" />\n    <material name="robot0_Part__Feature002_007_001_002" shininess="0.45" />\n    <material name="robot0_Part__Feature003_004_001_002" shininess="0.45" />\n    <material name="robot0_Part__Feature_001_001_001_002" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Feature001_001_003_001" shininess="0.45" />\n    <material name="robot0_Part__Feature002_001_003_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Feature003_001_003_001" shininess="0.45" />\n    <material name="robot0_Part__Feature_002_003_001" shininess="0.45" />\n    <material name="robot0_Part__Feature_002_004_003" shininess="0.45" />\n    <material name="robot0_Shell001_001_001_003" shininess="0.45" rgba="0.25 0.25 0.25 1" />\n    <material name="robot0_Shell_001_001_003" shininess="0.45" />\n    <material name="robot0_Face064_002_001_002_001" shininess="0.45" rgba="1 0 0 1" />\n    <material name="robot0_Face065_002_001_002_001" shininess="0.45" rgba="0 1 0 1" />\n    <material name="robot0_Face374_002_001_002_001" shininess="0.45" />\n    <material name="robot0_Face539_002_001_002_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Feature001_009_001_002_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Feature002_006_001_002_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Shell002_002_001_002_001" shininess="0.45" />\n    <material name="robot0_Shell003_002_001_002_001" shininess="0.45" />\n    <material name="robot0_Shell004_001_001_002_001" shininess="0.45" />\n    <material name="robot0_Shell005_001_001_002_001" shininess="0.45" />\n    <material name="robot0_Shell006_003_002_001" shininess="0.45" rgba="0.901961 0.921569 0.929412 1" />\n    <material name="robot0_Shell007_002_002_001" shininess="0.45" rgba="0.25 0.25 0.25 1" />\n    <material name="robot0_Shell011_002_002_001" shininess="0.45" />\n    <material name="robot0_Shell012_002_002_001" shininess="0.45" />\n    <material name="robot0_Shell_003_001_002_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Union001_001_001_002_001" shininess="0.45" rgba="0.039216 0.541176 0.780392 1" />\n    <material name="robot0_Union_001_001_002_001" shininess="0.45" rgba="0.039216 0.541176 0.780392 1" />\n    <material name="robot0_Part__Mirroring001_004_002" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Mirroring002_004_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Mirroring003_004_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Mirroring004_004_002" shininess="0.45" />\n    <material name="robot0_Part__Mirroring005_004_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Mirroring006_004_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Mirroring007_004_001" shininess="0.45" rgba="0.25098 0.25098 0.25098 1" />\n    <material name="robot0_Part__Mirroring_004_001" shininess="0.45" rgba="0.898039 0.917647 0.929412 1" />\n    <material name="coffee_pod_ceramic" texture="coffee_pod_tex-ceramic" texuniform="true" reflectance="0.5" />\n    <material name="coffee_machine_body_ceramic" texture="coffee_machine_body_tex-ceramic" texuniform="true" reflectance="0.5" />\n    <material name="coffee_machine_lid_ceramic" texture="coffee_machine_lid_tex-ceramic" texuniform="true" reflectance="0.5" />\n    <material name="coffee_machine_base_ceramic" texture="coffee_machine_base_tex-ceramic" texuniform="true" reflectance="0.5" />\n    <material name="CabinetObject_MatRedWood" texture="CabinetObject_redwood" specular="0.4" shininess="0.1" />\n    <material name="CabinetObject_MatCeramic" texture="CabinetObject_ceramic" specular="0.4" shininess="0.1" />\n    <material name="CabinetObject_MatLightWood" texture="CabinetObject_lightwood" texrepeat="3 3" specular="0.4" shininess="0.1" />\n    <material name="mug_3143a4ac" texture="mug_tex-3143a4ac" reflectance="0.5" />\n    <material name="mug_material_0_24" specular="0.4" shininess="0.01" rgba="0.823529 0.705882 0.54902 1" />\n    <mesh name="robot0_link0" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/meshes/link0.stl" />\n    <mesh name="robot0_link1" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/meshes/link1.stl" />\n    <mesh name="robot0_link2" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/meshes/link2.stl" />\n    <mesh name="robot0_link3" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/meshes/link3.stl" />\n    <mesh name="robot0_link4" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/meshes/link4.stl" />\n    <mesh name="robot0_link5" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/meshes/link5.stl" />\n    <mesh name="robot0_link6" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/meshes/link6.stl" />\n    <mesh name="robot0_link7" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/meshes/link7.stl" />\n    <mesh name="robot0_link0_vis_0" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_0.obj" />\n    <mesh name="robot0_link0_vis_1" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_1.obj" />\n    <mesh name="robot0_link0_vis_2" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_2.obj" />\n    <mesh name="robot0_link0_vis_3" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_3.obj" />\n    <mesh name="robot0_link0_vis_4" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_4.obj" />\n    <mesh name="robot0_link0_vis_5" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_5.obj" />\n    <mesh name="robot0_link0_vis_6" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_6.obj" />\n    <mesh name="robot0_link0_vis_7" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_7.obj" />\n    <mesh name="robot0_link0_vis_8" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_8.obj" />\n    <mesh name="robot0_link0_vis_9" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_9.obj" />\n    <mesh name="robot0_link0_vis_10" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_10.obj" />\n    <mesh name="robot0_link0_vis_11" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link0_vis/link0_vis_11.obj" />\n    <mesh name="robot0_link1_vis" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link1_vis/link1_vis.obj" />\n    <mesh name="robot0_link2_vis" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link2_vis/link2_vis.obj" />\n    <mesh name="robot0_link3_vis_0" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link3_vis/link3_vis_0.obj" />\n    <mesh name="robot0_link3_vis_1" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link3_vis/link3_vis_1.obj" />\n    <mesh name="robot0_link3_vis_2" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link3_vis/link3_vis_2.obj" />\n    <mesh name="robot0_link3_vis_3" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link3_vis/link3_vis_3.obj" />\n    <mesh name="robot0_link4_vis_0" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link4_vis/link4_vis_0.obj" />\n    <mesh name="robot0_link4_vis_1" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link4_vis/link4_vis_1.obj" />\n    <mesh name="robot0_link4_vis_2" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link4_vis/link4_vis_2.obj" />\n    <mesh name="robot0_link4_vis_3" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link4_vis/link4_vis_3.obj" />\n    <mesh name="robot0_link5_vis_0" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link5_vis/link5_vis_0.obj" />\n    <mesh name="robot0_link5_vis_1" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link5_vis/link5_vis_1.obj" />\n    <mesh name="robot0_link5_vis_2" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link5_vis/link5_vis_2.obj" />\n    <mesh name="robot0_link6_vis_0" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_0.obj" />\n    <mesh name="robot0_link6_vis_1" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_1.obj" />\n    <mesh name="robot0_link6_vis_2" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_2.obj" />\n    <mesh name="robot0_link6_vis_3" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_3.obj" />\n    <mesh name="robot0_link6_vis_4" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_4.obj" />\n    <mesh name="robot0_link6_vis_5" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_5.obj" />\n    <mesh name="robot0_link6_vis_6" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_6.obj" />\n    <mesh name="robot0_link6_vis_7" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_7.obj" />\n    <mesh name="robot0_link6_vis_8" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_8.obj" />\n    <mesh name="robot0_link6_vis_9" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_9.obj" />\n    <mesh name="robot0_link6_vis_10" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_10.obj" />\n    <mesh name="robot0_link6_vis_11" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_11.obj" />\n    <mesh name="robot0_link6_vis_12" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_12.obj" />\n    <mesh name="robot0_link6_vis_13" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_13.obj" />\n    <mesh name="robot0_link6_vis_14" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_14.obj" />\n    <mesh name="robot0_link6_vis_15" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_15.obj" />\n    <mesh name="robot0_link6_vis_16" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link6_vis/link6_vis_16.obj" />\n    <mesh name="robot0_link7_vis_0" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link7_vis/link7_vis_0.obj" />\n    <mesh name="robot0_link7_vis_1" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link7_vis/link7_vis_1.obj" />\n    <mesh name="robot0_link7_vis_2" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link7_vis/link7_vis_2.obj" />\n    <mesh name="robot0_link7_vis_3" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link7_vis/link7_vis_3.obj" />\n    <mesh name="robot0_link7_vis_4" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link7_vis/link7_vis_4.obj" />\n    <mesh name="robot0_link7_vis_5" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link7_vis/link7_vis_5.obj" />\n    <mesh name="robot0_link7_vis_6" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link7_vis/link7_vis_6.obj" />\n    <mesh name="robot0_link7_vis_7" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/robots/panda/obj_meshes/link7_vis/link7_vis_7.obj" />\n    <mesh name="mount0_pedestal" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/mounts/meshes/rethink_mount/pedestal.stl" />\n    <mesh name="gripper0_hand" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/grippers/meshes/panda_gripper/hand.stl" />\n    <mesh name="gripper0_hand_vis" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/grippers/meshes/panda_gripper/hand_vis.stl" />\n    <mesh name="gripper0_finger" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/grippers/meshes/panda_gripper/finger.stl" />\n    <mesh name="gripper0_finger_vis" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/grippers/meshes/panda_gripper/finger_vis.stl" />\n    <mesh name="gripper0_finger_vis2" file="/Users/amandlekar/Desktop/installed_libraries/robosuite/robosuite/models/assets/grippers/meshes/panda_gripper/finger_longer.stl" />\n    <mesh name="coffee_pod_mesh" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/objects/meshes/coffee_pod.stl" scale="0.018 0.018 0.018" />\n    <mesh name="coffee_machine_body_coffee_body_mesh" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/objects/meshes/coffee_body.stl" scale="0.01 0.01 0.01" />\n    <mesh name="coffee_machine_lid_coffee_lid_mesh" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/objects/meshes/coffee_lid.stl" scale="0.01 0.01 0.01" />\n    <mesh name="coffee_machine_base_coffee_base_mesh" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/objects/meshes/coffee_base.stl" scale="0.01 0.01 0.01" />\n    <mesh name="mug_model_normalized_0_vis" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/visual/model_normalized_0.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_13._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_13.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_16._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_16.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_30._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_30.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_21._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_21.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_1._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_1.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_20._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_20.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_27._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_27.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_10._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_10.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_24._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_24.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_28._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_28.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_25._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_25.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_23._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_23.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_6._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_6.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_8._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_8.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_2._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_2.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_12._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_12.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_4._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_4.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_19._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_19.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_5._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_5.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_14._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_14.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_11._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_11.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_15._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_15.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_18._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_18.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_29._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_29.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_26._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_26.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_17._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_17.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_31._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_31.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_3._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_3.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_9._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_9.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_22._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_22.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_7._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_7.obj" scale="0.15 0.15 0.15" />\n    <mesh name="mug_model_normalized_collision_0._coll" file="/Users/amandlekar/Desktop/installed_libraries/mimicgen_environments/mimicgen_envs/models/robosuite/assets/shapenet_core/mugs/3143a4ac/collision/model_normalized_collision_0.obj" scale="0.15 0.15 0.15" />\n  </asset>\n  <worldbody>\n    <geom name="floor" size="3 3 0.125" type="plane" group="1" material="floorplane" />\n    <geom name="wall_leftcorner_visual" size="1.06 1.5 0.01" pos="-1.25 2.25 1.5" quat="0.653281 0.653281 0.270598 0.270598" type="box" contype="0" conaffinity="0" group="1" material="walls_mat" />\n    <geom name="wall_rightcorner_visual" size="1.06 1.5 0.01" pos="-1.25 -2.25 1.5" quat="0.653281 0.653281 -0.270598 -0.270598" type="box" contype="0" conaffinity="0" group="1" material="walls_mat" />\n    <geom name="wall_left_visual" size="1.75 1.5 0.01" pos="1.25 3 1.5" quat="0.707107 0.707107 0 0" type="box" contype="0" conaffinity="0" group="1" material="walls_mat" />\n    <geom name="wall_right_visual" size="1.75 1.5 0.01" pos="1.25 -3 1.5" quat="0.707107 -0.707107 0 0" type="box" contype="0" conaffinity="0" group="1" material="walls_mat" />\n    <geom name="wall_rear_visual" size="1.5 1.5 0.01" pos="-2 0 1.5" quat="0.5 0.5 0.5 0.5" type="box" contype="0" conaffinity="0" group="1" material="walls_mat" />\n    <geom name="wall_front_visual" size="3 1.5 0.01" pos="3 0 1.5" quat="0.5 0.5 -0.5 -0.5" type="box" contype="0" conaffinity="0" group="1" material="walls_mat" />\n    <camera name="frontview" pos="1.6 0 1.45" quat="0.560842 0.430646 0.430646 0.560842" />\n    <camera name="birdview" pos="-0.2 0 3" quat="0.707107 0 0 0.707107" />\n    <camera name="agentview" pos="0.753078 2.06204e-08 1.51947" quat="0.643241 0.293668 0.293668 0.643241" />\n    <camera name="sideview" pos="-0.0565177 1.27612 1.48796" quat="0.00990507 0.00687796 0.591223 0.806418" />\n    <camera name="agentview_full" pos="0.5 0 1.35" quat="0.653098 0.271041 0.271041 0.653098" />\n    <light pos="1 1 1.5" dir="-0.19245 -0.19245 -0.96225" directional="true" castshadow="false" />\n    <body name="table" pos="0 0 0.775" gravcomp="0">\n      <geom name="table_collision" size="0.4 0.4 0.025" type="box" rgba="0.5 0.5 0 1" />\n      <geom name="table_visual" size="0.4 0.4 0.025" type="box" contype="0" conaffinity="0" group="1" material="table_ceramic" />\n      <geom name="table_leg1_visual" size="0.025 0.3875" pos="0.3 0.3 -0.3875" type="cylinder" contype="0" conaffinity="0" group="1" material="table_legs_metal" />\n      <geom name="table_leg2_visual" size="0.025 0.3875" pos="-0.3 0.3 -0.3875" type="cylinder" contype="0" conaffinity="0" group="1" material="table_legs_metal" />\n      <geom name="table_leg3_visual" size="0.025 0.3875" pos="-0.3 -0.3 -0.3875" type="cylinder" contype="0" conaffinity="0" group="1" material="table_legs_metal" />\n      <geom name="table_leg4_visual" size="0.025 0.3875" pos="0.3 -0.3 -0.3875" type="cylinder" contype="0" conaffinity="0" group="1" material="table_legs_metal" />\n      <site name="table_top" pos="0 0 0.025" size="0.001" rgba="0 0 0 0" />\n    </body>\n    <body name="robot0_base" pos="-0.56 0 0.912" gravcomp="0">\n      <inertial pos="0 0 0" mass="0" diaginertia="0 0 0" />\n      <camera name="robot0_robotview" pos="1 0 0.4" quat="0.653098 0.271041 0.271041 0.653098" />\n      <body name="robot0_link0" pos="0 0 0" gravcomp="0">\n        <inertial pos="0 0 0.05" mass="4" diaginertia="0.4 0.4 0.4" />\n        <geom name="robot0_g0_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell010_001" mesh="robot0_link0_vis_0" />\n        <geom name="robot0_g1_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell009_001" mesh="robot0_link0_vis_1" />\n        <geom name="robot0_g2_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell003_001" mesh="robot0_link0_vis_2" />\n        <geom name="robot0_g3_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell_001" mesh="robot0_link0_vis_3" />\n        <geom name="robot0_g4_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell002_001" mesh="robot0_link0_vis_4" />\n        <geom name="robot0_g5_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell001_001" mesh="robot0_link0_vis_5" />\n        <geom name="robot0_g6_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Face636_001" mesh="robot0_link0_vis_6" />\n        <geom name="robot0_g7_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature018_001" mesh="robot0_link0_vis_7" />\n        <geom name="robot0_g8_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature019_001" mesh="robot0_link0_vis_8" />\n        <geom name="robot0_g9_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature023_001" mesh="robot0_link0_vis_9" />\n        <geom name="robot0_g10_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature022_001" mesh="robot0_link0_vis_10" />\n        <geom name="robot0_g11_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature017_001" mesh="robot0_link0_vis_11" />\n        <geom name="robot0_link0_collision" type="mesh" rgba="0 0.5 0 1" mesh="robot0_link0" />\n        <body name="robot0_link1" pos="0 0 0.333" gravcomp="0">\n          <inertial pos="0 0 -0.07" mass="3" diaginertia="0.3 0.3 0.3" />\n          <joint name="robot0_joint1" pos="0 0 0" axis="0 0 1" range="-2.8973 2.8973" armature="5" damping="0.1" frictionloss="0.1" />\n          <geom name="robot0_g12_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature_001" mesh="robot0_link1_vis" />\n          <geom name="robot0_link1_collision" type="mesh" rgba="0 0.5 0 1" mesh="robot0_link1" />\n          <body name="robot0_link2" pos="0 0 0" quat="0.707107 -0.707107 0 0" gravcomp="0">\n            <inertial pos="0 -0.1 0" mass="3" diaginertia="0.3 0.3 0.3" />\n            <joint name="robot0_joint2" pos="0 0 0" axis="0 0 1" range="-1.7628 1.7628" armature="2.5" damping="0.1" frictionloss="0.1" />\n            <geom name="robot0_g13_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature024" mesh="robot0_link2_vis" />\n            <geom name="robot0_link2_collision" type="mesh" rgba="0 0.5 0 1" mesh="robot0_link2" />\n            <body name="robot0_link3" pos="0 -0.316 0" quat="0.707107 0.707107 0 0" gravcomp="0">\n              <inertial pos="0.04 0 -0.05" mass="2" diaginertia="0.2 0.2 0.2" />\n              <joint name="robot0_joint3" pos="0 0 0" axis="0 0 1" range="-2.8973 2.8973" armature="1.66667" damping="0.1" frictionloss="0.1" />\n              <geom name="robot0_g14_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature003_004_001_002" mesh="robot0_link3_vis_0" />\n              <geom name="robot0_g15_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature002_007_001_002" mesh="robot0_link3_vis_1" />\n              <geom name="robot0_g16_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature001_010_001_002" mesh="robot0_link3_vis_2" />\n              <geom name="robot0_g17_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature_001_001_001_002" mesh="robot0_link3_vis_3" />\n              <geom name="robot0_link3_collision" type="mesh" rgba="0 0.5 0 1" mesh="robot0_link3" />\n              <body name="robot0_link4" pos="0.0825 0 0" quat="0.707107 0.707107 0 0" gravcomp="0">\n                <inertial pos="-0.04 0.05 0" mass="2" diaginertia="0.2 0.2 0.2" />\n                <joint name="robot0_joint4" pos="0 0 0" axis="0 0 1" range="-3.0718 -0.0698" armature="1.25" damping="0.1" frictionloss="0.1" />\n                <geom name="robot0_g18_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature001_001_003_001" mesh="robot0_link4_vis_0" />\n                <geom name="robot0_g19_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature003_001_003_001" mesh="robot0_link4_vis_1" />\n                <geom name="robot0_g20_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature002_001_003_001" mesh="robot0_link4_vis_2" />\n                <geom name="robot0_g21_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature_002_003_001" mesh="robot0_link4_vis_3" />\n                <geom name="robot0_link4_collision" type="mesh" rgba="0 0.5 0 1" mesh="robot0_link4" />\n                <body name="robot0_link5" pos="-0.0825 0.384 0" quat="0.707107 -0.707107 0 0" gravcomp="0">\n                  <inertial pos="0 0 -0.15" mass="2" diaginertia="0.2 0.2 0.2" />\n                  <joint name="robot0_joint5" pos="0 0 0" axis="0 0 1" range="-2.8973 2.8973" armature="1" damping="0.1" frictionloss="0.1" />\n                  <geom name="robot0_g22_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell001_001_001_003" mesh="robot0_link5_vis_0" />\n                  <geom name="robot0_g23_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell_001_001_003" mesh="robot0_link5_vis_1" />\n                  <geom name="robot0_g24_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature_002_004_003" mesh="robot0_link5_vis_2" />\n                  <geom name="robot0_link5_collision" type="mesh" rgba="0 0.5 0 1" mesh="robot0_link5" />\n                  <body name="robot0_link6" pos="0 0 0" quat="0.707107 0.707107 0 0" gravcomp="0">\n                    <inertial pos="0.06 0 0" mass="1.5" diaginertia="0.1 0.1 0.1" />\n                    <joint name="robot0_joint6" pos="0 0 0" axis="0 0 1" range="-0.0175 3.7525" armature="0.833333" damping="0.01" frictionloss="0.1" />\n                    <geom name="robot0_g25_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell006_003_002_001" mesh="robot0_link6_vis_0" />\n                    <geom name="robot0_g26_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell011_002_002_001" mesh="robot0_link6_vis_1" />\n                    <geom name="robot0_g27_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell007_002_002_001" mesh="robot0_link6_vis_2" />\n                    <geom name="robot0_g28_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell005_001_001_002_001" mesh="robot0_link6_vis_3" />\n                    <geom name="robot0_g29_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell004_001_001_002_001" mesh="robot0_link6_vis_4" />\n                    <geom name="robot0_g30_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell003_002_001_002_001" mesh="robot0_link6_vis_5" />\n                    <geom name="robot0_g31_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell002_002_001_002_001" mesh="robot0_link6_vis_6" />\n                    <geom name="robot0_g32_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Union001_001_001_002_001" mesh="robot0_link6_vis_7" />\n                    <geom name="robot0_g33_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Union_001_001_002_001" mesh="robot0_link6_vis_8" />\n                    <geom name="robot0_g34_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Face539_002_001_002_001" mesh="robot0_link6_vis_9" />\n                    <geom name="robot0_g35_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell_003_001_002_001" mesh="robot0_link6_vis_10" />\n                    <geom name="robot0_g36_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Face374_002_001_002_001" mesh="robot0_link6_vis_11" />\n                    <geom name="robot0_g37_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Face065_002_001_002_001" mesh="robot0_link6_vis_12" />\n                    <geom name="robot0_g38_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Face064_002_001_002_001" mesh="robot0_link6_vis_13" />\n                    <geom name="robot0_g39_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature002_006_001_002_001" mesh="robot0_link6_vis_14" />\n                    <geom name="robot0_g40_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Feature001_009_001_002_001" mesh="robot0_link6_vis_15" />\n                    <geom name="robot0_g41_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Shell012_002_002_001" mesh="robot0_link6_vis_16" />\n                    <geom name="robot0_link6_collision" type="mesh" rgba="0 0.5 0 1" mesh="robot0_link6" />\n                    <body name="robot0_link7" pos="0.088 0 0" quat="0.707107 0.707107 0 0" gravcomp="0">\n                      <inertial pos="0 0 0.08" mass="0.5" diaginertia="0.05 0.05 0.05" />\n                      <joint name="robot0_joint7" pos="0 0 0" axis="0 0 1" range="-2.8973 2.8973" armature="0.714286" damping="0.01" frictionloss="0.1" />\n                      <geom name="robot0_g42_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Mirroring004_004_002" mesh="robot0_link7_vis_0" />\n                      <geom name="robot0_g43_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Mirroring001_004_002" mesh="robot0_link7_vis_1" />\n                      <geom name="robot0_g44_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Mirroring007_004_001" mesh="robot0_link7_vis_2" />\n                      <geom name="robot0_g45_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Mirroring006_004_001" mesh="robot0_link7_vis_3" />\n                      <geom name="robot0_g46_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Mirroring005_004_001" mesh="robot0_link7_vis_4" />\n                      <geom name="robot0_g47_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Mirroring003_004_001" mesh="robot0_link7_vis_5" />\n                      <geom name="robot0_g48_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Mirroring002_004_001" mesh="robot0_link7_vis_6" />\n                      <geom name="robot0_g49_vis" type="mesh" contype="0" conaffinity="0" group="1" material="robot0_Part__Mirroring_004_001" mesh="robot0_link7_vis_7" />\n                      <geom name="robot0_link7_collision" type="mesh" rgba="0 0.5 0 1" mesh="robot0_link7" />\n                      <body name="robot0_right_hand" pos="0 0 0.1065" quat="0.923785 0 0 -0.382911" gravcomp="0">\n                        <inertial pos="0 0 0" mass="0.5" diaginertia="0.05 0.05 0.05" />\n                        <camera name="robot0_eye_in_hand" pos="0.05 0 0" quat="0 0.707107 0.707107 0" fovy="75" />\n                        <body name="gripper0_right_gripper" pos="0 0 0" quat="0.707107 0 0 -0.707107" gravcomp="0">\n                          <inertial pos="0 0 0.17" quat="0.707107 0.707107 0 0" mass="0.3" diaginertia="0.09 0.07 0.05" />\n                          <geom name="gripper0_hand_visual" quat="0.707107 0 0 0.707107" type="mesh" contype="0" conaffinity="0" group="1" rgba="1 1 1 1" mesh="gripper0_hand_vis" />\n                          <geom name="gripper0_hand_collision" quat="0.707107 0 0 0.707107" type="mesh" rgba="0 0 0.5 1" mesh="gripper0_hand" />\n                          <site name="gripper0_ft_frame" pos="0 0 0" size="0.01" group="1" rgba="1 0 0 -1" />\n                          <body name="gripper0_eef" pos="0 0 0.097" gravcomp="0">\n                            <site name="gripper0_grip_site" pos="0 0 0" size="0.01" group="1" rgba="1 0 0 -0.5" />\n                            <site name="gripper0_ee_x" pos="0.1 0 0" quat="0.707105 0 0.707108 0" size="0.005 0.1" group="1" type="cylinder" rgba="1 0 0 0" />\n                            <site name="gripper0_ee_y" pos="0 0.1 0" quat="0.707105 0.707108 0 0" size="0.005 0.1" group="1" type="cylinder" rgba="0 1 0 0" />\n                            <site name="gripper0_ee_z" pos="0 0 0.1" size="0.005 0.1" group="1" type="cylinder" rgba="0 0 1 0" />\n                            <site name="gripper0_grip_site_cylinder" pos="0 0 0" size="0.005 10" group="1" type="cylinder" rgba="0 1 0 -0.3" />\n                          </body>\n                          <body name="gripper0_leftfinger" pos="0 0 0.0524" quat="0.707107 0 0 0.707107" gravcomp="0">\n                            <inertial pos="0 0 0.05" mass="0.1" diaginertia="0.01 0.01 0.005" />\n                            <joint name="gripper0_finger_joint1" pos="0 0 0" axis="0 1 0" type="slide" range="0 0.04" armature="1" damping="100" frictionloss="1" />\n                            <geom name="gripper0_finger1_visual" type="mesh" contype="0" conaffinity="0" group="1" rgba="0.499 0.499 0.499 1" mesh="gripper0_finger_vis" />\n                            <geom name="gripper0_finger1_collision" type="mesh" contype="0" condim="4" rgba="0 0 0.5 1" mesh="gripper0_finger" />\n                            <body name="gripper0_finger_joint1_tip" pos="0 0.0085 0.056" gravcomp="0">\n                              <inertial pos="0 0 0" quat="0 0 0 1" mass="0.01" diaginertia="0.01 0.01 0.01" />\n                              <geom name="gripper0_finger1_pad_collision" size="0.008 0.004 0.008" pos="0 -0.005 -0.015" quat="0 0 0 1" type="box" friction="2 0.05 0.0001" solref="0.01 0.5" rgba="0 0 0.5 1" />\n                            </body>\n                          </body>\n                          <body name="gripper0_rightfinger" pos="0 0 0.0524" quat="0.707107 0 0 0.707107" gravcomp="0">\n                            <inertial pos="0 0 0.05" mass="0.1" diaginertia="0.01 0.01 0.005" />\n                            <joint name="gripper0_finger_joint2" pos="0 0 0" axis="0 1 0" type="slide" range="-0.04 0" armature="1" damping="100" frictionloss="1" />\n                            <geom name="gripper0_finger2_visual" quat="0 0 0 1" type="mesh" contype="0" conaffinity="0" group="1" rgba="0.499 0.499 0.499 1" mesh="gripper0_finger_vis" />\n                            <geom name="gripper0_finger2_collision" quat="0 0 0 1" type="mesh" contype="0" condim="4" rgba="0 0 0.5 1" mesh="gripper0_finger" />\n                            <body name="gripper0_finger_joint2_tip" pos="0 -0.0085 0.056" gravcomp="0">\n                              <inertial pos="0 0 0" quat="0 0 0 1" mass="0.01" diaginertia="0.01 0.01 0.01" />\n                              <geom name="gripper0_finger2_pad_collision" size="0.008 0.004 0.008" pos="0 0.005 -0.015" quat="0 0 0 1" type="box" friction="2 0.05 0.0001" solref="0.01 0.5" rgba="0 0 0.5 1" />\n                            </body>\n                          </body>\n                        </body>\n                      </body>\n                    </body>\n                  </body>\n                </body>\n              </body>\n            </body>\n          </body>\n        </body>\n      </body>\n      <body name="mount0_base" pos="0 0 0.01" gravcomp="0">\n        <body name="mount0_controller_box" pos="0 0 0" gravcomp="0">\n          <inertial pos="-0.325 0 -0.38" mass="46.64" diaginertia="1.71363 1.27988 0.809981" />\n          <geom name="mount0_controller_box_col" size="0.11 0.2 0.265" pos="-0.325 0 -0.38" type="box" rgba="0.5 0.5 0 1" />\n        </body>\n        <body name="mount0_pedestal_feet" pos="0 0 0" gravcomp="0">\n          <inertial pos="-0.1225 0 -0.758" mass="167.09" diaginertia="8.16095 9.59375 15.0785" />\n          <geom name="mount0_pedestal_feet_col" size="0.385 0.35 0.155" pos="-0.1225 0 -0.758" type="box" rgba="0.5 0.5 0 1" />\n        </body>\n        <body name="mount0_torso" pos="0 0 0" gravcomp="0">\n          <inertial pos="0 0 0" mass="0.0001" diaginertia="1e-08 1e-08 1e-08" />\n          <geom name="mount0_torso_vis" size="0.05 0.05 0.05" pos="0 0 -0.05" type="box" contype="0" conaffinity="0" group="1" rgba="0.2 0.2 0.2 1" />\n        </body>\n        <body name="mount0_pedestal" pos="0 0 0" gravcomp="0">\n          <inertial pos="0 0 0" quat="0.659267 -0.259505 -0.260945 0.655692" mass="60.864" diaginertia="6.0869 5.81635 4.20915" />\n          <geom name="mount0_pedestal_vis" type="mesh" contype="0" conaffinity="0" group="1" rgba="0.2 0.2 0.2 1" mesh="mount0_pedestal" />\n          <geom name="mount0_pedestal_col" size="0.18 0.31" pos="-0.02 0 -0.29" type="cylinder" rgba="0.5 0.5 0 1" />\n        </body>\n      </body>\n    </body>\n    <body name="coffee_pod_main" pos="0 0 0" gravcomp="0">\n      <joint name="coffee_pod_joint0" type="free" />\n      <geom name="coffee_pod_g0" type="mesh" condim="4" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" density="100" rgba="0.5 0 0 1" mesh="coffee_pod_mesh" />\n      <geom name="coffee_pod_g0_visual" type="mesh" contype="0" conaffinity="0" condim="4" group="1" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" mass="0" material="coffee_pod_ceramic" rgba="0.839 0.839 0.839 1" mesh="coffee_pod_mesh" />\n      <site name="coffee_pod_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n    </body>\n    <body name="coffee_machine_root" pos="0 0 0" gravcomp="0">\n      <joint name="coffee_machine_joint0" type="free" />\n      <site name="coffee_machine_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n      <body name="coffee_machine_body_main" pos="0 -0.05 0" quat="0 0 0 1" gravcomp="0">\n        <geom name="coffee_machine_body_g0" type="mesh" condim="4" friction="0.95 0.3 0.1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" rgba="0.5 0 0 1" mesh="coffee_machine_body_coffee_body_mesh" />\n        <geom name="coffee_machine_body_g0_visual" type="mesh" contype="0" conaffinity="0" condim="4" group="1" friction="0.95 0.3 0.1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" mass="0" material="coffee_machine_body_ceramic" rgba="0.13 0.13 0.13 1" mesh="coffee_machine_body_coffee_body_mesh" />\n        <site name="coffee_machine_body_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n      </body>\n      <body name="coffee_machine_lid_main" pos="0 0.1045 0.106" gravcomp="0">\n        <joint name="coffee_machine_lid_main_joint0" pos="0 -0.044 0" axis="1 0 0" range="0 2.0944" damping="0.005" />\n        <geom name="coffee_machine_lid_g0" type="mesh" condim="4" friction="0.95 0.3 0.1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" rgba="0.5 0 0 1" mesh="coffee_machine_lid_coffee_lid_mesh" />\n        <geom name="coffee_machine_lid_g0_visual" type="mesh" contype="0" conaffinity="0" condim="4" group="1" friction="0.95 0.3 0.1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" mass="0" material="coffee_machine_lid_ceramic" rgba="0.839 0.839 0.839 1" mesh="coffee_machine_lid_coffee_lid_mesh" />\n        <site name="coffee_machine_lid_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n      </body>\n      <body name="coffee_machine_base_main" pos="0 0.1005 -0.1055" quat="0 0 0 1" gravcomp="0">\n        <geom name="coffee_machine_base_g0" type="mesh" condim="4" friction="0.95 0.3 0.1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" rgba="0.5 0 0 1" mesh="coffee_machine_base_coffee_base_mesh" />\n        <geom name="coffee_machine_base_g0_visual" type="mesh" contype="0" conaffinity="0" condim="4" group="1" friction="0.95 0.3 0.1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" mass="0" material="coffee_machine_base_ceramic" rgba="0.13 0.13 0.13 1" mesh="coffee_machine_base_coffee_base_mesh" />\n        <site name="coffee_machine_base_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n      </body>\n      <body name="coffee_machine_pod_holder_holder_main" pos="0 0.06355 0.0865" gravcomp="0">\n        <geom name="coffee_machine_pod_holder_holder_g0" size="0.01 0.01305 0.005" type="box" rgba="0.5 0 0 1" />\n        <geom name="coffee_machine_pod_holder_holder_g0_vis" size="0.01 0.01305 0.005" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="0.839 0.839 0.839 1" />\n        <site name="coffee_machine_pod_holder_holder_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 -1" />\n      </body>\n      <body name="coffee_machine_pod_holder_root" pos="0 0.1061 0.0635" gravcomp="0">\n        <site name="coffee_machine_pod_holder_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n        <body name="coffee_machine_pod_holder_cup_body_root" pos="0 0 0" gravcomp="0">\n          <geom name="coffee_machine_pod_holder_cup_body_hc_0" size="0.00224729 0.0014475 0.028" pos="-0.0272172 0 0" quat="0 0 0 1" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_0_vis" size="0.00224729 0.0014475 0.028" pos="-0.0272172 0 0" quat="0 0 0 1" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_1" size="0.00224729 0.0014475 0.028" pos="-0.0270861 0.00266775 0" quat="0.0490677 0 0 0.998795" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_1_vis" size="0.00224729 0.0014475 0.028" pos="-0.0270861 0.00266775 0" quat="0.0490677 0 0 0.998795" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_2" size="0.00224729 0.0014475 0.028" pos="-0.0266942 0.00530981 0" quat="0.0980171 0 0 0.995185" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_2_vis" size="0.00224729 0.0014475 0.028" pos="-0.0266942 0.00530981 0" quat="0.0980171 0 0 0.995185" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_3" size="0.00224729 0.0014475 0.028" pos="-0.0260452 0.00790073 0" quat="0.14673 0 0 0.989177" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_3_vis" size="0.00224729 0.0014475 0.028" pos="-0.0260452 0.00790073 0" quat="0.14673 0 0 0.989177" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_4" size="0.00224729 0.0014475 0.028" pos="-0.0251454 0.0104156 0" quat="0.19509 0 0 0.980785" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_4_vis" size="0.00224729 0.0014475 0.028" pos="-0.0251454 0.0104156 0" quat="0.19509 0 0 0.980785" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_5" size="0.00224729 0.0014475 0.028" pos="-0.0240034 0.0128301 0" quat="0.24298 0 0 0.970031" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_5_vis" size="0.00224729 0.0014475 0.028" pos="-0.0240034 0.0128301 0" quat="0.24298 0 0 0.970031" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_6" size="0.00224729 0.0014475 0.028" pos="-0.0226303 0.0151211 0" quat="0.290285 0 0 0.95694" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_6_vis" size="0.00224729 0.0014475 0.028" pos="-0.0226303 0.0151211 0" quat="0.290285 0 0 0.95694" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_7" size="0.00224729 0.0014475 0.028" pos="-0.0210392 0.0172664 0" quat="0.33689 0 0 0.941544" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_7_vis" size="0.00224729 0.0014475 0.028" pos="-0.0210392 0.0172664 0" quat="0.33689 0 0 0.941544" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_8" size="0.00224729 0.0014475 0.028" pos="-0.0192454 0.0192454 0" quat="0.382683 0 0 0.92388" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_8_vis" size="0.00224729 0.0014475 0.028" pos="-0.0192454 0.0192454 0" quat="0.382683 0 0 0.92388" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_9" size="0.00224729 0.0014475 0.028" pos="-0.0172664 0.0210392 0" quat="0.427555 0 0 0.903989" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_9_vis" size="0.00224729 0.0014475 0.028" pos="-0.0172664 0.0210392 0" quat="0.427555 0 0 0.903989" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_10" size="0.00224729 0.0014475 0.028" pos="-0.0151211 0.0226303 0" quat="0.471397 0 0 0.881921" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_10_vis" size="0.00224729 0.0014475 0.028" pos="-0.0151211 0.0226303 0" quat="0.471397 0 0 0.881921" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_11" size="0.00224729 0.0014475 0.028" pos="-0.0128301 0.0240034 0" quat="0.514103 0 0 0.857729" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_11_vis" size="0.00224729 0.0014475 0.028" pos="-0.0128301 0.0240034 0" quat="0.514103 0 0 0.857729" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_12" size="0.00224729 0.0014475 0.028" pos="-0.0104156 0.0251454 0" quat="0.55557 0 0 0.83147" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_12_vis" size="0.00224729 0.0014475 0.028" pos="-0.0104156 0.0251454 0" quat="0.55557 0 0 0.83147" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_13" size="0.00224729 0.0014475 0.028" pos="-0.00790073 0.0260452 0" quat="0.595699 0 0 0.803208" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_13_vis" size="0.00224729 0.0014475 0.028" pos="-0.00790073 0.0260452 0" quat="0.595699 0 0 0.803208" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_14" size="0.00224729 0.0014475 0.028" pos="-0.00530981 0.0266942 0" quat="0.634393 0 0 0.77301" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_14_vis" size="0.00224729 0.0014475 0.028" pos="-0.00530981 0.0266942 0" quat="0.634393 0 0 0.77301" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_15" size="0.00224729 0.0014475 0.028" pos="-0.00266775 0.0270861 0" quat="0.671559 0 0 0.740951" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_15_vis" size="0.00224729 0.0014475 0.028" pos="-0.00266775 0.0270861 0" quat="0.671559 0 0 0.740951" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_16" size="0.00224729 0.0014475 0.028" pos="0 0.0272172 0" quat="0.707107 0 0 0.707107" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_16_vis" size="0.00224729 0.0014475 0.028" pos="0 0.0272172 0" quat="0.707107 0 0 0.707107" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_17" size="0.00224729 0.0014475 0.028" pos="0.00266775 0.0270861 0" quat="0.740951 0 0 0.671559" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_17_vis" size="0.00224729 0.0014475 0.028" pos="0.00266775 0.0270861 0" quat="0.740951 0 0 0.671559" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_18" size="0.00224729 0.0014475 0.028" pos="0.00530981 0.0266942 0" quat="0.77301 0 0 0.634393" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_18_vis" size="0.00224729 0.0014475 0.028" pos="0.00530981 0.0266942 0" quat="0.77301 0 0 0.634393" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_19" size="0.00224729 0.0014475 0.028" pos="0.00790073 0.0260452 0" quat="0.803208 0 0 0.595699" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_19_vis" size="0.00224729 0.0014475 0.028" pos="0.00790073 0.0260452 0" quat="0.803208 0 0 0.595699" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_20" size="0.00224729 0.0014475 0.028" pos="0.0104156 0.0251454 0" quat="0.83147 0 0 0.55557" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_20_vis" size="0.00224729 0.0014475 0.028" pos="0.0104156 0.0251454 0" quat="0.83147 0 0 0.55557" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_21" size="0.00224729 0.0014475 0.028" pos="0.0128301 0.0240034 0" quat="0.857729 0 0 0.514103" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_21_vis" size="0.00224729 0.0014475 0.028" pos="0.0128301 0.0240034 0" quat="0.857729 0 0 0.514103" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_22" size="0.00224729 0.0014475 0.028" pos="0.0151211 0.0226303 0" quat="0.881921 0 0 0.471397" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_22_vis" size="0.00224729 0.0014475 0.028" pos="0.0151211 0.0226303 0" quat="0.881921 0 0 0.471397" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_23" size="0.00224729 0.0014475 0.028" pos="0.0172664 0.0210392 0" quat="0.903989 0 0 0.427555" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_23_vis" size="0.00224729 0.0014475 0.028" pos="0.0172664 0.0210392 0" quat="0.903989 0 0 0.427555" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_24" size="0.00224729 0.0014475 0.028" pos="0.0192454 0.0192454 0" quat="0.92388 0 0 0.382683" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_24_vis" size="0.00224729 0.0014475 0.028" pos="0.0192454 0.0192454 0" quat="0.92388 0 0 0.382683" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_25" size="0.00224729 0.0014475 0.028" pos="0.0210392 0.0172664 0" quat="0.941544 0 0 0.33689" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_25_vis" size="0.00224729 0.0014475 0.028" pos="0.0210392 0.0172664 0" quat="0.941544 0 0 0.33689" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_26" size="0.00224729 0.0014475 0.028" pos="0.0226303 0.0151211 0" quat="0.95694 0 0 0.290285" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_26_vis" size="0.00224729 0.0014475 0.028" pos="0.0226303 0.0151211 0" quat="0.95694 0 0 0.290285" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_27" size="0.00224729 0.0014475 0.028" pos="0.0240034 0.0128301 0" quat="0.970031 0 0 0.24298" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_27_vis" size="0.00224729 0.0014475 0.028" pos="0.0240034 0.0128301 0" quat="0.970031 0 0 0.24298" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_28" size="0.00224729 0.0014475 0.028" pos="0.0251454 0.0104156 0" quat="0.980785 0 0 0.19509" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_28_vis" size="0.00224729 0.0014475 0.028" pos="0.0251454 0.0104156 0" quat="0.980785 0 0 0.19509" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_29" size="0.00224729 0.0014475 0.028" pos="0.0260452 0.00790073 0" quat="0.989177 0 0 0.14673" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_29_vis" size="0.00224729 0.0014475 0.028" pos="0.0260452 0.00790073 0" quat="0.989177 0 0 0.14673" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_30" size="0.00224729 0.0014475 0.028" pos="0.0266942 0.00530981 0" quat="0.995185 0 0 0.0980171" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_30_vis" size="0.00224729 0.0014475 0.028" pos="0.0266942 0.00530981 0" quat="0.995185 0 0 0.0980171" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_31" size="0.00224729 0.0014475 0.028" pos="0.0270861 0.00266775 0" quat="0.998795 0 0 0.0490677" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_31_vis" size="0.00224729 0.0014475 0.028" pos="0.0270861 0.00266775 0" quat="0.998795 0 0 0.0490677" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_32" size="0.00224729 0.0014475 0.028" pos="0.0272172 0 0" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_32_vis" size="0.00224729 0.0014475 0.028" pos="0.0272172 0 0" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_33" size="0.00224729 0.0014475 0.028" pos="0.0270861 -0.00266775 0" quat="0.998795 0 0 -0.0490677" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_33_vis" size="0.00224729 0.0014475 0.028" pos="0.0270861 -0.00266775 0" quat="0.998795 0 0 -0.0490677" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_34" size="0.00224729 0.0014475 0.028" pos="0.0266942 -0.00530981 0" quat="0.995185 0 0 -0.0980171" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_34_vis" size="0.00224729 0.0014475 0.028" pos="0.0266942 -0.00530981 0" quat="0.995185 0 0 -0.0980171" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_35" size="0.00224729 0.0014475 0.028" pos="0.0260452 -0.00790073 0" quat="0.989177 0 0 -0.14673" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_35_vis" size="0.00224729 0.0014475 0.028" pos="0.0260452 -0.00790073 0" quat="0.989177 0 0 -0.14673" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_36" size="0.00224729 0.0014475 0.028" pos="0.0251454 -0.0104156 0" quat="0.980785 0 0 -0.19509" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_36_vis" size="0.00224729 0.0014475 0.028" pos="0.0251454 -0.0104156 0" quat="0.980785 0 0 -0.19509" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_37" size="0.00224729 0.0014475 0.028" pos="0.0240034 -0.0128301 0" quat="0.970031 0 0 -0.24298" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_37_vis" size="0.00224729 0.0014475 0.028" pos="0.0240034 -0.0128301 0" quat="0.970031 0 0 -0.24298" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_38" size="0.00224729 0.0014475 0.028" pos="0.0226303 -0.0151211 0" quat="0.95694 0 0 -0.290285" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_38_vis" size="0.00224729 0.0014475 0.028" pos="0.0226303 -0.0151211 0" quat="0.95694 0 0 -0.290285" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_39" size="0.00224729 0.0014475 0.028" pos="0.0210392 -0.0172664 0" quat="0.941544 0 0 -0.33689" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_39_vis" size="0.00224729 0.0014475 0.028" pos="0.0210392 -0.0172664 0" quat="0.941544 0 0 -0.33689" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_40" size="0.00224729 0.0014475 0.028" pos="0.0192454 -0.0192454 0" quat="0.92388 0 0 -0.382683" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_40_vis" size="0.00224729 0.0014475 0.028" pos="0.0192454 -0.0192454 0" quat="0.92388 0 0 -0.382683" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_41" size="0.00224729 0.0014475 0.028" pos="0.0172664 -0.0210392 0" quat="0.903989 0 0 -0.427555" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_41_vis" size="0.00224729 0.0014475 0.028" pos="0.0172664 -0.0210392 0" quat="0.903989 0 0 -0.427555" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_42" size="0.00224729 0.0014475 0.028" pos="0.0151211 -0.0226303 0" quat="0.881921 0 0 -0.471397" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_42_vis" size="0.00224729 0.0014475 0.028" pos="0.0151211 -0.0226303 0" quat="0.881921 0 0 -0.471397" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_43" size="0.00224729 0.0014475 0.028" pos="0.0128301 -0.0240034 0" quat="0.857729 0 0 -0.514103" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_43_vis" size="0.00224729 0.0014475 0.028" pos="0.0128301 -0.0240034 0" quat="0.857729 0 0 -0.514103" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_44" size="0.00224729 0.0014475 0.028" pos="0.0104156 -0.0251454 0" quat="0.83147 0 0 -0.55557" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_44_vis" size="0.00224729 0.0014475 0.028" pos="0.0104156 -0.0251454 0" quat="0.83147 0 0 -0.55557" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_45" size="0.00224729 0.0014475 0.028" pos="0.00790073 -0.0260452 0" quat="0.803208 0 0 -0.595699" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_45_vis" size="0.00224729 0.0014475 0.028" pos="0.00790073 -0.0260452 0" quat="0.803208 0 0 -0.595699" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_46" size="0.00224729 0.0014475 0.028" pos="0.00530981 -0.0266942 0" quat="0.77301 0 0 -0.634393" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_46_vis" size="0.00224729 0.0014475 0.028" pos="0.00530981 -0.0266942 0" quat="0.77301 0 0 -0.634393" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_47" size="0.00224729 0.0014475 0.028" pos="0.00266775 -0.0270861 0" quat="0.740951 0 0 -0.671559" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_47_vis" size="0.00224729 0.0014475 0.028" pos="0.00266775 -0.0270861 0" quat="0.740951 0 0 -0.671559" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_48" size="0.00224729 0.0014475 0.028" pos="0 -0.0272172 0" quat="0.707107 0 0 -0.707107" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_48_vis" size="0.00224729 0.0014475 0.028" pos="0 -0.0272172 0" quat="0.707107 0 0 -0.707107" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_49" size="0.00224729 0.0014475 0.028" pos="-0.00266775 -0.0270861 0" quat="0.671559 0 0 -0.740951" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_49_vis" size="0.00224729 0.0014475 0.028" pos="-0.00266775 -0.0270861 0" quat="0.671559 0 0 -0.740951" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_50" size="0.00224729 0.0014475 0.028" pos="-0.00530981 -0.0266942 0" quat="0.634393 0 0 -0.77301" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_50_vis" size="0.00224729 0.0014475 0.028" pos="-0.00530981 -0.0266942 0" quat="0.634393 0 0 -0.77301" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_51" size="0.00224729 0.0014475 0.028" pos="-0.00790073 -0.0260452 0" quat="0.595699 0 0 -0.803208" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_51_vis" size="0.00224729 0.0014475 0.028" pos="-0.00790073 -0.0260452 0" quat="0.595699 0 0 -0.803208" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_52" size="0.00224729 0.0014475 0.028" pos="-0.0104156 -0.0251454 0" quat="0.55557 0 0 -0.83147" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_52_vis" size="0.00224729 0.0014475 0.028" pos="-0.0104156 -0.0251454 0" quat="0.55557 0 0 -0.83147" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_53" size="0.00224729 0.0014475 0.028" pos="-0.0128301 -0.0240034 0" quat="0.514103 0 0 -0.857729" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_53_vis" size="0.00224729 0.0014475 0.028" pos="-0.0128301 -0.0240034 0" quat="0.514103 0 0 -0.857729" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_54" size="0.00224729 0.0014475 0.028" pos="-0.0151211 -0.0226303 0" quat="0.471397 0 0 -0.881921" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_54_vis" size="0.00224729 0.0014475 0.028" pos="-0.0151211 -0.0226303 0" quat="0.471397 0 0 -0.881921" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_55" size="0.00224729 0.0014475 0.028" pos="-0.0172664 -0.0210392 0" quat="0.427555 0 0 -0.903989" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_55_vis" size="0.00224729 0.0014475 0.028" pos="-0.0172664 -0.0210392 0" quat="0.427555 0 0 -0.903989" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_56" size="0.00224729 0.0014475 0.028" pos="-0.0192454 -0.0192454 0" quat="0.382683 0 0 -0.92388" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_56_vis" size="0.00224729 0.0014475 0.028" pos="-0.0192454 -0.0192454 0" quat="0.382683 0 0 -0.92388" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_57" size="0.00224729 0.0014475 0.028" pos="-0.0210392 -0.0172664 0" quat="0.33689 0 0 -0.941544" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_57_vis" size="0.00224729 0.0014475 0.028" pos="-0.0210392 -0.0172664 0" quat="0.33689 0 0 -0.941544" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_58" size="0.00224729 0.0014475 0.028" pos="-0.0226303 -0.0151211 0" quat="0.290285 0 0 -0.95694" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_58_vis" size="0.00224729 0.0014475 0.028" pos="-0.0226303 -0.0151211 0" quat="0.290285 0 0 -0.95694" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_59" size="0.00224729 0.0014475 0.028" pos="-0.0240034 -0.0128301 0" quat="0.24298 0 0 -0.970031" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_59_vis" size="0.00224729 0.0014475 0.028" pos="-0.0240034 -0.0128301 0" quat="0.24298 0 0 -0.970031" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_60" size="0.00224729 0.0014475 0.028" pos="-0.0251454 -0.0104156 0" quat="0.19509 0 0 -0.980785" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_60_vis" size="0.00224729 0.0014475 0.028" pos="-0.0251454 -0.0104156 0" quat="0.19509 0 0 -0.980785" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_61" size="0.00224729 0.0014475 0.028" pos="-0.0260452 -0.00790073 0" quat="0.14673 0 0 -0.989177" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_61_vis" size="0.00224729 0.0014475 0.028" pos="-0.0260452 -0.00790073 0" quat="0.14673 0 0 -0.989177" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_62" size="0.00224729 0.0014475 0.028" pos="-0.0266942 -0.00530981 0" quat="0.0980171 0 0 -0.995185" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_62_vis" size="0.00224729 0.0014475 0.028" pos="-0.0266942 -0.00530981 0" quat="0.0980171 0 0 -0.995185" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_63" size="0.00224729 0.0014475 0.028" pos="-0.0270861 -0.00266775 0" quat="0.0490677 0 0 -0.998795" type="box" condim="4" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_body_hc_63_vis" size="0.00224729 0.0014475 0.028" pos="-0.0270861 -0.00266775 0" quat="0.0490677 0 0 -0.998795" type="box" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <site name="coffee_machine_pod_holder_cup_body_center" pos="0 0 0" size="0.002" rgba="1 0 0 -1" />\n          <site name="coffee_machine_pod_holder_cup_body_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n        </body>\n        <body name="coffee_machine_pod_holder_cup_base_main" pos="0 0 -0.021" gravcomp="0">\n          <geom name="coffee_machine_pod_holder_cup_base_g0" size="0.0272172 0.005" type="cylinder" friction="1 0.01 0.001" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" rgba="0.5 0 0 1" />\n          <geom name="coffee_machine_pod_holder_cup_base_g0_vis" size="0.0272172 0.005" type="cylinder" contype="0" conaffinity="0" group="1" mass="0" rgba="1 0 0 1" />\n          <site name="coffee_machine_pod_holder_cup_base_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 -1" />\n        </body>\n      </body>\n    </body>\n    <body name="CabinetObject_main" pos="0.15 -0.35 0.805" quat="0 0 0 1" gravcomp="0">\n      <site name="CabinetObject_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n      <body name="CabinetObject_base" pos="0 0 0" gravcomp="0">\n        <geom name="CabinetObject_drawer_left_wall" size="0.008 0.1435 0.064" pos="-0.11 -0.0315 0.065" type="box" mass="0.05" rgba="0.5 0 0 1" />\n        <geom name="CabinetObject_drawer_right_wall" size="0.008 0.1435 0.064" pos="0.11 -0.0315 0.065" type="box" mass="0.05" rgba="0.5 0 0 1" />\n        <geom name="CabinetObject_drawer_back_wall" size="0.102 0.008 0.064" pos="0 0.092 0.062" type="box" mass="0.05" rgba="0.5 0 0 1" />\n        <geom name="CabinetObject_drawer_bottom_surface" size="0.102 0.1335 0.014" pos="0 -0.0395 0.004" type="box" mass="0.05" rgba="0.5 0 0 1" />\n        <geom name="CabinetObject_drawer_top_surface" size="0.102 0.1335 0.008" pos="0 -0.0215 0.121" type="box" mass="0.05" rgba="0.5 0 0 1" />\n        <geom name="CabinetObject_drawer_cavity_1" size="0.012 0.012 0.064" pos="-0.102 -0.163 0.065" type="box" mass="0.05" rgba="0.5 0 0 1" />\n        <geom name="CabinetObject_drawer_cavity_2" size="0.012 0.012 0.064" pos="0.102 -0.163 0.065" type="box" mass="0.05" rgba="0.5 0 0 1" />\n        <geom name="CabinetObject_drawer_left_wall_visual" size="0.008 0.1435 0.064" pos="-0.11 -0.0315 0.065" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n        <geom name="CabinetObject_drawer_right_wall_visual" size="0.008 0.1435 0.064" pos="0.11 -0.0315 0.065" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n        <geom name="CabinetObject_drawer_back_wall_visual" size="0.102 0.008 0.064" pos="0 0.092 0.062" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n        <geom name="CabinetObject_drawer_bottom_surface_visual" size="0.102 0.1335 0.014" pos="0 -0.0395 0.004" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n        <geom name="CabinetObject_drawer_top_surface_visual" size="0.102 0.1335 0.008" pos="0 -0.0215 0.121" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n        <geom name="CabinetObject_drawer_cavity_1_visual" size="0.012 0.012 0.064" pos="-0.102 -0.163 0.065" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n        <geom name="CabinetObject_drawer_cavity_2_visual" size="0.012 0.012 0.064" pos="0.102 -0.163 0.065" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n        <body name="CabinetObject_drawer_link" pos="0 -0.01 0.076" gravcomp="0">\n          <inertial pos="0 0 0.35" quat="0.5 0.5 0.5 0.5" mass="7.85398" diaginertia="0.923301 0.764585 0.168533" />\n          <joint name="CabinetObject_goal_slidey" pos="0 0 0" axis="0 1 0" type="slide" range="-1 0" damping="100" />\n          <geom name="CabinetObject_drawer_tray_1" size="0.088 0.01 0.046" pos="0 -0.155 0.007" type="box" mass="0" rgba="0.5 0 0 1" />\n          <geom name="CabinetObject_drawer_tray_2" size="0.095 0.008 0.028" pos="0 0.065 0.008" type="box" mass="0" rgba="0.5 0 0 1" />\n          <geom name="CabinetObject_drawer_tray_3" size="0.008 0.114 0.008" pos="-0.072 -0.042 -0.015" type="box" mass="0" rgba="0.5 0 0 1" />\n          <geom name="CabinetObject_drawer_tray_4" size="0.008 0.114 0.008" pos="0.072 -0.042 -0.015" type="box" mass="0" rgba="0.5 0 0 1" />\n          <geom name="CabinetObject_drawer_bottom" size="0.08 0.12 0.008" pos="0 -0.04 -0.03" type="box" mass="0" rgba="0.5 0 0 1" />\n          <geom name="CabinetObject_drawer_handle_1" size="0.009 0.03" pos="-0.05 -0.19 0.04" quat="0.707105 0.707108 0 0" type="capsule" mass="0" rgba="0.5 0 0 1" />\n          <geom name="CabinetObject_drawer_handle_2" size="0.009 0.05" pos="0 -0.22 0.04" quat="0.707105 0 0.707108 0" type="capsule" mass="0" rgba="0.5 0 0 1" />\n          <geom name="CabinetObject_drawer_handle_3" size="0.009 0.03" pos="0.05 -0.19 0.04" quat="0.707105 0.707108 0 0" type="capsule" mass="0" rgba="0.5 0 0 1" />\n          <geom name="CabinetObject_drawer_tray_1_visual" size="0.088 0.01 0.046" pos="0 -0.155 0.007" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n          <geom name="CabinetObject_drawer_tray_2_visual" size="0.095 0.008 0.028" pos="0 0.065 0.008" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n          <geom name="CabinetObject_drawer_tray_3_visual" size="0.008 0.114 0.008" pos="-0.072 -0.042 -0.015" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n          <geom name="CabinetObject_drawer_tray_4_visual" size="0.008 0.114 0.008" pos="0.072 -0.042 -0.015" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n          <geom name="CabinetObject_drawer_bottom_visual" size="0.08 0.12 0.008" pos="0 -0.04 -0.03" type="box" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatRedWood" />\n          <geom name="CabinetObject_drawer_handle_1_visual" size="0.009 0.03" pos="-0.05 -0.19 0.04" quat="0.707105 0.707108 0 0" type="capsule" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatLightWood" />\n          <geom name="CabinetObject_drawer_handle_2_visual" size="0.009 0.05" pos="0 -0.22 0.04" quat="0.707105 0 0.707108 0" type="capsule" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatLightWood" />\n          <geom name="CabinetObject_drawer_handle_3_visual" size="0.009 0.03" pos="0.05 -0.19 0.04" quat="0.707105 0.707108 0 0" type="capsule" contype="0" conaffinity="0" group="1" mass="0" material="CabinetObject_MatLightWood" />\n        </body>\n      </body>\n    </body>\n    <body name="mug_main" pos="0 0 0">\n      <joint name="mug_joint0" type="free" damping="0.0005" />\n      <geom name="mug_g0" type="mesh" contype="0" conaffinity="0" group="1" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" material="mug_material_0_24" mesh="mug_model_normalized_0_vis" />\n      <geom name="mug_g1" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_13._coll" />\n      <geom name="mug_g2" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_16._coll" />\n      <geom name="mug_g3" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_30._coll" />\n      <geom name="mug_g4" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_21._coll" />\n      <geom name="mug_g5" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_1._coll" />\n      <geom name="mug_g6" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_20._coll" />\n      <geom name="mug_g7" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_27._coll" />\n      <geom name="mug_g8" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_10._coll" />\n      <geom name="mug_g9" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_24._coll" />\n      <geom name="mug_g10" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_28._coll" />\n      <geom name="mug_g11" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_25._coll" />\n      <geom name="mug_g12" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_23._coll" />\n      <geom name="mug_g13" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_6._coll" />\n      <geom name="mug_g14" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_8._coll" />\n      <geom name="mug_g15" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_2._coll" />\n      <geom name="mug_g16" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_12._coll" />\n      <geom name="mug_g17" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_4._coll" />\n      <geom name="mug_g18" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_19._coll" />\n      <geom name="mug_g19" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_5._coll" />\n      <geom name="mug_g20" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_14._coll" />\n      <geom name="mug_g21" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_11._coll" />\n      <geom name="mug_g22" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_15._coll" />\n      <geom name="mug_g23" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_18._coll" />\n      <geom name="mug_g24" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_29._coll" />\n      <geom name="mug_g25" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_26._coll" />\n      <geom name="mug_g26" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_17._coll" />\n      <geom name="mug_g27" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_31._coll" />\n      <geom name="mug_g28" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_3._coll" />\n      <geom name="mug_g29" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_9._coll" />\n      <geom name="mug_g30" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_22._coll" />\n      <geom name="mug_g31" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_7._coll" />\n      <geom name="mug_g32" type="mesh" friction="1 1 1" solref="0.001 1" solimp="0.998 0.998 0.001 0.5 2" margin="0.001" density="100" rgba="0.5 0 0 1" mesh="mug_model_normalized_collision_0._coll" />\n      <site name="mug_default_site" pos="0 0 0" size="0.002" rgba="1 0 0 0" />\n    </body>\n  </worldbody>\n  <actuator>\n    <general name="robot0_torq_j1" joint="robot0_joint1" ctrlrange="-80 80" actdim="0" />\n    <general name="robot0_torq_j2" joint="robot0_joint2" ctrlrange="-80 80" actdim="0" />\n    <general name="robot0_torq_j3" joint="robot0_joint3" ctrlrange="-80 80" actdim="0" />\n    <general name="robot0_torq_j4" joint="robot0_joint4" ctrlrange="-80 80" actdim="0" />\n    <general name="robot0_torq_j5" joint="robot0_joint5" ctrlrange="-80 80" actdim="0" />\n    <general name="robot0_torq_j6" joint="robot0_joint6" ctrlrange="-12 12" actdim="0" />\n    <general name="robot0_torq_j7" joint="robot0_joint7" ctrlrange="-12 12" actdim="0" />\n    <general name="gripper0_gripper_finger_joint1" joint="gripper0_finger_joint1" ctrlrange="0 0.04" forcerange="-20 20" actdim="0" biastype="affine" gainprm="1000 0 0 0 0 0 0 0 0 0" biasprm="0 -1000 0 0 0 0 0 0 0 0" />\n    <general name="gripper0_gripper_finger_joint2" joint="gripper0_finger_joint2" ctrlrange="-0.04 0" forcerange="-20 20" actdim="0" biastype="affine" gainprm="1000 0 0 0 0 0 0 0 0 0" biasprm="0 -1000 0 0 0 0 0 0 0 0" />\n  </actuator>\n  <sensor>\n    <force site="gripper0_ft_frame" name="gripper0_force_ee" />\n    <torque site="gripper0_ft_frame" name="gripper0_torque_ee" />\n  </sensor>\n</mujoco>'
PT文件解析

policy 信息

============= Loaded Policy =============
ObservationKeyToModalityDict: mean not found, adding mean to mapping with assumed low_dim modality!
ObservationKeyToModalityDict: scale not found, adding scale to mapping with assumed low_dim modality!
ObservationKeyToModalityDict: logits not found, adding logits to mapping with assumed low_dim modality!
BC_RNN_GMM (
  ModuleDict(
    (policy): RNNGMMActorNetwork(
        action_dim=7, std_activation=softplus, low_noise_eval=True, num_nodes=5, min_std=0.0001
  
        encoder=ObservationGroupEncoder(
            group=obs
            ObservationEncoder(
                Key(
                    name=agentview_image
                    shape=[3, 84, 84]
                    modality=rgb
                    randomizer=CropRandomizer(input_shape=[3, 84, 84], crop_size=[76, 76], num_crops=1)
                    net=VisualCore(
                      input_shape=[3, 76, 76]
                      output_shape=[64]
                      backbone_net=ResNet18Conv(input_channel=3, input_coord_conv=False)
                      pool_net=SpatialSoftmax(num_kp=32, temperature=1.0, noise=0.0)
                    )
                    sharing_from=None
                )
                Key(
                    name=robot0_eef_pos
                    shape=[3]
                    modality=low_dim
                    randomizer=None
                    net=None
                    sharing_from=None
                )
                Key(
                    name=robot0_eef_quat
                    shape=[4]
                    modality=low_dim
                    randomizer=None
                    net=None
                    sharing_from=None
                )
                Key(
                    name=robot0_eye_in_hand_image
                    shape=[3, 84, 84]
                    modality=rgb
                    randomizer=CropRandomizer(input_shape=[3, 84, 84], crop_size=[76, 76], num_crops=1)
                    net=VisualCore(
                      input_shape=[3, 76, 76]
                      output_shape=[64]
                      backbone_net=ResNet18Conv(input_channel=3, input_coord_conv=False)
                      pool_net=SpatialSoftmax(num_kp=32, temperature=1.0, noise=0.0)
                    )
                    sharing_from=None
                )
                Key(
                    name=robot0_gripper_qpos
                    shape=[2]
                    modality=low_dim
                    randomizer=None
                    net=None
                    sharing_from=None
                )
                output_shape=[137]
            )
        )
  
        rnn=RNN_Base(
          (per_step_net): ObservationDecoder(
              Key(
                  name=mean
                  shape=(5, 7)
                  modality=low_dim
                  net=(Linear(in_features=1000, out_features=35, bias=True))
              )
              Key(
                  name=scale
                  shape=(5, 7)
                  modality=low_dim
                  net=(Linear(in_features=1000, out_features=35, bias=True))
              )
              Key(
                  name=logits
                  shape=(5,)
                  modality=low_dim
                  net=(Linear(in_features=1000, out_features=5, bias=True))
              )coffee_preparation_d0
          )
          (nets): LSTM(137, 1000, num_layers=2, batch_first=True)
        )
    )
  )
)
ckpt数据
keys = dict_keys(['model', 'config', 'algo_name', 'env_metadata', 'shape_metadata'])

model 部分局部截图,推测为 policy 中用到的具体参数
在这里插入图片描述config 为训练时指定的 json 内容,详细数据如下:

'{\n    "algo_name": "bc",\n    "experiment": {\n        "name": "core_coffee_preparation_d0_image",\n        "validate": false,\n        "logging": {\n            "terminal_output_to_txt": true,\n            "log_tb": true,\n            "log_wandb": false,\n            "wandb_proj_name": "debug"\n        },\n        "save": {\n            "enabled": true,\n            "every_n_seconds": null,\n            "every_n_epochs": 20,\n            "epochs": [],\n            "on_best_validation": false,\n            "on_best_rollout_return": false,\n            "on_best_rollout_success_rate": true\n        },\n        "epoch_every_n_steps": 500,\n        "validation_epoch_every_n_steps": 50,\n        "env": null,\n        "additional_envs": null,\n        "render": false,\n        "render_video": true,\n        "keep_all_videos": false,\n        "video_skip": 5,\n        "rollout": {\n            "enabled": true,\n            "n": 50,\n            "horizon": 800,\n            "rate": 20,\n            "warmstart": 0,\n            "terminate_on_success": true\n        }\n    },\n    "train": {\n        "data": "/home/idm/Documents/mimicgen/mimicgen_environments/mimicgen_envs/../datasets/core/coffee_preparation_d0.hdf5",\n        "output_dir": "/home/idm/Documents/mimicgen/mimicgen_environments/mimicgen_envs/../training_results/core/coffee_preparation_d0/image/trained_models",\n        "num_data_workers": 2,\n        "hdf5_cache_mode": "low_dim",\n        "hdf5_use_swmr": true,\n        "hdf5_load_next_obs": false,\n        "hdf5_normalize_obs": false,\n        "hdf5_filter_key": null,\n        "hdf5_validation_filter_key": null,\n        "seq_length": 10,\n        "pad_seq_length": true,\n        "frame_stack": 1,\n        "pad_frame_stack": true,\n        "dataset_keys": [\n            "actions",\n            "rewards",\n            "dones"\n        ],\n        "goal_mode": null,\n        "cuda": true,\n        "batch_size": 128,\n        "num_epochs": 600,\n        "seed": 1\n    },\n    "algo": {\n        "optim_params": {\n            "policy": {\n                "optimizer_type": "adam",\n                "learning_rate": {\n                    "initial": 0.0001,\n                    "decay_factor": 0.1,\n                    "epoch_schedule": [],\n                    "scheduler_type": "multistep"\n                },\n                "regularization": {\n                    "L2": 0.0\n                }\n            }\n        },\n        "loss": {\n            "l2_weight": 1.0,\n            "l1_weight": 0.0,\n            "cos_weight": 0.0\n        },\n        "actor_layer_dims": [],\n        "gaussian": {\n            "enabled": false,\n            "fixed_std": false,\n            "init_std": 0.1,\n            "min_std": 0.01,\n            "std_activation": "softplus",\n            "low_noise_eval": true\n        },\n        "gmm": {\n            "enabled": true,\n            "num_modes": 5,\n            "min_std": 0.0001,\n            "std_activation": "softplus",\n            "low_noise_eval": true\n        },\n        "vae": {\n            "enabled": false,\n            "latent_dim": 14,\n            "latent_clip": null,\n            "kl_weight": 1.0,\n            "decoder": {\n                "is_conditioned": true,\n                "reconstruction_sum_across_elements": false\n            },\n            "prior": {\n                "learn": false,\n                "is_conditioned": false,\n                "use_gmm": false,\n                "gmm_num_modes": 10,\n                "gmm_learn_weights": false,\n                "use_categorical": false,\n                "categorical_dim": 10,\n                "categorical_gumbel_softmax_hard": false,\n                "categorical_init_temp": 1.0,\n                "categorical_temp_anneal_step": 0.001,\n                "categorical_min_temp": 0.3\n            },\n            "encoder_layer_dims": [\n                300,\n                400\n            ],\n            "decoder_layer_dims": [\n                300,\n                400\n            ],\n            "prior_layer_dims": [\n                300,\n                400\n            ]\n        },\n        "rnn": {\n            "enabled": true,\n            "horizon": 10,\n            "hidden_dim": 1000,\n            "rnn_type": "LSTM",\n            "num_layers": 2,\n            "open_loop": false,\n            "kwargs": {\n                "bidirectional": false\n            }\n        },\n        "transformer": {\n            "enabled": false,\n            "context_length": 10,\n            "embed_dim": 512,\n            "num_layers": 6,\n            "num_heads": 8,\n            "emb_dropout": 0.1,\n            "attn_dropout": 0.1,\n            "block_output_dropout": 0.1,\n            "sinusoidal_embedding": false,\n            "activation": "gelu",\n            "supervise_all_steps": false,\n            "nn_parameter_for_timesteps": true\n        }\n    },\n    "observation": {\n        "modalities": {\n            "obs": {\n                "low_dim": [\n                    "robot0_eef_pos",\n                    "robot0_eef_quat",\n                    "robot0_gripper_qpos"\n                ],\n                "rgb": [\n                    "agentview_image",\n                    "robot0_eye_in_hand_image"\n                ],\n                "depth": [],\n                "scan": []\n            },\n            "goal": {\n                "low_dim": [],\n                "rgb": [],\n                "depth": [],\n                "scan": []\n            }\n        },\n        "encoder": {\n            "low_dim": {\n                "core_class": null,\n                "core_kwargs": {},\n                "obs_randomizer_class": null,\n                "obs_randomizer_kwargs": {}\n            },\n            "rgb": {\n                "core_class": "VisualCore",\n                "core_kwargs": {\n                    "feature_dimension": 64,\n                    "backbone_class": "ResNet18Conv",\n                    "backbone_kwargs": {\n                        "pretrained": false,\n                        "input_coord_conv": false\n                    },\n                    "pool_class": "SpatialSoftmax",\n                    "pool_kwargs": {\n                        "num_kp": 32,\n                        "learnable_temperature": false,\n                        "temperature": 1.0,\n                        "noise_std": 0.0\n                    }\n                },\n                "obs_randomizer_class": "CropRandomizer",\n                "obs_randomizer_kwargs": {\n                    "crop_height": 76,\n                    "crop_width": 76,\n                    "num_crops": 1,\n                    "pos_enc": false\n                }\n            },\n            "depth": {\n                "core_class": "VisualCore",\n                "core_kwargs": {},\n                "obs_randomizer_class": null,\n                "obs_randomizer_kwargs": {}\n            },\n            "scan": {\n                "core_class": "ScanCore",\n                "core_kwargs": {},\n                "obs_randomizer_class": null,\n                "obs_randomizer_kwargs": {}\n            }\n        }\n    },\n    "meta": {\n        "hp_base_config_file": null,\n        "hp_keys": [],\n        "hp_values": []\n    }\n}'

env_meta内容如下,来源于训练数据中的env_args

{'env_name': 'CoffeePreparation_D0', 'env_version': '1.4.1', 'type': 1, 'env_kwargs': {'has_renderer': False, 'has_offscreen_renderer': True, 'ignore_done': True, 'use_object_obs': True, 'use_camera_obs': True, 'control_freq': 20, 'controller_configs': {'type': 'OSC_POSE', 'input_max': 1, 'input_min': -1, 'output_max': [0.05, 0.05, 0.05, 0.5, 0.5, 0.5], 'output_min': [-0.05, -0.05, -0.05, -0.5, -0.5, -0.5], 'kp': 150, 'damping': 1, 'impedance_mode': 'fixed', 'kp_limits': [0, 300], 'damping_limits': [0, 10], 'position_limits': None, 'orientation_limits': None, 'uncouple_pos_ori': True, 'control_delta': True, 'interpolation': None, 'ramp_ratio': 0.2}, 'robots': ['Panda'], 'camera_depths': False, 'camera_heights': 84, 'camera_widths': 84, 'render_gpu_device_id': 0, 'reward_shaping': False, 'camera_names': ['agentview', 'robot0_eye_in_hand']}}

shape_meta 主要表示大小,详细内容如下:

ipdb> ckpt_dict['shape_metadata']
{'ac_dim': 7, 'all_shapes': OrderedDict([('agentview_image', [3, 84, 84]), ('robot0_eef_pos', [3]), ('robot0_eef_quat', [4]), ('robot0_eye_in_hand_image', [3, 84, 84]), ('robot0_gripper_qpos', [2])]), 'all_obs_keys': ['agentview_image', 'robot0_eef_pos', 'robot0_eef_quat', 'robot0_eye_in_hand_image', 'robot0_gripper_qpos'], 'use_images': True}

场景修改

阶段一:能实现在现有简单场景中,添加标准几何物体

在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

阶段二:可修改现有场景中的配置文件xml
阶段三:搭建新的场景

在这里插入图片描述

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值