Add bedroom scene, demos, Chinese documentation, and scene type guide

#1
by yuq-nv - opened
.gitattributes CHANGED
@@ -33,3 +33,15 @@ saved_model/**/* filter=lfs diff=lfs merge=lfs -text
33
  *.zip filter=lfs diff=lfs merge=lfs -text
34
  *.zst filter=lfs diff=lfs merge=lfs -text
35
  *tfevents* filter=lfs diff=lfs merge=lfs -text
 
 
 
 
 
 
 
 
 
 
 
 
 
33
  *.zip filter=lfs diff=lfs merge=lfs -text
34
  *.zst filter=lfs diff=lfs merge=lfs -text
35
  *tfevents* filter=lfs diff=lfs merge=lfs -text
36
+ demos/demo_bedroom_nightstand_to_desk_trajectory.png filter=lfs diff=lfs merge=lfs -text
37
+ demos/demo_bedroom_wardrobe_to_desk_trajectory.png filter=lfs diff=lfs merge=lfs -text
38
+ scenes/scene_01_bedroom/flythrough.mp4 filter=lfs diff=lfs merge=lfs -text
39
+ scenes/scene_01_bedroom/renders/ceiling_top.png filter=lfs diff=lfs merge=lfs -text
40
+ scenes/scene_01_bedroom/renders/floor_plan.png filter=lfs diff=lfs merge=lfs -text
41
+ scenes/scene_01_bedroom/renders/furniture_side0.png filter=lfs diff=lfs merge=lfs -text
42
+ scenes/scene_01_bedroom/renders/furniture_side1.png filter=lfs diff=lfs merge=lfs -text
43
+ scenes/scene_01_bedroom/renders/furniture_side2.png filter=lfs diff=lfs merge=lfs -text
44
+ scenes/scene_01_bedroom/renders/furniture_side3.png filter=lfs diff=lfs merge=lfs -text
45
+ scenes/scene_01_bedroom/renders/furniture_top.png filter=lfs diff=lfs merge=lfs -text
46
+ scenes/scene_01_bedroom/renders/wall_north.png filter=lfs diff=lfs merge=lfs -text
47
+ scenes/scene_01_bedroom/renders/wall_top.png filter=lfs diff=lfs merge=lfs -text
README.md ADDED
@@ -0,0 +1,662 @@
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
+ # SceneSmith 完整技术文档
2
+
3
+ > 语言:中文
4
+ > 对应代码:[nepfaff/scenesmith](https://github.com/nepfaff/scenesmith)
5
+ > 论文:[arXiv 2602.09153](https://arxiv.org/abs/2602.09153)
6
+ > 本次运行环境:NVIDIA L40S GPU,SLURM 集群
7
+
8
+ ---
9
+
10
+ ## 目录
11
+
12
+ 1. [系统总览](#1-系统总览)
13
+ 2. [输入输出格式](#2-输入输出格式)
14
+ 3. [核心流程详解](#3-核心流程详解)
15
+ 4. [代码结构解析](#4-代码结构解析)
16
+ 5. [Robot Eval 模块](#5-robot-eval-模块)
17
+ 6. [SceneSmith 能做什么 / 不能做什么](#6-scenesmith-能做什么--不能做什么)
18
+ 7. [本次运行结果](#7-本次运行结果)
19
+ 8. [Demo采集说明](#8-demo采集说明)
20
+ 9. [常见问题与局限性](#9-常见问题与局限性)
21
+ 10. [复现指南](#10-复现指南)
22
+
23
+ ---
24
+
25
+ ## 1. 系统总览
26
+
27
+ SceneSmith 是一个**全自动、文本驱动的室内场景生成系统**,专为机器人仿真设计。
28
+
29
+ 给一段自然语言描述(如"一个有书桌、床和衣柜的卧室"),SceneSmith 会输出一个**物理上可用的完整室内场景**,包含:
30
+ - 精确的 6D 物体位姿
31
+ - 每个物体的碰撞几何体(SDF 格式)
32
+ - 物理属性(质量、摩擦系数、惯性矩阵)
33
+ - 可以直接导入 Drake / MuJoCo / Isaac Sim 的格式
34
+
35
+ 系统的核心是用**多个 LLM Agent 协作**代替人工设计:每个 Agent 负责场景生成的一个阶段,用视觉反馈迭代优化,直到满足质量标准。
36
+
37
+ ```
38
+ 文字描述
39
+
40
+
41
+ ┌─────────────────────────────────────────────────────────┐
42
+ │ SceneSmith Pipeline │
43
+ │ │
44
+ │ Floor Plan Agent → Furniture Agent → Wall Agent │
45
+ │ ↓ ↓ ↓ │
46
+ │ 生成平面图 摆放大件家具 墙面装饰 │
47
+ │ ↓ ↓ │
48
+ │ Ceiling Agent → Manipuland Agent │
49
+ │ ↓ ↓ │
50
+ │ 天花板灯具 小件可操作物体 │
51
+ │ │
52
+ │ 每个阶段:LLM 规划 → 3D资产生成 → 物理验证 → 视觉评分 │
53
+ └─────────────────────────────────────────────────────────┘
54
+
55
+
56
+ house.blend (Blender 渲染) + house.dmd.yaml (Drake 仿真) + house_state.json
57
+ ```
58
+
59
+ ---
60
+
61
+ ## 2. 输入输出格式
62
+
63
+ ### 输入
64
+
65
+ | 输入项 | 格式 | 说明 |
66
+ |--------|------|------|
67
+ | 场景描述 | 自然语言字符串 | 例:`"A cozy bedroom with a queen bed..."` |
68
+ | CSV 提示文件(可选) | `prompts.csv` | 批量生成多个场景时使用 |
69
+ | 配置文件 | Hydra YAML | 控制使用的模型、后端、参数 |
70
+
71
+ **`prompts.csv` 格式**:
72
+ ```csv
73
+ scene_index,prompt
74
+ 0,"A modern kitchen with..."
75
+ 1,"A cozy living room with..."
76
+ ```
77
+
78
+ **关键配置参数**:
79
+ ```yaml
80
+ openai:
81
+ model: "gpt-5.2" # LLM 模型名
82
+ experiment:
83
+ num_scenes: 5 # 生成场景数量
84
+ scene_prompt: "..." # 单场景描述
85
+ furniture_agent:
86
+ asset_manager:
87
+ backend: "hunyuan3d" # 3D资产生成后端: sam3d | hunyuan3d | hssd
88
+ ```
89
+
90
+ ### 输出
91
+
92
+ 每次运行生成如下目录结构:
93
+
94
+ ```
95
+ outputs/YYYY-MM-DD/HH-MM-SS/
96
+ └── scene_000/
97
+ ├── combined_house/
98
+ │ ├── house.blend ← Blender 完整场景 (~200MB)
99
+ │ ├── house.dmd.yaml ← Drake Directives(仿真可用)
100
+ │ ├── house_furniture_welded.dmd.yaml ← 家具焊接版(稳定性更好)
101
+ │ ├── house_state.json ← 所有物体的位姿+元数据
102
+ │ └── sceneeval_state.json ← 场景评分数据
103
+ ├── room_bedroom/
104
+ │ ├── generated_assets/ ← 每个物体的 SDF + 纹理
105
+ │ │ ├── desk_0/
106
+ │ │ │ ├── model.sdf
107
+ │ │ │ ├── model.obj
108
+ │ │ │ └── texture.png
109
+ │ │ └── ...
110
+ │ ├── scene_states/ ← 各阶段保存的中间状态
111
+ │ │ ├── scene_after_furniture/scene.blend
112
+ │ │ ├── scene_after_wall_objects/scene.blend
113
+ │ │ ├── scene_after_ceiling_objects/scene.blend
114
+ │ │ └── final_scene/
115
+ │ │ ├── scene.blend
116
+ │ │ └── scene_state.json
117
+ │ └── scene_renders/ ← 各阶段的渲染图像 (PNG)
118
+ └── floor_plans/
119
+ └── final_floor_plan/
120
+ ├── floor_plan.blend
121
+ └── floor_plan.dmd.yaml
122
+ ```
123
+
124
+ **`house_state.json` 结构**(关键字段):
125
+ ```json
126
+ {
127
+ "rooms": {
128
+ "bedroom": {
129
+ "objects": {
130
+ "desk_0": {
131
+ "object_type": "furniture",
132
+ "name": "desk",
133
+ "description": "A modern wooden desk",
134
+ "sdf_path": "generated_assets/desk_0/model.sdf",
135
+ "transform": {
136
+ "translation": [0.79, 1.58, 0.0],
137
+ "rotation_wxyz": [1.0, 0.0, 0.0, 0.0]
138
+ },
139
+ "bbox_min": [-0.6, -0.3, 0.0],
140
+ "bbox_max": [0.6, 0.3, 0.75],
141
+ "mass": 15.0,
142
+ "mu_static": 0.6
143
+ }
144
+ }
145
+ }
146
+ }
147
+ }
148
+ ```
149
+
150
+ **`house.dmd.yaml` 格式**(Drake Directives):
151
+ ```yaml
152
+ directives:
153
+ - add_model:
154
+ name: bedroom_desk_0
155
+ file: package://scene/room_bedroom/generated_assets/desk_0/model.sdf
156
+ - add_weld:
157
+ parent: world
158
+ child: bedroom_desk_0::base_link
159
+ X_PC:
160
+ translation: [0.79, 1.58, 0.0]
161
+ rotation: !Rpy { deg: [0, 0, 0] }
162
+ ```
163
+
164
+ ---
165
+
166
+ ## 3. 核心流程详解
167
+
168
+ ### Stage 1:Floor Plan Agent(平面图规划)
169
+
170
+ **输入**:场景描述文字
171
+ **输出**:房间尺寸、门窗位置、墙体布局(`floor_plan.dmd.yaml`)
172
+
173
+ 工作方式:
174
+ 1. LLM 解析场景描述,确定所需房间类型(卧室、厨房等)
175
+ 2. 生成候选平面图(房间长宽、门的位置)
176
+ 3. 用 Blender 渲染俯视图,LLM 评分(0-1分)
177
+ 4. 迭代优化,选择得分最高的方案
178
+
179
+ 评分标准:空间合理性、比例、门窗位置是否符合常识。
180
+
181
+ ---
182
+
183
+ ### Stage 2:Furniture Agent(家具摆放)
184
+
185
+ **输入**:平面图、场景描述
186
+ **输出**:家具的精确 6D 位姿 + 每件家具的 SDF 模型
187
+
188
+ 这是最复杂的阶段,分三个子步骤:
189
+
190
+ #### 2a. 家具规划
191
+ LLM 决定放什么家具、大概的位置,生成一个结构化的家具列表。
192
+
193
+ #### 2b. 3D 资产生成
194
+ 对每件家具,走以下路由(Asset Router):
195
+
196
+ ```
197
+ 家具描述文字
198
+
199
+
200
+ Asset Router (LLM决策)
201
+ ├── "generated" → Hunyuan3D-2 / SAM3D
202
+ │ ├── 生成参考图 (GPT-Image-2)
203
+ │ └── 图片 → 3D mesh (扩散模型)
204
+ │ ↓
205
+ │ 纹理烘焙 + SDF生成
206
+
207
+ ├── "artvip" → 从ArtVIP库检索关节物体(开门的衣柜等)
208
+
209
+ └── "hssd" → 从HSSD数据集检索(更快,质量稳定)
210
+ ```
211
+
212
+ #### 2c. 迭代摆放
213
+ 1. 放置家具到初始位置
214
+ 2. Drake 物理仿真:检测碰撞、检查是否可站立
215
+ 3. Blender 渲染多视角图
216
+ 4. LLM 用视觉反馈打分(美观度、布局合理性、可达性)
217
+ 5. 如果分数不满足阈值,调整位置重试(最多 N 轮)
218
+
219
+ ---
220
+
221
+ ### Stage 3:Wall Agent(墙面装饰)
222
+
223
+ **输入**:已摆好家具的场景
224
+ **输出**:墙面装饰物(画、镜子、时钟、架子等)的位姿
225
+
226
+ 同样走 asset router → 3D 生成 → Drake 验证 → 视觉评分的流程,但专注于墙面的高度、朝向、装饰品间距。
227
+
228
+ ---
229
+
230
+ ### Stage 4:Ceiling Agent(天花板)
231
+
232
+ **输入**:已完成墙面的场景
233
+ **输出**:天花板灯具、风扇等物体
234
+
235
+ 主要验证灯具位置是否在房间中央、是否与墙面冲突。
236
+
237
+ ---
238
+
239
+ ### Stage 5:Manipuland Agent(可操作小物件)
240
+
241
+ **输入**:已完成天花板的场景、每件家具的支撑面信息
242
+ **输出**:桌面上的书、杯子、水果等小物件
243
+
244
+ 特点:
245
+ - 自动分析每件家具的"支撑面"(桌面、架子面)
246
+ - 在支撑面上随机采样放置位置,Drake 验证不碰撞
247
+ - 可生成组合(stack/pile/filled_container):叠起来的书、装苹果的碗等
248
+
249
+ ---
250
+
251
+ ### Stage 6:物理投影 + 最终导出
252
+
253
+ 所有物体放好后:
254
+ 1. Drake 运行物理仿真,让物体自然落下(消除浮空、轻微穿插)
255
+ 2. 输出最终 `house.dmd.yaml`(固定位姿,weld 到 world)
256
+ 3. Blender 渲染最终场景,保存 `house.blend`
257
+
258
+ ---
259
+
260
+ ## 4. 代码结构解析
261
+
262
+ ```
263
+ scenesmith/
264
+ ├── main.py ← 入口,Hydra 配置,调度各 Agent
265
+
266
+ ├── scenesmith/
267
+ │ ├── experiments/
268
+ │ │ └── indoor_scene_generation.py ← 主实验类,串联所有 Agent
269
+ │ │
270
+ │ ├── floor_plan_agents/
271
+ │ │ ├── stateful_floor_plan_agent.py ← Floor Plan Agent 实现
272
+ │ │ └── tools/ ← 平面图相关工具
273
+ │ │
274
+ │ ├── furniture_agents/
275
+ │ │ ├── stateful_furniture_agent.py ← Furniture Agent 主类
276
+ │ │ └── tools/
277
+ │ │ ├── furniture_tools.py ← 家具放置、物理检查工具
278
+ │ │ ├── vision_tools.py ← Blender 渲染观察工具
279
+ │ │ └── scene_tools.py ← 场景状态查询
280
+ │ │
281
+ │ ├── wall_agents/ ← Wall Agent(同结构)
282
+ │ ├── ceiling_agents/ ← Ceiling Agent(同结构)
283
+ │ ├── manipuland_agents/ ← Manipuland Agent���同结构)
284
+ │ │
285
+ │ ├── agent_utils/
286
+ │ │ ├── asset_manager.py ← 资产获取总入口
287
+ │ │ ├── asset_router/ ← LLM决策走哪个资产后端
288
+ │ │ ├── geometry_generation_server/ ← 3D生成服务(Hunyuan3D工作进程)
289
+ │ │ │ ├── server_manager.py
290
+ │ │ │ ├── worker_pool.py ← GPU工作进程池
291
+ │ │ │ └── gpu_worker.py ← 单个GPU的3D生成进程
292
+ │ │ ├── drake_utils.py ← Drake 仿真工具
293
+ │ │ ├── rendering.py ← 场景渲染工具
294
+ │ │ ├── physics_validation.py ← 物理碰撞检测
295
+ │ │ ├── reachability.py ← 机器人可达性分析
296
+ │ │ ├── image_generation.py ← 参考图生成(GPT-Image-2)
297
+ │ │ ├── vlm_service.py ← VLM评分服务
298
+ │ │ └── blender/ ← Blender 进程通信
299
+ │ │ ├── server_manager.py ← Blender 服务器管理
300
+ │ │ └── renderer.py ← 渲染接口
301
+ │ │
302
+ │ └── robot_eval/
303
+ │ ├── dmd_scene.py ← Drake 场景加载
304
+ │ ├── policy_interface/
305
+ │ │ ├── policy_agent.py ← 任务 → 物体绑定 Agent
306
+ │ │ └── predicate_resolver.py ← 绑定 → 精确位姿
307
+ │ ├── success_validation/
308
+ │ │ └── validator_agent.py ← 任务成功验证 Agent
309
+ │ └── task_generation/
310
+ │ └── scene_prompt_generator.py ← 任务 → 场景描述
311
+
312
+ └── scripts/
313
+ ├── robot_eval/
314
+ │ ├── generate_prompts.py ← Stage 1: task → prompts
315
+ │ ├── policy_interface.py ← Stage 3: scene + task → robot poses
316
+ │ └── validate.py ← Stage 4: 验证任务完成
317
+ ├── collect_demo.py ← Demo采集与可视化(本次添加)
318
+ ├── render_flythrough.py ← 生成场景飞行视频
319
+ └── export_scene_to_mujoco.py ← 导出到 MuJoCo
320
+ ```
321
+
322
+ ---
323
+
324
+ ### 关键类说明
325
+
326
+ #### `StatefulFurnitureAgent`
327
+ 继承自 `BaseStatefulAgent`,用 `openai-agents` SDK 运行 LLM agent loop。
328
+
329
+ Agent 的 tools 包括:
330
+ - `place_furniture(obj_id, x, y, yaw)` — 放置家具
331
+ - `observe_scene()` — 渲染当前场景,返回多视角图给 LLM 看
332
+ - `get_physics_check()` — 运行 Drake 碰撞检测
333
+ - `generate_furniture_assets(descriptions)` — 批量生成 3D 资产
334
+ - `score_scene()` — VLM 打分
335
+
336
+ 每轮 LLM 调用 tools → 观察反馈 → 调整 → 直到评分达标或超过最大轮数。
337
+
338
+ #### `AssetManager`
339
+ 统一的资产获取接口,内部调用 `AssetRouter` 决策:
340
+ ```python
341
+ asset = await asset_manager.get_asset(
342
+ description="A wooden desk with drawers",
343
+ object_type="furniture",
344
+ strategy="generated" # or "hssd", "artvip"
345
+ )
346
+ # 返回 Asset(sdf_path, obj_path, texture_path, dimensions, ...)
347
+ ```
348
+
349
+ #### `DMDScene` + `PredicateResolver`
350
+ 用于 robot eval:
351
+ ```python
352
+ scene = load_scene_for_validation(
353
+ scene_state_path=Path("house_state.json"),
354
+ dmd_path=Path("house.dmd.yaml"),
355
+ )
356
+ scene.finalize() # 建立 Drake plant,同步位姿
357
+
358
+ resolver = PredicateResolver(scene=scene, cfg=cfg)
359
+ result = resolver.resolve("Pick the apple and place it on the plate")
360
+ # result.poses[0].target_position → [x, y, z] 目标位姿
361
+ # result.poses[0].placement_bounds_min/max → 有效放置区域 AABB
362
+ ```
363
+
364
+ ---
365
+
366
+ ## 5. Robot Eval 模块
367
+
368
+ 这是 SceneSmith 的机器人评测框架,共 4 个阶段:
369
+
370
+ ### 阶段 1:生成场景提示词
371
+ ```bash
372
+ python scripts/robot_eval/generate_prompts.py \
373
+ --task "Pick a fruit from the bowl and place it on the plate" \
374
+ --output-dir outputs/eval_run \
375
+ --num-prompts 5
376
+ ```
377
+ LLM 分析 task,提取:
378
+ - 必须存在的物体(水果、碗、盘子)
379
+ - 初始状态约束(水果不能已经在盘子上)
380
+ - 可变的风格维度(厨房风格、其他装饰物)
381
+
382
+ 输出 `prompts.csv` 供 `main.py` 生成多个不同风格的场景。
383
+
384
+ ### 阶段 2:生成场景
385
+ ```bash
386
+ python main.py +name=eval experiment.csv_path=outputs/eval_run/prompts.csv
387
+ ```
388
+
389
+ ### 阶段 3:Policy Interface(任务 → 机器人位姿)
390
+ ```bash
391
+ python scripts/robot_eval/policy_interface.py \
392
+ --scene-state outputs/.../house_state.json \
393
+ --dmd outputs/.../house.dmd.yaml \
394
+ --task "Pick a fruit from the bowl and place it on the plate" \
395
+ --output-json robot_commands.json
396
+ ```
397
+
398
+ 输出格式:
399
+ ```json
400
+ {
401
+ "task": "Pick a fruit...",
402
+ "robot_start_xy": [1.2, -0.5],
403
+ "world_bounds": {"min": [-3, -3, 0], "max": [3, 3, 2.7]},
404
+ "commands": [{
405
+ "action": "pick_and_place",
406
+ "rank": 1,
407
+ "confidence": 0.92,
408
+ "drake_model_name": "bedroom_apple_0",
409
+ "target_position": [0.5, 0.3, 0.85],
410
+ "placement_bounds_min": [0.2, 0.1, 0.85],
411
+ "placement_bounds_max": [0.8, 0.5, 1.0],
412
+ "reasoning": "Apple found on nightstand (precondition met), plate on desk is valid goal"
413
+ }]
414
+ }
415
+ ```
416
+
417
+ **注意**:SceneSmith 不包含 robot URDF 和 policy。`placement_bounds_min/max` 是给你的 policy 用的采样区域。
418
+
419
+ ### 阶段 4:验证
420
+ Robot 执行完任务后,将修改过的 `house.dmd.yaml`(更新了物体位姿)传入验证器:
421
+ ```bash
422
+ python scripts/robot_eval/validate.py \
423
+ --scene-state outputs/.../house_state.json \
424
+ --dmd outputs/.../modified_house.dmd.yaml \
425
+ --task "Pick a fruit from the bowl and place it on the plate"
426
+ ```
427
+
428
+ 验证器用 Drake 物理查询(签名距离、接触检测)+ VLM 视觉判断,输出每个子要求的得分。
429
+
430
+ ---
431
+
432
+ ## 6. SceneSmith 能做什么 / 不能做什么
433
+
434
+ ### ✅ 能做的
435
+
436
+ | 场景类型 | 说明 |
437
+ |---------|------|
438
+ | 卧室 | 床、衣柜、书桌、台灯、挂画、小件(书、闹钟等) |
439
+ | 厨房 | 橱柜、餐桌、厨具、水果、杯子等 |
440
+ | 办公室 | 桌子、椅子、电脑、文具等 |
441
+ | 客厅 | 沙发、茶几、书架、摆件等 |
442
+ | 关节物体 | 可开关的柜子、抽屉(来自 ArtVIP 数据集) |
443
+ | 桌面操作场景 | 通过 manipuland agent 生成多个小物件,支持 pick-and-place |
444
+ | 组合物体 | 叠起来的书(stack)、装了东西的碗(filled_container)、散乱的一堆(pile) |
445
+
446
+ ### ❌ 不能做的
447
+
448
+ | 类别 | 原因 |
449
+ |------|------|
450
+ | **柔性物体**(布料、毛绒玩具) | SceneSmith 只生成刚体 SDF。柔性物体需要 FEM/粒子仿真,Drake 支持有限,SceneSmith 不建模 |
451
+ | **流体**(倒水、液体) | 同上,流体需要 SPH/粒子系统,不在 SceneSmith 范围内。`house.dmd.yaml` 是刚体 Directives |
452
+ | **人体/角色动画** | 无 URDF/骨骼,无动画系统 |
453
+ | **室外场景** | 专为室内设计,无地形、植被等 |
454
+ | **Robot URDF** | SceneSmith 只生成环境,不包含机器人本体 |
455
+ | **Policy / Controller** | 不包含任何 policy,只提供场景 + eval harness |
456
+
457
+ ### 关于柔性物体和流体的正确路径
458
+
459
+ 如果需要:
460
+ - **布料**:用 MuJoCo 的 `composite` 元素或 Isaac Sim 的 FEM,把 SceneSmith 生成的刚体场景作为背景
461
+ - **流体**:FluidLab、Taichi,SceneSmith 生成杯子/瓶子的 SDF 作为容器几何体
462
+ - 可以用 `scripts/export_scene_to_mujoco.py` 先把 SceneSmith 场景转成 MuJoCo XML,再在 MuJoCo 里加入柔性/流体模拟
463
+
464
+ ---
465
+
466
+ ## 7. 本次运行结果
467
+
468
+ ### 场景 1:卧室(Bedroom)
469
+
470
+ **提示词**:
471
+ > A cozy bedroom with a queen bed against the wall, two nightstands with lamps, a wardrobe in the corner, and a small desk with a chair near the window.
472
+
473
+ **运行时间**:约 1 小时 57 分钟(L40S GPU)
474
+
475
+ **生成物体**:
476
+ | 物体 | 类型 | 位置 (x, y, z) |
477
+ |------|------|---------------|
478
+ | desk_0 | furniture | (0.79, 1.58, 0.0) |
479
+ | nightstand_0 | furniture | (-0.55, -1.73, 0.0) |
480
+ | nightstand_1 | furniture | (0.62, -1.73, 0.0) |
481
+ | rug_0 | furniture | (-0.01, -0.39, 0.0) |
482
+ | wardrobe_0 | furniture | (2.06, -1.53, 0.0) |
483
+
484
+ **注意**:本次运行中 Hunyuan3D worker 因 CUDA fork 问题未能生成 manipuland(小件物体),house_state.json 只有家具级别的物体。
485
+
486
+ **输出文件**:
487
+ - `combined_house/house.blend` — 201MB Blender 场景
488
+ - `combined_house/flythrough.mp4` — 120帧 1280×720 飞行视频
489
+ - `combined_house/house.dmd.yaml` — Drake 仿真文件
490
+
491
+ ---
492
+
493
+ ## 8. Demo采集说明
494
+
495
+ ### 什么是 Demo
496
+
497
+ 在这里,"demo" 是指一个 **pick-and-place 任务的完整轨迹**,包含:
498
+ - 初始场景状态(物体位姿)
499
+ - 末端执行器的完整轨迹(6D位姿序列)
500
+ - 夹爪宽度序列
501
+ - 任务成功与否
502
+
503
+ ### 本次 Demo 类型
504
+
505
+ 由于 SceneSmith 不含真实 robot,我们采用 **scripted demo**(脚本化轨迹),按照标准 pick-and-place 轨迹规划:
506
+
507
+ ```
508
+ Home → Approach(接近物体上方)→ Pre-grasp(下降)→ Grasp(夹爪闭合)
509
+ → Lift(提升)→ Transport(平移)→ Place(放下)→ Release(张开夹爪)
510
+ ```
511
+
512
+ ### 与真实采集的区别
513
+
514
+ | 项目 | 本次(脚本化) | 真实采集 |
515
+ |------|--------------|---------|
516
+ | 轨迹来源 | 几何规划 | robot controller / teleop |
517
+ | 物理真实性 | 运动学插值 | 力矩控制 |
518
+ | 碰撞避免 | 简单直线轨迹 | 运动规划(RRT等) |
519
+ | 接触建模 | 无 | Drake/MuJoCo 物理仿真 |
520
+ | 用途 | 演示、可视化 | 训练 policy |
521
+
522
+ ### Demo JSON 格式
523
+
524
+ ```json
525
+ {
526
+ "task": "Pick an object from the nightstand and place it on the desk",
527
+ "scene_id": "bedroom_nightstand_to_desk",
528
+ "target_object": "bedroom_nightstand_0",
529
+ "initial_pos": [-0.55, -1.73, 0.5],
530
+ "goal_pos": [0.79, 1.58, 0.85],
531
+ "goal_reference": "bedroom_desk_0",
532
+ "success": true,
533
+ "total_duration_s": 7.5,
534
+ "num_steps": 150,
535
+ "trajectory": [
536
+ {
537
+ "step_id": 0,
538
+ "phase": "approach",
539
+ "end_effector_pos": [0.0, 0.0, 0.8],
540
+ "end_effector_quat_wxyz": [1, 0, 0, 0],
541
+ "gripper_width": 1.0,
542
+ "target_object_pos": [-0.55, -1.73, 0.5],
543
+ "timestamp": 0.0
544
+ },
545
+ ...
546
+ ]
547
+ }
548
+ ```
549
+
550
+ ### 可视化说明
551
+
552
+ `demo_*_trajectory.png` 包含 4 个子图:
553
+ 1. **3D 轨迹图**:不同颜色表示不同阶段(接近/抓取/搬运/放置)
554
+ 2. **俯视图**(XY平面):路径规划可视化
555
+ 3. **高度-时间曲线**:末端执行器与物体的 Z 轴变化
556
+ 4. **夹爪宽度-时间曲线**:抓取动作可视化
557
+
558
+ ---
559
+
560
+ ## 9. 常见问题与局限性
561
+
562
+ ### Q: Hunyuan3D-2 生成质量很差怎么办?
563
+ **A**: 换 SAM3D 后端(需要 A100/H100,无 gated 访问限制)。Hunyuan3D 官方说明仅作 proof-of-concept,质量明显劣于 SAM3D。
564
+
565
+ ### Q: manipuland 物体没有生成?
566
+ **A**: Hunyuan3D worker 在 fork 后 CUDA 重初始化失败。症状:`Worker shutting down. Stats: 279 total, 0 completed, 279 failed`。解决:换用 `strategy: "hssd"` 检索模式,不依赖 CUDA generation。
567
+
568
+ ### Q: LLM 返回 `rs_*` 错误?
569
+ **A**: LiteLLM 代理是无状态的,不支持 server-side reasoning 续接。需要设置 `reasoning_effort: none` 并使用自定义 `NvidiaInferenceProvider`(已在本次配置中修复)。
570
+
571
+ ### Q: 一次运行需要多久?
572
+ **A**: 单房间约 1-2 小时(L40S, Hunyuan3D)。SAM3D 质量更好但更慢。多 GPU 可以并行生成多个房间。
573
+
574
+ ### Q: 能生成多房间场景吗?
575
+ **A**: 可以,在 `scene_prompt` 中描述多个房间,`experiment.num_scenes` 控制变体数量。
576
+
577
+ ### Q: 如何接入自己的 robot?
578
+ **A**:
579
+ 1. 加载 `house.dmd.yaml` 到 Drake/MuJoCo
580
+ 2. 用 `policy_interface.py` 获取 task 的目标位姿
581
+ 3. 用你自己的 robot controller 执行
582
+ 4. 将结果写回修改后的 `.dmd.yaml`
583
+ 5. 用 `validate.py` 验证成功率
584
+
585
+ ---
586
+
587
+ ## 10. 复现指南
588
+
589
+ ### 环境要求
590
+
591
+ - Python 3.11
592
+ - CUDA 12.4(编译 custom_rasterizer)
593
+ - Blender 5.1(headless,EEVEE 渲染)
594
+ - SLURM 集群,L40S GPU(48GB)
595
+
596
+ ### 安装步骤
597
+
598
+ ```bash
599
+ # 1. 克隆仓库
600
+ git clone https://github.com/nepfaff/scenesmith.git
601
+ cd scenesmith
602
+ git submodule update --init --recursive
603
+
604
+ # 2. 创建虚拟环境
605
+ uv sync --no-dev
606
+
607
+ # 3. 安装 Hunyuan3D-2
608
+ bash scripts/install_hunyuan3d.sh
609
+
610
+ # 4. 下载 ArtVIP 数据
611
+ huggingface-cli download nepfaff/scenesmith-preprocessed-data \
612
+ artvip/artvip_vhacd.tar.gz --repo-type dataset --local-dir .
613
+ mkdir -p data/artvip_sdf
614
+ tar xzf artvip/artvip_vhacd.tar.gz -C data/artvip_sdf
615
+
616
+ # 5. 下载材质
617
+ python scripts/download_ambientcg.py --output data/materials
618
+ # 下载材质嵌入(从 HF)
619
+
620
+ # 6. 编译 CUDA 扩展(需要 CUDA toolkit)
621
+ # 见 cuda_home/ 目录的说明
622
+ ```
623
+
624
+ ### 运行
625
+
626
+ ```bash
627
+ # 设置环境变量
628
+ export OPENAI_API_KEY=<your_key>
629
+ export OPENAI_BASE_URL=https://inference-api.nvidia.com/v1
630
+ export HF_TOKEN=<your_hf_token>
631
+
632
+ # 生成场景
633
+ python main.py \
634
+ "+name=my_scene" \
635
+ "experiment.scene_prompt=A cozy bedroom with a bed and desk" \
636
+ "openai.model=azure/openai/gpt-5.2" \
637
+ "furniture_agent.asset_manager.backend=hunyuan3d" \
638
+ "furniture_agent.reasoning_effort.generation=none"
639
+
640
+ # 渲染视频
641
+ python scripts/render_flythrough.py \
642
+ --blend outputs/.../combined_house/house.blend \
643
+ --output flythrough.mp4 \
644
+ --blender /path/to/blender
645
+
646
+ # 采集 Demo
647
+ python scripts/collect_demo.py \
648
+ --scene-state outputs/.../house_state.json \
649
+ --dmd outputs/.../house.dmd.yaml \
650
+ --task "Pick the book and place it on the desk" \
651
+ --output-dir demos/
652
+ ```
653
+
654
+ ### 本次运行的关键 Patch
655
+
656
+ 本次在 NVIDIA 内部集群运行时,在原始代码基础上做了以下修改:
657
+
658
+ 1. **`nvidia_inference_provider.py`**(新增):绕过 `openai-agents` SDK 对 `azure/openai/gpt-5.2` 的前缀解析,直接路由到 `inference-api.nvidia.com`
659
+ 2. **`base_stateful_agent.py`**:注入自定义 Provider
660
+ 3. **所有 YAML 配置**:`reasoning_effort: none`,防止 stateful reasoning items
661
+ 4. **`worker_pool.py`**:限制 CUDA re-init 重试次数(max 3次)
662
+ 5. **`render_flythrough.py`**(新增):适配 Blender 5.1 新 API(`action.layers[].strips[].channelbags[].fcurves`)
demos/README.md ADDED
@@ -0,0 +1,81 @@
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
+ # Demo 采集说明
2
+
3
+ 本目录包含从 SceneSmith 生成场景中采集的 pick-and-place demo。
4
+
5
+ ## Demo 列表
6
+
7
+ | 文件 | 任务 | 场景 |
8
+ |------|------|------|
9
+ | `demo_bedroom_nightstand_to_desk.json` | 从床头柜取物放到书桌 | 卧室 |
10
+ | `demo_bedroom_nightstand_to_desk_trajectory.png` | 轨迹可视化 | 卧室 |
11
+ | `demo_bedroom_wardrobe_to_desk.json` | 从衣柜附近取物放到书桌 | 卧室 |
12
+ | `demo_bedroom_wardrobe_to_desk_trajectory.png` | 轨迹可视化 | 卧室 |
13
+
14
+ ## 可视化说明
15
+
16
+ 每张 `*_trajectory.png` 包含 4 个子图:
17
+
18
+ 1. **3D 轨迹**:末端执行器路径,颜色区分阶段
19
+ - 蓝色 = approach(接近)
20
+ - 橙色 = pre_grasp(下降)
21
+ - 红色 = grasp(抓取)
22
+ - 紫色 = lift(提升)
23
+ - 绿色 = transport(搬运)
24
+ - 黄色 = place(放置)
25
+
26
+ 2. **俯视图 (XY)**:任务路径平面投影
27
+
28
+ 3. **高度时间曲线**:末端执行器(蓝实线)和物体(红虚线)Z轴变化
29
+
30
+ 4. **夹爪宽度**:0 = 完全闭合,1 = 完全张开
31
+
32
+ ## Demo JSON 格式
33
+
34
+ ```json
35
+ {
36
+ "task": "Pick an object from the nightstand and place it on the desk",
37
+ "scene_id": "bedroom_nightstand_to_desk",
38
+ "target_object": "bedroom_nightstand_0",
39
+ "initial_pos": [-0.55, -1.73, 0.5],
40
+ "goal_pos": [0.79, 1.58, 0.85],
41
+ "goal_reference": "bedroom_desk_0",
42
+ "success": true,
43
+ "total_duration_s": 7.5,
44
+ "num_steps": 150,
45
+ "trajectory": [
46
+ {
47
+ "step_id": 0,
48
+ "phase": "approach",
49
+ "end_effector_pos": [x, y, z],
50
+ "end_effector_quat_wxyz": [w, x, y, z],
51
+ "gripper_width": 1.0,
52
+ "target_object_pos": [x, y, z],
53
+ "timestamp": 0.0
54
+ }
55
+ ]
56
+ }
57
+ ```
58
+
59
+ ## 重要说明
60
+
61
+ 本次 demo 是**脚本化轨迹**(scripted demo),不是真实 robot 采集:
62
+ - 轨迹是几何插值(直线 + 竖直升降),不来自 robot controller
63
+ - 没有物理碰撞避免
64
+ - 没有力矩控制
65
+
66
+ SceneSmith 官方不提供 robot URDF 和 policy。真实 demo 采集需要:
67
+ 1. 加载 `sim_files/house.dmd.yaml` 到 Drake / MuJoCo
68
+ 2. 添加 robot URDF
69
+ 3. 用 `policy_interface.py` 获取目标位姿
70
+ 4. 用真实 controller 执行并记录
71
+
72
+ ## 采集方法
73
+
74
+ ```bash
75
+ python scripts/collect_demo.py \
76
+ --scene-state scenes/scene_01_bedroom/sim_files/house_state.json \
77
+ --dmd scenes/scene_01_bedroom/sim_files/house.dmd.yaml \
78
+ --task "Pick an object from the nightstand and place it on the desk" \
79
+ --output-dir demos/ \
80
+ --scene-id bedroom_demo
81
+ ```
demos/demo_bedroom_nightstand_to_desk.json ADDED
@@ -0,0 +1,3473 @@
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
+ {
2
+ "task": "Pick an object from the nightstand and place it on the desk",
3
+ "scene_id": "bedroom_nightstand_to_desk",
4
+ "target_object": "bedroom_desk_0",
5
+ "initial_pos": [
6
+ 0.794653215186312,
7
+ 1.5823980974477518,
8
+ -0.000425074022993442
9
+ ],
10
+ "goal_pos": [
11
+ 0.0,
12
+ 0.0,
13
+ 0.09957492597700657
14
+ ],
15
+ "goal_reference": "table",
16
+ "success": true,
17
+ "total_duration_s": 7.5,
18
+ "num_steps": 150,
19
+ "policy_interface": {},
20
+ "confidence": 0.5,
21
+ "trajectory": [
22
+ {
23
+ "step_id": 0,
24
+ "phase": "approach",
25
+ "end_effector_pos": [
26
+ 0.0,
27
+ 0.0,
28
+ 0.8
29
+ ],
30
+ "end_effector_quat_wxyz": [
31
+ 1,
32
+ 0,
33
+ 0,
34
+ 0
35
+ ],
36
+ "gripper_width": 1.0,
37
+ "target_object_id": "bedroom_desk_0",
38
+ "target_object_pos": [
39
+ 0.794653215186312,
40
+ 1.5823980974477518,
41
+ -0.000425074022993442
42
+ ],
43
+ "timestamp": 0.0
44
+ },
45
+ {
46
+ "step_id": 1,
47
+ "phase": "approach",
48
+ "end_effector_pos": [
49
+ 0.026488440506210402,
50
+ 0.052746603248258396,
51
+ 0.7866524975325669
52
+ ],
53
+ "end_effector_quat_wxyz": [
54
+ 1,
55
+ 0,
56
+ 0,
57
+ 0
58
+ ],
59
+ "gripper_width": 1.0,
60
+ "target_object_id": "bedroom_desk_0",
61
+ "target_object_pos": [
62
+ 0.794653215186312,
63
+ 1.5823980974477518,
64
+ -0.000425074022993442
65
+ ],
66
+ "timestamp": 0.05
67
+ },
68
+ {
69
+ "step_id": 2,
70
+ "phase": "approach",
71
+ "end_effector_pos": [
72
+ 0.052976881012420804,
73
+ 0.10549320649651679,
74
+ 0.7733049950651338
75
+ ],
76
+ "end_effector_quat_wxyz": [
77
+ 1,
78
+ 0,
79
+ 0,
80
+ 0
81
+ ],
82
+ "gripper_width": 1.0,
83
+ "target_object_id": "bedroom_desk_0",
84
+ "target_object_pos": [
85
+ 0.794653215186312,
86
+ 1.5823980974477518,
87
+ -0.000425074022993442
88
+ ],
89
+ "timestamp": 0.1
90
+ },
91
+ {
92
+ "step_id": 3,
93
+ "phase": "approach",
94
+ "end_effector_pos": [
95
+ 0.07946532151863121,
96
+ 0.1582398097447752,
97
+ 0.7599574925977007
98
+ ],
99
+ "end_effector_quat_wxyz": [
100
+ 1,
101
+ 0,
102
+ 0,
103
+ 0
104
+ ],
105
+ "gripper_width": 1.0,
106
+ "target_object_id": "bedroom_desk_0",
107
+ "target_object_pos": [
108
+ 0.794653215186312,
109
+ 1.5823980974477518,
110
+ -0.000425074022993442
111
+ ],
112
+ "timestamp": 0.15
113
+ },
114
+ {
115
+ "step_id": 4,
116
+ "phase": "approach",
117
+ "end_effector_pos": [
118
+ 0.10595376202484161,
119
+ 0.21098641299303358,
120
+ 0.7466099901302676
121
+ ],
122
+ "end_effector_quat_wxyz": [
123
+ 1,
124
+ 0,
125
+ 0,
126
+ 0
127
+ ],
128
+ "gripper_width": 1.0,
129
+ "target_object_id": "bedroom_desk_0",
130
+ "target_object_pos": [
131
+ 0.794653215186312,
132
+ 1.5823980974477518,
133
+ -0.000425074022993442
134
+ ],
135
+ "timestamp": 0.2
136
+ },
137
+ {
138
+ "step_id": 5,
139
+ "phase": "approach",
140
+ "end_effector_pos": [
141
+ 0.132442202531052,
142
+ 0.263733016241292,
143
+ 0.7332624876628344
144
+ ],
145
+ "end_effector_quat_wxyz": [
146
+ 1,
147
+ 0,
148
+ 0,
149
+ 0
150
+ ],
151
+ "gripper_width": 1.0,
152
+ "target_object_id": "bedroom_desk_0",
153
+ "target_object_pos": [
154
+ 0.794653215186312,
155
+ 1.5823980974477518,
156
+ -0.000425074022993442
157
+ ],
158
+ "timestamp": 0.25
159
+ },
160
+ {
161
+ "step_id": 6,
162
+ "phase": "approach",
163
+ "end_effector_pos": [
164
+ 0.15893064303726243,
165
+ 0.3164796194895504,
166
+ 0.7199149851954013
167
+ ],
168
+ "end_effector_quat_wxyz": [
169
+ 1,
170
+ 0,
171
+ 0,
172
+ 0
173
+ ],
174
+ "gripper_width": 1.0,
175
+ "target_object_id": "bedroom_desk_0",
176
+ "target_object_pos": [
177
+ 0.794653215186312,
178
+ 1.5823980974477518,
179
+ -0.000425074022993442
180
+ ],
181
+ "timestamp": 0.3
182
+ },
183
+ {
184
+ "step_id": 7,
185
+ "phase": "approach",
186
+ "end_effector_pos": [
187
+ 0.1854190835434728,
188
+ 0.36922622273780875,
189
+ 0.7065674827279682
190
+ ],
191
+ "end_effector_quat_wxyz": [
192
+ 1,
193
+ 0,
194
+ 0,
195
+ 0
196
+ ],
197
+ "gripper_width": 1.0,
198
+ "target_object_id": "bedroom_desk_0",
199
+ "target_object_pos": [
200
+ 0.794653215186312,
201
+ 1.5823980974477518,
202
+ -0.000425074022993442
203
+ ],
204
+ "timestamp": 0.35
205
+ },
206
+ {
207
+ "step_id": 8,
208
+ "phase": "approach",
209
+ "end_effector_pos": [
210
+ 0.21190752404968322,
211
+ 0.42197282598606717,
212
+ 0.6932199802605351
213
+ ],
214
+ "end_effector_quat_wxyz": [
215
+ 1,
216
+ 0,
217
+ 0,
218
+ 0
219
+ ],
220
+ "gripper_width": 1.0,
221
+ "target_object_id": "bedroom_desk_0",
222
+ "target_object_pos": [
223
+ 0.794653215186312,
224
+ 1.5823980974477518,
225
+ -0.000425074022993442
226
+ ],
227
+ "timestamp": 0.4
228
+ },
229
+ {
230
+ "step_id": 9,
231
+ "phase": "approach",
232
+ "end_effector_pos": [
233
+ 0.2383959645558936,
234
+ 0.47471942923432553,
235
+ 0.679872477793102
236
+ ],
237
+ "end_effector_quat_wxyz": [
238
+ 1,
239
+ 0,
240
+ 0,
241
+ 0
242
+ ],
243
+ "gripper_width": 1.0,
244
+ "target_object_id": "bedroom_desk_0",
245
+ "target_object_pos": [
246
+ 0.794653215186312,
247
+ 1.5823980974477518,
248
+ -0.000425074022993442
249
+ ],
250
+ "timestamp": 0.45
251
+ },
252
+ {
253
+ "step_id": 10,
254
+ "phase": "approach",
255
+ "end_effector_pos": [
256
+ 0.264884405062104,
257
+ 0.527466032482584,
258
+ 0.6665249753256689
259
+ ],
260
+ "end_effector_quat_wxyz": [
261
+ 1,
262
+ 0,
263
+ 0,
264
+ 0
265
+ ],
266
+ "gripper_width": 1.0,
267
+ "target_object_id": "bedroom_desk_0",
268
+ "target_object_pos": [
269
+ 0.794653215186312,
270
+ 1.5823980974477518,
271
+ -0.000425074022993442
272
+ ],
273
+ "timestamp": 0.5
274
+ },
275
+ {
276
+ "step_id": 11,
277
+ "phase": "approach",
278
+ "end_effector_pos": [
279
+ 0.2913728455683144,
280
+ 0.5802126357308423,
281
+ 0.6531774728582358
282
+ ],
283
+ "end_effector_quat_wxyz": [
284
+ 1,
285
+ 0,
286
+ 0,
287
+ 0
288
+ ],
289
+ "gripper_width": 1.0,
290
+ "target_object_id": "bedroom_desk_0",
291
+ "target_object_pos": [
292
+ 0.794653215186312,
293
+ 1.5823980974477518,
294
+ -0.000425074022993442
295
+ ],
296
+ "timestamp": 0.55
297
+ },
298
+ {
299
+ "step_id": 12,
300
+ "phase": "approach",
301
+ "end_effector_pos": [
302
+ 0.31786128607452485,
303
+ 0.6329592389791008,
304
+ 0.6398299703908026
305
+ ],
306
+ "end_effector_quat_wxyz": [
307
+ 1,
308
+ 0,
309
+ 0,
310
+ 0
311
+ ],
312
+ "gripper_width": 1.0,
313
+ "target_object_id": "bedroom_desk_0",
314
+ "target_object_pos": [
315
+ 0.794653215186312,
316
+ 1.5823980974477518,
317
+ -0.000425074022993442
318
+ ],
319
+ "timestamp": 0.6
320
+ },
321
+ {
322
+ "step_id": 13,
323
+ "phase": "approach",
324
+ "end_effector_pos": [
325
+ 0.3443497265807352,
326
+ 0.6857058422273592,
327
+ 0.6264824679233696
328
+ ],
329
+ "end_effector_quat_wxyz": [
330
+ 1,
331
+ 0,
332
+ 0,
333
+ 0
334
+ ],
335
+ "gripper_width": 1.0,
336
+ "target_object_id": "bedroom_desk_0",
337
+ "target_object_pos": [
338
+ 0.794653215186312,
339
+ 1.5823980974477518,
340
+ -0.000425074022993442
341
+ ],
342
+ "timestamp": 0.65
343
+ },
344
+ {
345
+ "step_id": 14,
346
+ "phase": "approach",
347
+ "end_effector_pos": [
348
+ 0.3708381670869456,
349
+ 0.7384524454756175,
350
+ 0.6131349654559364
351
+ ],
352
+ "end_effector_quat_wxyz": [
353
+ 1,
354
+ 0,
355
+ 0,
356
+ 0
357
+ ],
358
+ "gripper_width": 1.0,
359
+ "target_object_id": "bedroom_desk_0",
360
+ "target_object_pos": [
361
+ 0.794653215186312,
362
+ 1.5823980974477518,
363
+ -0.000425074022993442
364
+ ],
365
+ "timestamp": 0.7
366
+ },
367
+ {
368
+ "step_id": 15,
369
+ "phase": "approach",
370
+ "end_effector_pos": [
371
+ 0.397326607593156,
372
+ 0.7911990487238759,
373
+ 0.5997874629885033
374
+ ],
375
+ "end_effector_quat_wxyz": [
376
+ 1,
377
+ 0,
378
+ 0,
379
+ 0
380
+ ],
381
+ "gripper_width": 1.0,
382
+ "target_object_id": "bedroom_desk_0",
383
+ "target_object_pos": [
384
+ 0.794653215186312,
385
+ 1.5823980974477518,
386
+ -0.000425074022993442
387
+ ],
388
+ "timestamp": 0.75
389
+ },
390
+ {
391
+ "step_id": 16,
392
+ "phase": "approach",
393
+ "end_effector_pos": [
394
+ 0.42381504809936643,
395
+ 0.8439456519721343,
396
+ 0.5864399605210702
397
+ ],
398
+ "end_effector_quat_wxyz": [
399
+ 1,
400
+ 0,
401
+ 0,
402
+ 0
403
+ ],
404
+ "gripper_width": 1.0,
405
+ "target_object_id": "bedroom_desk_0",
406
+ "target_object_pos": [
407
+ 0.794653215186312,
408
+ 1.5823980974477518,
409
+ -0.000425074022993442
410
+ ],
411
+ "timestamp": 0.8
412
+ },
413
+ {
414
+ "step_id": 17,
415
+ "phase": "approach",
416
+ "end_effector_pos": [
417
+ 0.45030348860557684,
418
+ 0.8966922552203926,
419
+ 0.5730924580536371
420
+ ],
421
+ "end_effector_quat_wxyz": [
422
+ 1,
423
+ 0,
424
+ 0,
425
+ 0
426
+ ],
427
+ "gripper_width": 1.0,
428
+ "target_object_id": "bedroom_desk_0",
429
+ "target_object_pos": [
430
+ 0.794653215186312,
431
+ 1.5823980974477518,
432
+ -0.000425074022993442
433
+ ],
434
+ "timestamp": 0.85
435
+ },
436
+ {
437
+ "step_id": 18,
438
+ "phase": "approach",
439
+ "end_effector_pos": [
440
+ 0.4767919291117872,
441
+ 0.9494388584686511,
442
+ 0.559744955586204
443
+ ],
444
+ "end_effector_quat_wxyz": [
445
+ 1,
446
+ 0,
447
+ 0,
448
+ 0
449
+ ],
450
+ "gripper_width": 1.0,
451
+ "target_object_id": "bedroom_desk_0",
452
+ "target_object_pos": [
453
+ 0.794653215186312,
454
+ 1.5823980974477518,
455
+ -0.000425074022993442
456
+ ],
457
+ "timestamp": 0.9
458
+ },
459
+ {
460
+ "step_id": 19,
461
+ "phase": "approach",
462
+ "end_effector_pos": [
463
+ 0.5032803696179976,
464
+ 1.0021854617169095,
465
+ 0.5463974531187709
466
+ ],
467
+ "end_effector_quat_wxyz": [
468
+ 1,
469
+ 0,
470
+ 0,
471
+ 0
472
+ ],
473
+ "gripper_width": 1.0,
474
+ "target_object_id": "bedroom_desk_0",
475
+ "target_object_pos": [
476
+ 0.794653215186312,
477
+ 1.5823980974477518,
478
+ -0.000425074022993442
479
+ ],
480
+ "timestamp": 0.95
481
+ },
482
+ {
483
+ "step_id": 20,
484
+ "phase": "approach",
485
+ "end_effector_pos": [
486
+ 0.529768810124208,
487
+ 1.054932064965168,
488
+ 0.5330499506513378
489
+ ],
490
+ "end_effector_quat_wxyz": [
491
+ 1,
492
+ 0,
493
+ 0,
494
+ 0
495
+ ],
496
+ "gripper_width": 1.0,
497
+ "target_object_id": "bedroom_desk_0",
498
+ "target_object_pos": [
499
+ 0.794653215186312,
500
+ 1.5823980974477518,
501
+ -0.000425074022993442
502
+ ],
503
+ "timestamp": 1.0
504
+ },
505
+ {
506
+ "step_id": 21,
507
+ "phase": "approach",
508
+ "end_effector_pos": [
509
+ 0.5562572506304184,
510
+ 1.1076786682134263,
511
+ 0.5197024481839045
512
+ ],
513
+ "end_effector_quat_wxyz": [
514
+ 1,
515
+ 0,
516
+ 0,
517
+ 0
518
+ ],
519
+ "gripper_width": 1.0,
520
+ "target_object_id": "bedroom_desk_0",
521
+ "target_object_pos": [
522
+ 0.794653215186312,
523
+ 1.5823980974477518,
524
+ -0.000425074022993442
525
+ ],
526
+ "timestamp": 1.05
527
+ },
528
+ {
529
+ "step_id": 22,
530
+ "phase": "approach",
531
+ "end_effector_pos": [
532
+ 0.5827456911366288,
533
+ 1.1604252714616845,
534
+ 0.5063549457164715
535
+ ],
536
+ "end_effector_quat_wxyz": [
537
+ 1,
538
+ 0,
539
+ 0,
540
+ 0
541
+ ],
542
+ "gripper_width": 1.0,
543
+ "target_object_id": "bedroom_desk_0",
544
+ "target_object_pos": [
545
+ 0.794653215186312,
546
+ 1.5823980974477518,
547
+ -0.000425074022993442
548
+ ],
549
+ "timestamp": 1.1
550
+ },
551
+ {
552
+ "step_id": 23,
553
+ "phase": "approach",
554
+ "end_effector_pos": [
555
+ 0.6092341316428392,
556
+ 1.2131718747099431,
557
+ 0.49300744324903834
558
+ ],
559
+ "end_effector_quat_wxyz": [
560
+ 1,
561
+ 0,
562
+ 0,
563
+ 0
564
+ ],
565
+ "gripper_width": 1.0,
566
+ "target_object_id": "bedroom_desk_0",
567
+ "target_object_pos": [
568
+ 0.794653215186312,
569
+ 1.5823980974477518,
570
+ -0.000425074022993442
571
+ ],
572
+ "timestamp": 1.15
573
+ },
574
+ {
575
+ "step_id": 24,
576
+ "phase": "approach",
577
+ "end_effector_pos": [
578
+ 0.6357225721490497,
579
+ 1.2659184779582016,
580
+ 0.47965994078160523
581
+ ],
582
+ "end_effector_quat_wxyz": [
583
+ 1,
584
+ 0,
585
+ 0,
586
+ 0
587
+ ],
588
+ "gripper_width": 1.0,
589
+ "target_object_id": "bedroom_desk_0",
590
+ "target_object_pos": [
591
+ 0.794653215186312,
592
+ 1.5823980974477518,
593
+ -0.000425074022993442
594
+ ],
595
+ "timestamp": 1.2
596
+ },
597
+ {
598
+ "step_id": 25,
599
+ "phase": "approach",
600
+ "end_effector_pos": [
601
+ 0.6622110126552601,
602
+ 1.31866508120646,
603
+ 0.46631243831417213
604
+ ],
605
+ "end_effector_quat_wxyz": [
606
+ 1,
607
+ 0,
608
+ 0,
609
+ 0
610
+ ],
611
+ "gripper_width": 1.0,
612
+ "target_object_id": "bedroom_desk_0",
613
+ "target_object_pos": [
614
+ 0.794653215186312,
615
+ 1.5823980974477518,
616
+ -0.000425074022993442
617
+ ],
618
+ "timestamp": 1.25
619
+ },
620
+ {
621
+ "step_id": 26,
622
+ "phase": "approach",
623
+ "end_effector_pos": [
624
+ 0.6886994531614704,
625
+ 1.3714116844547184,
626
+ 0.452964935846739
627
+ ],
628
+ "end_effector_quat_wxyz": [
629
+ 1,
630
+ 0,
631
+ 0,
632
+ 0
633
+ ],
634
+ "gripper_width": 1.0,
635
+ "target_object_id": "bedroom_desk_0",
636
+ "target_object_pos": [
637
+ 0.794653215186312,
638
+ 1.5823980974477518,
639
+ -0.000425074022993442
640
+ ],
641
+ "timestamp": 1.3
642
+ },
643
+ {
644
+ "step_id": 27,
645
+ "phase": "approach",
646
+ "end_effector_pos": [
647
+ 0.7151878936676809,
648
+ 1.4241582877029766,
649
+ 0.4396174333793059
650
+ ],
651
+ "end_effector_quat_wxyz": [
652
+ 1,
653
+ 0,
654
+ 0,
655
+ 0
656
+ ],
657
+ "gripper_width": 1.0,
658
+ "target_object_id": "bedroom_desk_0",
659
+ "target_object_pos": [
660
+ 0.794653215186312,
661
+ 1.5823980974477518,
662
+ -0.000425074022993442
663
+ ],
664
+ "timestamp": 1.35
665
+ },
666
+ {
667
+ "step_id": 28,
668
+ "phase": "approach",
669
+ "end_effector_pos": [
670
+ 0.7416763341738912,
671
+ 1.476904890951235,
672
+ 0.42626993091187276
673
+ ],
674
+ "end_effector_quat_wxyz": [
675
+ 1,
676
+ 0,
677
+ 0,
678
+ 0
679
+ ],
680
+ "gripper_width": 1.0,
681
+ "target_object_id": "bedroom_desk_0",
682
+ "target_object_pos": [
683
+ 0.794653215186312,
684
+ 1.5823980974477518,
685
+ -0.000425074022993442
686
+ ],
687
+ "timestamp": 1.4
688
+ },
689
+ {
690
+ "step_id": 29,
691
+ "phase": "approach",
692
+ "end_effector_pos": [
693
+ 0.7681647746801017,
694
+ 1.5296514941994934,
695
+ 0.41292242844443966
696
+ ],
697
+ "end_effector_quat_wxyz": [
698
+ 1,
699
+ 0,
700
+ 0,
701
+ 0
702
+ ],
703
+ "gripper_width": 1.0,
704
+ "target_object_id": "bedroom_desk_0",
705
+ "target_object_pos": [
706
+ 0.794653215186312,
707
+ 1.5823980974477518,
708
+ -0.000425074022993442
709
+ ],
710
+ "timestamp": 1.45
711
+ },
712
+ {
713
+ "step_id": 30,
714
+ "phase": "pre_grasp",
715
+ "end_effector_pos": [
716
+ 0.794653215186312,
717
+ 1.5823980974477518,
718
+ 0.39957492597700656
719
+ ],
720
+ "end_effector_quat_wxyz": [
721
+ 1,
722
+ 0,
723
+ 0,
724
+ 0
725
+ ],
726
+ "gripper_width": 0.8,
727
+ "target_object_id": "bedroom_desk_0",
728
+ "target_object_pos": [
729
+ 0.794653215186312,
730
+ 1.5823980974477518,
731
+ -0.000425074022993442
732
+ ],
733
+ "timestamp": 1.5
734
+ },
735
+ {
736
+ "step_id": 31,
737
+ "phase": "pre_grasp",
738
+ "end_effector_pos": [
739
+ 0.794653215186312,
740
+ 1.5823980974477518,
741
+ 0.38557492597700654
742
+ ],
743
+ "end_effector_quat_wxyz": [
744
+ 1,
745
+ 0,
746
+ 0,
747
+ 0
748
+ ],
749
+ "gripper_width": 0.8,
750
+ "target_object_id": "bedroom_desk_0",
751
+ "target_object_pos": [
752
+ 0.794653215186312,
753
+ 1.5823980974477518,
754
+ -0.000425074022993442
755
+ ],
756
+ "timestamp": 1.55
757
+ },
758
+ {
759
+ "step_id": 32,
760
+ "phase": "pre_grasp",
761
+ "end_effector_pos": [
762
+ 0.794653215186312,
763
+ 1.5823980974477518,
764
+ 0.3715749259770066
765
+ ],
766
+ "end_effector_quat_wxyz": [
767
+ 1,
768
+ 0,
769
+ 0,
770
+ 0
771
+ ],
772
+ "gripper_width": 0.8,
773
+ "target_object_id": "bedroom_desk_0",
774
+ "target_object_pos": [
775
+ 0.794653215186312,
776
+ 1.5823980974477518,
777
+ -0.000425074022993442
778
+ ],
779
+ "timestamp": 1.6
780
+ },
781
+ {
782
+ "step_id": 33,
783
+ "phase": "pre_grasp",
784
+ "end_effector_pos": [
785
+ 0.794653215186312,
786
+ 1.5823980974477518,
787
+ 0.3575749259770066
788
+ ],
789
+ "end_effector_quat_wxyz": [
790
+ 1,
791
+ 0,
792
+ 0,
793
+ 0
794
+ ],
795
+ "gripper_width": 0.8,
796
+ "target_object_id": "bedroom_desk_0",
797
+ "target_object_pos": [
798
+ 0.794653215186312,
799
+ 1.5823980974477518,
800
+ -0.000425074022993442
801
+ ],
802
+ "timestamp": 1.65
803
+ },
804
+ {
805
+ "step_id": 34,
806
+ "phase": "pre_grasp",
807
+ "end_effector_pos": [
808
+ 0.794653215186312,
809
+ 1.5823980974477518,
810
+ 0.34357492597700656
811
+ ],
812
+ "end_effector_quat_wxyz": [
813
+ 1,
814
+ 0,
815
+ 0,
816
+ 0
817
+ ],
818
+ "gripper_width": 0.8,
819
+ "target_object_id": "bedroom_desk_0",
820
+ "target_object_pos": [
821
+ 0.794653215186312,
822
+ 1.5823980974477518,
823
+ -0.000425074022993442
824
+ ],
825
+ "timestamp": 1.7
826
+ },
827
+ {
828
+ "step_id": 35,
829
+ "phase": "pre_grasp",
830
+ "end_effector_pos": [
831
+ 0.794653215186312,
832
+ 1.5823980974477518,
833
+ 0.32957492597700655
834
+ ],
835
+ "end_effector_quat_wxyz": [
836
+ 1,
837
+ 0,
838
+ 0,
839
+ 0
840
+ ],
841
+ "gripper_width": 0.8,
842
+ "target_object_id": "bedroom_desk_0",
843
+ "target_object_pos": [
844
+ 0.794653215186312,
845
+ 1.5823980974477518,
846
+ -0.000425074022993442
847
+ ],
848
+ "timestamp": 1.75
849
+ },
850
+ {
851
+ "step_id": 36,
852
+ "phase": "pre_grasp",
853
+ "end_effector_pos": [
854
+ 0.794653215186312,
855
+ 1.5823980974477518,
856
+ 0.31557492597700654
857
+ ],
858
+ "end_effector_quat_wxyz": [
859
+ 1,
860
+ 0,
861
+ 0,
862
+ 0
863
+ ],
864
+ "gripper_width": 0.8,
865
+ "target_object_id": "bedroom_desk_0",
866
+ "target_object_pos": [
867
+ 0.794653215186312,
868
+ 1.5823980974477518,
869
+ -0.000425074022993442
870
+ ],
871
+ "timestamp": 1.8
872
+ },
873
+ {
874
+ "step_id": 37,
875
+ "phase": "pre_grasp",
876
+ "end_effector_pos": [
877
+ 0.794653215186312,
878
+ 1.5823980974477518,
879
+ 0.3015749259770066
880
+ ],
881
+ "end_effector_quat_wxyz": [
882
+ 1,
883
+ 0,
884
+ 0,
885
+ 0
886
+ ],
887
+ "gripper_width": 0.8,
888
+ "target_object_id": "bedroom_desk_0",
889
+ "target_object_pos": [
890
+ 0.794653215186312,
891
+ 1.5823980974477518,
892
+ -0.000425074022993442
893
+ ],
894
+ "timestamp": 1.85
895
+ },
896
+ {
897
+ "step_id": 38,
898
+ "phase": "pre_grasp",
899
+ "end_effector_pos": [
900
+ 0.794653215186312,
901
+ 1.5823980974477518,
902
+ 0.28757492597700657
903
+ ],
904
+ "end_effector_quat_wxyz": [
905
+ 1,
906
+ 0,
907
+ 0,
908
+ 0
909
+ ],
910
+ "gripper_width": 0.8,
911
+ "target_object_id": "bedroom_desk_0",
912
+ "target_object_pos": [
913
+ 0.794653215186312,
914
+ 1.5823980974477518,
915
+ -0.000425074022993442
916
+ ],
917
+ "timestamp": 1.9
918
+ },
919
+ {
920
+ "step_id": 39,
921
+ "phase": "pre_grasp",
922
+ "end_effector_pos": [
923
+ 0.794653215186312,
924
+ 1.5823980974477518,
925
+ 0.27357492597700656
926
+ ],
927
+ "end_effector_quat_wxyz": [
928
+ 1,
929
+ 0,
930
+ 0,
931
+ 0
932
+ ],
933
+ "gripper_width": 0.8,
934
+ "target_object_id": "bedroom_desk_0",
935
+ "target_object_pos": [
936
+ 0.794653215186312,
937
+ 1.5823980974477518,
938
+ -0.000425074022993442
939
+ ],
940
+ "timestamp": 1.95
941
+ },
942
+ {
943
+ "step_id": 40,
944
+ "phase": "pre_grasp",
945
+ "end_effector_pos": [
946
+ 0.794653215186312,
947
+ 1.5823980974477518,
948
+ 0.2595749259770066
949
+ ],
950
+ "end_effector_quat_wxyz": [
951
+ 1,
952
+ 0,
953
+ 0,
954
+ 0
955
+ ],
956
+ "gripper_width": 0.8,
957
+ "target_object_id": "bedroom_desk_0",
958
+ "target_object_pos": [
959
+ 0.794653215186312,
960
+ 1.5823980974477518,
961
+ -0.000425074022993442
962
+ ],
963
+ "timestamp": 2.0
964
+ },
965
+ {
966
+ "step_id": 41,
967
+ "phase": "pre_grasp",
968
+ "end_effector_pos": [
969
+ 0.794653215186312,
970
+ 1.5823980974477518,
971
+ 0.24557492597700656
972
+ ],
973
+ "end_effector_quat_wxyz": [
974
+ 1,
975
+ 0,
976
+ 0,
977
+ 0
978
+ ],
979
+ "gripper_width": 0.8,
980
+ "target_object_id": "bedroom_desk_0",
981
+ "target_object_pos": [
982
+ 0.794653215186312,
983
+ 1.5823980974477518,
984
+ -0.000425074022993442
985
+ ],
986
+ "timestamp": 2.05
987
+ },
988
+ {
989
+ "step_id": 42,
990
+ "phase": "pre_grasp",
991
+ "end_effector_pos": [
992
+ 0.794653215186312,
993
+ 1.5823980974477518,
994
+ 0.23157492597700657
995
+ ],
996
+ "end_effector_quat_wxyz": [
997
+ 1,
998
+ 0,
999
+ 0,
1000
+ 0
1001
+ ],
1002
+ "gripper_width": 0.8,
1003
+ "target_object_id": "bedroom_desk_0",
1004
+ "target_object_pos": [
1005
+ 0.794653215186312,
1006
+ 1.5823980974477518,
1007
+ -0.000425074022993442
1008
+ ],
1009
+ "timestamp": 2.1
1010
+ },
1011
+ {
1012
+ "step_id": 43,
1013
+ "phase": "pre_grasp",
1014
+ "end_effector_pos": [
1015
+ 0.794653215186312,
1016
+ 1.5823980974477518,
1017
+ 0.21757492597700656
1018
+ ],
1019
+ "end_effector_quat_wxyz": [
1020
+ 1,
1021
+ 0,
1022
+ 0,
1023
+ 0
1024
+ ],
1025
+ "gripper_width": 0.8,
1026
+ "target_object_id": "bedroom_desk_0",
1027
+ "target_object_pos": [
1028
+ 0.794653215186312,
1029
+ 1.5823980974477518,
1030
+ -0.000425074022993442
1031
+ ],
1032
+ "timestamp": 2.15
1033
+ },
1034
+ {
1035
+ "step_id": 44,
1036
+ "phase": "pre_grasp",
1037
+ "end_effector_pos": [
1038
+ 0.794653215186312,
1039
+ 1.5823980974477518,
1040
+ 0.20357492597700658
1041
+ ],
1042
+ "end_effector_quat_wxyz": [
1043
+ 1,
1044
+ 0,
1045
+ 0,
1046
+ 0
1047
+ ],
1048
+ "gripper_width": 0.8,
1049
+ "target_object_id": "bedroom_desk_0",
1050
+ "target_object_pos": [
1051
+ 0.794653215186312,
1052
+ 1.5823980974477518,
1053
+ -0.000425074022993442
1054
+ ],
1055
+ "timestamp": 2.2
1056
+ },
1057
+ {
1058
+ "step_id": 45,
1059
+ "phase": "pre_grasp",
1060
+ "end_effector_pos": [
1061
+ 0.794653215186312,
1062
+ 1.5823980974477518,
1063
+ 0.1895749259770066
1064
+ ],
1065
+ "end_effector_quat_wxyz": [
1066
+ 1,
1067
+ 0,
1068
+ 0,
1069
+ 0
1070
+ ],
1071
+ "gripper_width": 0.8,
1072
+ "target_object_id": "bedroom_desk_0",
1073
+ "target_object_pos": [
1074
+ 0.794653215186312,
1075
+ 1.5823980974477518,
1076
+ -0.000425074022993442
1077
+ ],
1078
+ "timestamp": 2.25
1079
+ },
1080
+ {
1081
+ "step_id": 46,
1082
+ "phase": "pre_grasp",
1083
+ "end_effector_pos": [
1084
+ 0.794653215186312,
1085
+ 1.5823980974477518,
1086
+ 0.17557492597700658
1087
+ ],
1088
+ "end_effector_quat_wxyz": [
1089
+ 1,
1090
+ 0,
1091
+ 0,
1092
+ 0
1093
+ ],
1094
+ "gripper_width": 0.8,
1095
+ "target_object_id": "bedroom_desk_0",
1096
+ "target_object_pos": [
1097
+ 0.794653215186312,
1098
+ 1.5823980974477518,
1099
+ -0.000425074022993442
1100
+ ],
1101
+ "timestamp": 2.3
1102
+ },
1103
+ {
1104
+ "step_id": 47,
1105
+ "phase": "pre_grasp",
1106
+ "end_effector_pos": [
1107
+ 0.794653215186312,
1108
+ 1.5823980974477518,
1109
+ 0.1615749259770066
1110
+ ],
1111
+ "end_effector_quat_wxyz": [
1112
+ 1,
1113
+ 0,
1114
+ 0,
1115
+ 0
1116
+ ],
1117
+ "gripper_width": 0.8,
1118
+ "target_object_id": "bedroom_desk_0",
1119
+ "target_object_pos": [
1120
+ 0.794653215186312,
1121
+ 1.5823980974477518,
1122
+ -0.000425074022993442
1123
+ ],
1124
+ "timestamp": 2.35
1125
+ },
1126
+ {
1127
+ "step_id": 48,
1128
+ "phase": "pre_grasp",
1129
+ "end_effector_pos": [
1130
+ 0.794653215186312,
1131
+ 1.5823980974477518,
1132
+ 0.14757492597700655
1133
+ ],
1134
+ "end_effector_quat_wxyz": [
1135
+ 1,
1136
+ 0,
1137
+ 0,
1138
+ 0
1139
+ ],
1140
+ "gripper_width": 0.8,
1141
+ "target_object_id": "bedroom_desk_0",
1142
+ "target_object_pos": [
1143
+ 0.794653215186312,
1144
+ 1.5823980974477518,
1145
+ -0.000425074022993442
1146
+ ],
1147
+ "timestamp": 2.4
1148
+ },
1149
+ {
1150
+ "step_id": 49,
1151
+ "phase": "pre_grasp",
1152
+ "end_effector_pos": [
1153
+ 0.794653215186312,
1154
+ 1.5823980974477518,
1155
+ 0.1335749259770066
1156
+ ],
1157
+ "end_effector_quat_wxyz": [
1158
+ 1,
1159
+ 0,
1160
+ 0,
1161
+ 0
1162
+ ],
1163
+ "gripper_width": 0.8,
1164
+ "target_object_id": "bedroom_desk_0",
1165
+ "target_object_pos": [
1166
+ 0.794653215186312,
1167
+ 1.5823980974477518,
1168
+ -0.000425074022993442
1169
+ ],
1170
+ "timestamp": 2.45
1171
+ },
1172
+ {
1173
+ "step_id": 50,
1174
+ "phase": "grasp",
1175
+ "end_effector_pos": [
1176
+ 0.794653215186312,
1177
+ 1.5823980974477518,
1178
+ 0.11957492597700657
1179
+ ],
1180
+ "end_effector_quat_wxyz": [
1181
+ 1,
1182
+ 0,
1183
+ 0,
1184
+ 0
1185
+ ],
1186
+ "gripper_width": 1.0,
1187
+ "target_object_id": "bedroom_desk_0",
1188
+ "target_object_pos": [
1189
+ 0.794653215186312,
1190
+ 1.5823980974477518,
1191
+ -0.000425074022993442
1192
+ ],
1193
+ "timestamp": 2.5
1194
+ },
1195
+ {
1196
+ "step_id": 51,
1197
+ "phase": "grasp",
1198
+ "end_effector_pos": [
1199
+ 0.794653215186312,
1200
+ 1.5823980974477518,
1201
+ 0.11957492597700657
1202
+ ],
1203
+ "end_effector_quat_wxyz": [
1204
+ 1,
1205
+ 0,
1206
+ 0,
1207
+ 0
1208
+ ],
1209
+ "gripper_width": 0.91,
1210
+ "target_object_id": "bedroom_desk_0",
1211
+ "target_object_pos": [
1212
+ 0.794653215186312,
1213
+ 1.5823980974477518,
1214
+ -0.000425074022993442
1215
+ ],
1216
+ "timestamp": 2.55
1217
+ },
1218
+ {
1219
+ "step_id": 52,
1220
+ "phase": "grasp",
1221
+ "end_effector_pos": [
1222
+ 0.794653215186312,
1223
+ 1.5823980974477518,
1224
+ 0.11957492597700657
1225
+ ],
1226
+ "end_effector_quat_wxyz": [
1227
+ 1,
1228
+ 0,
1229
+ 0,
1230
+ 0
1231
+ ],
1232
+ "gripper_width": 0.82,
1233
+ "target_object_id": "bedroom_desk_0",
1234
+ "target_object_pos": [
1235
+ 0.794653215186312,
1236
+ 1.5823980974477518,
1237
+ -0.000425074022993442
1238
+ ],
1239
+ "timestamp": 2.6
1240
+ },
1241
+ {
1242
+ "step_id": 53,
1243
+ "phase": "grasp",
1244
+ "end_effector_pos": [
1245
+ 0.794653215186312,
1246
+ 1.5823980974477518,
1247
+ 0.11957492597700657
1248
+ ],
1249
+ "end_effector_quat_wxyz": [
1250
+ 1,
1251
+ 0,
1252
+ 0,
1253
+ 0
1254
+ ],
1255
+ "gripper_width": 0.73,
1256
+ "target_object_id": "bedroom_desk_0",
1257
+ "target_object_pos": [
1258
+ 0.794653215186312,
1259
+ 1.5823980974477518,
1260
+ -0.000425074022993442
1261
+ ],
1262
+ "timestamp": 2.65
1263
+ },
1264
+ {
1265
+ "step_id": 54,
1266
+ "phase": "grasp",
1267
+ "end_effector_pos": [
1268
+ 0.794653215186312,
1269
+ 1.5823980974477518,
1270
+ 0.11957492597700657
1271
+ ],
1272
+ "end_effector_quat_wxyz": [
1273
+ 1,
1274
+ 0,
1275
+ 0,
1276
+ 0
1277
+ ],
1278
+ "gripper_width": 0.6399999999999999,
1279
+ "target_object_id": "bedroom_desk_0",
1280
+ "target_object_pos": [
1281
+ 0.794653215186312,
1282
+ 1.5823980974477518,
1283
+ -0.000425074022993442
1284
+ ],
1285
+ "timestamp": 2.7
1286
+ },
1287
+ {
1288
+ "step_id": 55,
1289
+ "phase": "grasp",
1290
+ "end_effector_pos": [
1291
+ 0.794653215186312,
1292
+ 1.5823980974477518,
1293
+ 0.11957492597700657
1294
+ ],
1295
+ "end_effector_quat_wxyz": [
1296
+ 1,
1297
+ 0,
1298
+ 0,
1299
+ 0
1300
+ ],
1301
+ "gripper_width": 0.55,
1302
+ "target_object_id": "bedroom_desk_0",
1303
+ "target_object_pos": [
1304
+ 0.794653215186312,
1305
+ 1.5823980974477518,
1306
+ -0.000425074022993442
1307
+ ],
1308
+ "timestamp": 2.75
1309
+ },
1310
+ {
1311
+ "step_id": 56,
1312
+ "phase": "grasp",
1313
+ "end_effector_pos": [
1314
+ 0.794653215186312,
1315
+ 1.5823980974477518,
1316
+ 0.11957492597700657
1317
+ ],
1318
+ "end_effector_quat_wxyz": [
1319
+ 1,
1320
+ 0,
1321
+ 0,
1322
+ 0
1323
+ ],
1324
+ "gripper_width": 0.45999999999999996,
1325
+ "target_object_id": "bedroom_desk_0",
1326
+ "target_object_pos": [
1327
+ 0.794653215186312,
1328
+ 1.5823980974477518,
1329
+ -0.000425074022993442
1330
+ ],
1331
+ "timestamp": 2.8
1332
+ },
1333
+ {
1334
+ "step_id": 57,
1335
+ "phase": "grasp",
1336
+ "end_effector_pos": [
1337
+ 0.794653215186312,
1338
+ 1.5823980974477518,
1339
+ 0.11957492597700657
1340
+ ],
1341
+ "end_effector_quat_wxyz": [
1342
+ 1,
1343
+ 0,
1344
+ 0,
1345
+ 0
1346
+ ],
1347
+ "gripper_width": 0.37,
1348
+ "target_object_id": "bedroom_desk_0",
1349
+ "target_object_pos": [
1350
+ 0.794653215186312,
1351
+ 1.5823980974477518,
1352
+ -0.000425074022993442
1353
+ ],
1354
+ "timestamp": 2.85
1355
+ },
1356
+ {
1357
+ "step_id": 58,
1358
+ "phase": "grasp",
1359
+ "end_effector_pos": [
1360
+ 0.794653215186312,
1361
+ 1.5823980974477518,
1362
+ 0.11957492597700657
1363
+ ],
1364
+ "end_effector_quat_wxyz": [
1365
+ 1,
1366
+ 0,
1367
+ 0,
1368
+ 0
1369
+ ],
1370
+ "gripper_width": 0.2799999999999999,
1371
+ "target_object_id": "bedroom_desk_0",
1372
+ "target_object_pos": [
1373
+ 0.794653215186312,
1374
+ 1.5823980974477518,
1375
+ -0.000425074022993442
1376
+ ],
1377
+ "timestamp": 2.9
1378
+ },
1379
+ {
1380
+ "step_id": 59,
1381
+ "phase": "grasp",
1382
+ "end_effector_pos": [
1383
+ 0.794653215186312,
1384
+ 1.5823980974477518,
1385
+ 0.11957492597700657
1386
+ ],
1387
+ "end_effector_quat_wxyz": [
1388
+ 1,
1389
+ 0,
1390
+ 0,
1391
+ 0
1392
+ ],
1393
+ "gripper_width": 0.18999999999999995,
1394
+ "target_object_id": "bedroom_desk_0",
1395
+ "target_object_pos": [
1396
+ 0.794653215186312,
1397
+ 1.5823980974477518,
1398
+ -0.000425074022993442
1399
+ ],
1400
+ "timestamp": 2.95
1401
+ },
1402
+ {
1403
+ "step_id": 60,
1404
+ "phase": "lift",
1405
+ "end_effector_pos": [
1406
+ 0.794653215186312,
1407
+ 1.5823980974477518,
1408
+ 0.11957492597700657
1409
+ ],
1410
+ "end_effector_quat_wxyz": [
1411
+ 1,
1412
+ 0,
1413
+ 0,
1414
+ 0
1415
+ ],
1416
+ "gripper_width": 0.1,
1417
+ "target_object_id": "bedroom_desk_0",
1418
+ "target_object_pos": [
1419
+ 0.794653215186312,
1420
+ 1.5823980974477518,
1421
+ 0.11957492597700657
1422
+ ],
1423
+ "timestamp": 3.0
1424
+ },
1425
+ {
1426
+ "step_id": 61,
1427
+ "phase": "lift",
1428
+ "end_effector_pos": [
1429
+ 0.794653215186312,
1430
+ 1.5823980974477518,
1431
+ 0.13357492597700657
1432
+ ],
1433
+ "end_effector_quat_wxyz": [
1434
+ 1,
1435
+ 0,
1436
+ 0,
1437
+ 0
1438
+ ],
1439
+ "gripper_width": 0.1,
1440
+ "target_object_id": "bedroom_desk_0",
1441
+ "target_object_pos": [
1442
+ 0.794653215186312,
1443
+ 1.5823980974477518,
1444
+ 0.13357492597700657
1445
+ ],
1446
+ "timestamp": 3.05
1447
+ },
1448
+ {
1449
+ "step_id": 62,
1450
+ "phase": "lift",
1451
+ "end_effector_pos": [
1452
+ 0.794653215186312,
1453
+ 1.5823980974477518,
1454
+ 0.14757492597700655
1455
+ ],
1456
+ "end_effector_quat_wxyz": [
1457
+ 1,
1458
+ 0,
1459
+ 0,
1460
+ 0
1461
+ ],
1462
+ "gripper_width": 0.1,
1463
+ "target_object_id": "bedroom_desk_0",
1464
+ "target_object_pos": [
1465
+ 0.794653215186312,
1466
+ 1.5823980974477518,
1467
+ 0.14757492597700655
1468
+ ],
1469
+ "timestamp": 3.1
1470
+ },
1471
+ {
1472
+ "step_id": 63,
1473
+ "phase": "lift",
1474
+ "end_effector_pos": [
1475
+ 0.794653215186312,
1476
+ 1.5823980974477518,
1477
+ 0.16157492597700657
1478
+ ],
1479
+ "end_effector_quat_wxyz": [
1480
+ 1,
1481
+ 0,
1482
+ 0,
1483
+ 0
1484
+ ],
1485
+ "gripper_width": 0.1,
1486
+ "target_object_id": "bedroom_desk_0",
1487
+ "target_object_pos": [
1488
+ 0.794653215186312,
1489
+ 1.5823980974477518,
1490
+ 0.16157492597700657
1491
+ ],
1492
+ "timestamp": 3.15
1493
+ },
1494
+ {
1495
+ "step_id": 64,
1496
+ "phase": "lift",
1497
+ "end_effector_pos": [
1498
+ 0.794653215186312,
1499
+ 1.5823980974477518,
1500
+ 0.17557492597700658
1501
+ ],
1502
+ "end_effector_quat_wxyz": [
1503
+ 1,
1504
+ 0,
1505
+ 0,
1506
+ 0
1507
+ ],
1508
+ "gripper_width": 0.1,
1509
+ "target_object_id": "bedroom_desk_0",
1510
+ "target_object_pos": [
1511
+ 0.794653215186312,
1512
+ 1.5823980974477518,
1513
+ 0.17557492597700658
1514
+ ],
1515
+ "timestamp": 3.2
1516
+ },
1517
+ {
1518
+ "step_id": 65,
1519
+ "phase": "lift",
1520
+ "end_effector_pos": [
1521
+ 0.794653215186312,
1522
+ 1.5823980974477518,
1523
+ 0.18957492597700656
1524
+ ],
1525
+ "end_effector_quat_wxyz": [
1526
+ 1,
1527
+ 0,
1528
+ 0,
1529
+ 0
1530
+ ],
1531
+ "gripper_width": 0.1,
1532
+ "target_object_id": "bedroom_desk_0",
1533
+ "target_object_pos": [
1534
+ 0.794653215186312,
1535
+ 1.5823980974477518,
1536
+ 0.18957492597700656
1537
+ ],
1538
+ "timestamp": 3.25
1539
+ },
1540
+ {
1541
+ "step_id": 66,
1542
+ "phase": "lift",
1543
+ "end_effector_pos": [
1544
+ 0.794653215186312,
1545
+ 1.5823980974477518,
1546
+ 0.20357492597700655
1547
+ ],
1548
+ "end_effector_quat_wxyz": [
1549
+ 1,
1550
+ 0,
1551
+ 0,
1552
+ 0
1553
+ ],
1554
+ "gripper_width": 0.1,
1555
+ "target_object_id": "bedroom_desk_0",
1556
+ "target_object_pos": [
1557
+ 0.794653215186312,
1558
+ 1.5823980974477518,
1559
+ 0.20357492597700655
1560
+ ],
1561
+ "timestamp": 3.3
1562
+ },
1563
+ {
1564
+ "step_id": 67,
1565
+ "phase": "lift",
1566
+ "end_effector_pos": [
1567
+ 0.794653215186312,
1568
+ 1.5823980974477518,
1569
+ 0.21757492597700656
1570
+ ],
1571
+ "end_effector_quat_wxyz": [
1572
+ 1,
1573
+ 0,
1574
+ 0,
1575
+ 0
1576
+ ],
1577
+ "gripper_width": 0.1,
1578
+ "target_object_id": "bedroom_desk_0",
1579
+ "target_object_pos": [
1580
+ 0.794653215186312,
1581
+ 1.5823980974477518,
1582
+ 0.21757492597700656
1583
+ ],
1584
+ "timestamp": 3.35
1585
+ },
1586
+ {
1587
+ "step_id": 68,
1588
+ "phase": "lift",
1589
+ "end_effector_pos": [
1590
+ 0.794653215186312,
1591
+ 1.5823980974477518,
1592
+ 0.23157492597700657
1593
+ ],
1594
+ "end_effector_quat_wxyz": [
1595
+ 1,
1596
+ 0,
1597
+ 0,
1598
+ 0
1599
+ ],
1600
+ "gripper_width": 0.1,
1601
+ "target_object_id": "bedroom_desk_0",
1602
+ "target_object_pos": [
1603
+ 0.794653215186312,
1604
+ 1.5823980974477518,
1605
+ 0.23157492597700657
1606
+ ],
1607
+ "timestamp": 3.4
1608
+ },
1609
+ {
1610
+ "step_id": 69,
1611
+ "phase": "lift",
1612
+ "end_effector_pos": [
1613
+ 0.794653215186312,
1614
+ 1.5823980974477518,
1615
+ 0.2455749259770066
1616
+ ],
1617
+ "end_effector_quat_wxyz": [
1618
+ 1,
1619
+ 0,
1620
+ 0,
1621
+ 0
1622
+ ],
1623
+ "gripper_width": 0.1,
1624
+ "target_object_id": "bedroom_desk_0",
1625
+ "target_object_pos": [
1626
+ 0.794653215186312,
1627
+ 1.5823980974477518,
1628
+ 0.2455749259770066
1629
+ ],
1630
+ "timestamp": 3.45
1631
+ },
1632
+ {
1633
+ "step_id": 70,
1634
+ "phase": "lift",
1635
+ "end_effector_pos": [
1636
+ 0.794653215186312,
1637
+ 1.5823980974477518,
1638
+ 0.25957492597700654
1639
+ ],
1640
+ "end_effector_quat_wxyz": [
1641
+ 1,
1642
+ 0,
1643
+ 0,
1644
+ 0
1645
+ ],
1646
+ "gripper_width": 0.1,
1647
+ "target_object_id": "bedroom_desk_0",
1648
+ "target_object_pos": [
1649
+ 0.794653215186312,
1650
+ 1.5823980974477518,
1651
+ 0.25957492597700654
1652
+ ],
1653
+ "timestamp": 3.5
1654
+ },
1655
+ {
1656
+ "step_id": 71,
1657
+ "phase": "lift",
1658
+ "end_effector_pos": [
1659
+ 0.794653215186312,
1660
+ 1.5823980974477518,
1661
+ 0.27357492597700656
1662
+ ],
1663
+ "end_effector_quat_wxyz": [
1664
+ 1,
1665
+ 0,
1666
+ 0,
1667
+ 0
1668
+ ],
1669
+ "gripper_width": 0.1,
1670
+ "target_object_id": "bedroom_desk_0",
1671
+ "target_object_pos": [
1672
+ 0.794653215186312,
1673
+ 1.5823980974477518,
1674
+ 0.27357492597700656
1675
+ ],
1676
+ "timestamp": 3.55
1677
+ },
1678
+ {
1679
+ "step_id": 72,
1680
+ "phase": "lift",
1681
+ "end_effector_pos": [
1682
+ 0.794653215186312,
1683
+ 1.5823980974477518,
1684
+ 0.28757492597700657
1685
+ ],
1686
+ "end_effector_quat_wxyz": [
1687
+ 1,
1688
+ 0,
1689
+ 0,
1690
+ 0
1691
+ ],
1692
+ "gripper_width": 0.1,
1693
+ "target_object_id": "bedroom_desk_0",
1694
+ "target_object_pos": [
1695
+ 0.794653215186312,
1696
+ 1.5823980974477518,
1697
+ 0.28757492597700657
1698
+ ],
1699
+ "timestamp": 3.6
1700
+ },
1701
+ {
1702
+ "step_id": 73,
1703
+ "phase": "lift",
1704
+ "end_effector_pos": [
1705
+ 0.794653215186312,
1706
+ 1.5823980974477518,
1707
+ 0.3015749259770066
1708
+ ],
1709
+ "end_effector_quat_wxyz": [
1710
+ 1,
1711
+ 0,
1712
+ 0,
1713
+ 0
1714
+ ],
1715
+ "gripper_width": 0.1,
1716
+ "target_object_id": "bedroom_desk_0",
1717
+ "target_object_pos": [
1718
+ 0.794653215186312,
1719
+ 1.5823980974477518,
1720
+ 0.3015749259770066
1721
+ ],
1722
+ "timestamp": 3.65
1723
+ },
1724
+ {
1725
+ "step_id": 74,
1726
+ "phase": "lift",
1727
+ "end_effector_pos": [
1728
+ 0.794653215186312,
1729
+ 1.5823980974477518,
1730
+ 0.31557492597700654
1731
+ ],
1732
+ "end_effector_quat_wxyz": [
1733
+ 1,
1734
+ 0,
1735
+ 0,
1736
+ 0
1737
+ ],
1738
+ "gripper_width": 0.1,
1739
+ "target_object_id": "bedroom_desk_0",
1740
+ "target_object_pos": [
1741
+ 0.794653215186312,
1742
+ 1.5823980974477518,
1743
+ 0.31557492597700654
1744
+ ],
1745
+ "timestamp": 3.7
1746
+ },
1747
+ {
1748
+ "step_id": 75,
1749
+ "phase": "lift",
1750
+ "end_effector_pos": [
1751
+ 0.794653215186312,
1752
+ 1.5823980974477518,
1753
+ 0.32957492597700655
1754
+ ],
1755
+ "end_effector_quat_wxyz": [
1756
+ 1,
1757
+ 0,
1758
+ 0,
1759
+ 0
1760
+ ],
1761
+ "gripper_width": 0.1,
1762
+ "target_object_id": "bedroom_desk_0",
1763
+ "target_object_pos": [
1764
+ 0.794653215186312,
1765
+ 1.5823980974477518,
1766
+ 0.32957492597700655
1767
+ ],
1768
+ "timestamp": 3.75
1769
+ },
1770
+ {
1771
+ "step_id": 76,
1772
+ "phase": "lift",
1773
+ "end_effector_pos": [
1774
+ 0.794653215186312,
1775
+ 1.5823980974477518,
1776
+ 0.34357492597700656
1777
+ ],
1778
+ "end_effector_quat_wxyz": [
1779
+ 1,
1780
+ 0,
1781
+ 0,
1782
+ 0
1783
+ ],
1784
+ "gripper_width": 0.1,
1785
+ "target_object_id": "bedroom_desk_0",
1786
+ "target_object_pos": [
1787
+ 0.794653215186312,
1788
+ 1.5823980974477518,
1789
+ 0.34357492597700656
1790
+ ],
1791
+ "timestamp": 3.8
1792
+ },
1793
+ {
1794
+ "step_id": 77,
1795
+ "phase": "lift",
1796
+ "end_effector_pos": [
1797
+ 0.794653215186312,
1798
+ 1.5823980974477518,
1799
+ 0.3575749259770065
1800
+ ],
1801
+ "end_effector_quat_wxyz": [
1802
+ 1,
1803
+ 0,
1804
+ 0,
1805
+ 0
1806
+ ],
1807
+ "gripper_width": 0.1,
1808
+ "target_object_id": "bedroom_desk_0",
1809
+ "target_object_pos": [
1810
+ 0.794653215186312,
1811
+ 1.5823980974477518,
1812
+ 0.3575749259770065
1813
+ ],
1814
+ "timestamp": 3.85
1815
+ },
1816
+ {
1817
+ "step_id": 78,
1818
+ "phase": "lift",
1819
+ "end_effector_pos": [
1820
+ 0.794653215186312,
1821
+ 1.5823980974477518,
1822
+ 0.3715749259770066
1823
+ ],
1824
+ "end_effector_quat_wxyz": [
1825
+ 1,
1826
+ 0,
1827
+ 0,
1828
+ 0
1829
+ ],
1830
+ "gripper_width": 0.1,
1831
+ "target_object_id": "bedroom_desk_0",
1832
+ "target_object_pos": [
1833
+ 0.794653215186312,
1834
+ 1.5823980974477518,
1835
+ 0.3715749259770066
1836
+ ],
1837
+ "timestamp": 3.9
1838
+ },
1839
+ {
1840
+ "step_id": 79,
1841
+ "phase": "lift",
1842
+ "end_effector_pos": [
1843
+ 0.794653215186312,
1844
+ 1.5823980974477518,
1845
+ 0.38557492597700654
1846
+ ],
1847
+ "end_effector_quat_wxyz": [
1848
+ 1,
1849
+ 0,
1850
+ 0,
1851
+ 0
1852
+ ],
1853
+ "gripper_width": 0.1,
1854
+ "target_object_id": "bedroom_desk_0",
1855
+ "target_object_pos": [
1856
+ 0.794653215186312,
1857
+ 1.5823980974477518,
1858
+ 0.38557492597700654
1859
+ ],
1860
+ "timestamp": 3.95
1861
+ },
1862
+ {
1863
+ "step_id": 80,
1864
+ "phase": "transport",
1865
+ "end_effector_pos": [
1866
+ 0.794653215186312,
1867
+ 1.5823980974477518,
1868
+ 0.39957492597700656
1869
+ ],
1870
+ "end_effector_quat_wxyz": [
1871
+ 1,
1872
+ 0,
1873
+ 0,
1874
+ 0
1875
+ ],
1876
+ "gripper_width": 0.1,
1877
+ "target_object_id": "bedroom_desk_0",
1878
+ "target_object_pos": [
1879
+ 0.794653215186312,
1880
+ 1.5823980974477518,
1881
+ 0.39957492597700656
1882
+ ],
1883
+ "timestamp": 4.0
1884
+ },
1885
+ {
1886
+ "step_id": 81,
1887
+ "phase": "transport",
1888
+ "end_effector_pos": [
1889
+ 0.7747868848066543,
1890
+ 1.542838145011558,
1891
+ 0.39957492597700656
1892
+ ],
1893
+ "end_effector_quat_wxyz": [
1894
+ 1,
1895
+ 0,
1896
+ 0,
1897
+ 0
1898
+ ],
1899
+ "gripper_width": 0.1,
1900
+ "target_object_id": "bedroom_desk_0",
1901
+ "target_object_pos": [
1902
+ 0.7747868848066543,
1903
+ 1.542838145011558,
1904
+ 0.39957492597700656
1905
+ ],
1906
+ "timestamp": 4.05
1907
+ },
1908
+ {
1909
+ "step_id": 82,
1910
+ "phase": "transport",
1911
+ "end_effector_pos": [
1912
+ 0.7549205544269965,
1913
+ 1.5032781925753642,
1914
+ 0.39957492597700656
1915
+ ],
1916
+ "end_effector_quat_wxyz": [
1917
+ 1,
1918
+ 0,
1919
+ 0,
1920
+ 0
1921
+ ],
1922
+ "gripper_width": 0.1,
1923
+ "target_object_id": "bedroom_desk_0",
1924
+ "target_object_pos": [
1925
+ 0.7549205544269965,
1926
+ 1.5032781925753642,
1927
+ 0.39957492597700656
1928
+ ],
1929
+ "timestamp": 4.1
1930
+ },
1931
+ {
1932
+ "step_id": 83,
1933
+ "phase": "transport",
1934
+ "end_effector_pos": [
1935
+ 0.7350542240473387,
1936
+ 1.4637182401391704,
1937
+ 0.39957492597700656
1938
+ ],
1939
+ "end_effector_quat_wxyz": [
1940
+ 1,
1941
+ 0,
1942
+ 0,
1943
+ 0
1944
+ ],
1945
+ "gripper_width": 0.1,
1946
+ "target_object_id": "bedroom_desk_0",
1947
+ "target_object_pos": [
1948
+ 0.7350542240473387,
1949
+ 1.4637182401391704,
1950
+ 0.39957492597700656
1951
+ ],
1952
+ "timestamp": 4.15
1953
+ },
1954
+ {
1955
+ "step_id": 84,
1956
+ "phase": "transport",
1957
+ "end_effector_pos": [
1958
+ 0.7151878936676809,
1959
+ 1.4241582877029766,
1960
+ 0.39957492597700656
1961
+ ],
1962
+ "end_effector_quat_wxyz": [
1963
+ 1,
1964
+ 0,
1965
+ 0,
1966
+ 0
1967
+ ],
1968
+ "gripper_width": 0.1,
1969
+ "target_object_id": "bedroom_desk_0",
1970
+ "target_object_pos": [
1971
+ 0.7151878936676809,
1972
+ 1.4241582877029766,
1973
+ 0.39957492597700656
1974
+ ],
1975
+ "timestamp": 4.2
1976
+ },
1977
+ {
1978
+ "step_id": 85,
1979
+ "phase": "transport",
1980
+ "end_effector_pos": [
1981
+ 0.6953215632880231,
1982
+ 1.3845983352667828,
1983
+ 0.39957492597700656
1984
+ ],
1985
+ "end_effector_quat_wxyz": [
1986
+ 1,
1987
+ 0,
1988
+ 0,
1989
+ 0
1990
+ ],
1991
+ "gripper_width": 0.1,
1992
+ "target_object_id": "bedroom_desk_0",
1993
+ "target_object_pos": [
1994
+ 0.6953215632880231,
1995
+ 1.3845983352667828,
1996
+ 0.39957492597700656
1997
+ ],
1998
+ "timestamp": 4.25
1999
+ },
2000
+ {
2001
+ "step_id": 86,
2002
+ "phase": "transport",
2003
+ "end_effector_pos": [
2004
+ 0.6754552329083653,
2005
+ 1.3450383828305892,
2006
+ 0.39957492597700656
2007
+ ],
2008
+ "end_effector_quat_wxyz": [
2009
+ 1,
2010
+ 0,
2011
+ 0,
2012
+ 0
2013
+ ],
2014
+ "gripper_width": 0.1,
2015
+ "target_object_id": "bedroom_desk_0",
2016
+ "target_object_pos": [
2017
+ 0.6754552329083653,
2018
+ 1.3450383828305892,
2019
+ 0.39957492597700656
2020
+ ],
2021
+ "timestamp": 4.3
2022
+ },
2023
+ {
2024
+ "step_id": 87,
2025
+ "phase": "transport",
2026
+ "end_effector_pos": [
2027
+ 0.6555889025287074,
2028
+ 1.3054784303943952,
2029
+ 0.39957492597700656
2030
+ ],
2031
+ "end_effector_quat_wxyz": [
2032
+ 1,
2033
+ 0,
2034
+ 0,
2035
+ 0
2036
+ ],
2037
+ "gripper_width": 0.1,
2038
+ "target_object_id": "bedroom_desk_0",
2039
+ "target_object_pos": [
2040
+ 0.6555889025287074,
2041
+ 1.3054784303943952,
2042
+ 0.39957492597700656
2043
+ ],
2044
+ "timestamp": 4.35
2045
+ },
2046
+ {
2047
+ "step_id": 88,
2048
+ "phase": "transport",
2049
+ "end_effector_pos": [
2050
+ 0.6357225721490496,
2051
+ 1.2659184779582016,
2052
+ 0.39957492597700656
2053
+ ],
2054
+ "end_effector_quat_wxyz": [
2055
+ 1,
2056
+ 0,
2057
+ 0,
2058
+ 0
2059
+ ],
2060
+ "gripper_width": 0.1,
2061
+ "target_object_id": "bedroom_desk_0",
2062
+ "target_object_pos": [
2063
+ 0.6357225721490496,
2064
+ 1.2659184779582016,
2065
+ 0.39957492597700656
2066
+ ],
2067
+ "timestamp": 4.4
2068
+ },
2069
+ {
2070
+ "step_id": 89,
2071
+ "phase": "transport",
2072
+ "end_effector_pos": [
2073
+ 0.6158562417693918,
2074
+ 1.2263585255220077,
2075
+ 0.39957492597700656
2076
+ ],
2077
+ "end_effector_quat_wxyz": [
2078
+ 1,
2079
+ 0,
2080
+ 0,
2081
+ 0
2082
+ ],
2083
+ "gripper_width": 0.1,
2084
+ "target_object_id": "bedroom_desk_0",
2085
+ "target_object_pos": [
2086
+ 0.6158562417693918,
2087
+ 1.2263585255220077,
2088
+ 0.39957492597700656
2089
+ ],
2090
+ "timestamp": 4.45
2091
+ },
2092
+ {
2093
+ "step_id": 90,
2094
+ "phase": "transport",
2095
+ "end_effector_pos": [
2096
+ 0.595989911389734,
2097
+ 1.186798573085814,
2098
+ 0.39957492597700656
2099
+ ],
2100
+ "end_effector_quat_wxyz": [
2101
+ 1,
2102
+ 0,
2103
+ 0,
2104
+ 0
2105
+ ],
2106
+ "gripper_width": 0.1,
2107
+ "target_object_id": "bedroom_desk_0",
2108
+ "target_object_pos": [
2109
+ 0.595989911389734,
2110
+ 1.186798573085814,
2111
+ 0.39957492597700656
2112
+ ],
2113
+ "timestamp": 4.5
2114
+ },
2115
+ {
2116
+ "step_id": 91,
2117
+ "phase": "transport",
2118
+ "end_effector_pos": [
2119
+ 0.5761235810100762,
2120
+ 1.1472386206496201,
2121
+ 0.39957492597700656
2122
+ ],
2123
+ "end_effector_quat_wxyz": [
2124
+ 1,
2125
+ 0,
2126
+ 0,
2127
+ 0
2128
+ ],
2129
+ "gripper_width": 0.1,
2130
+ "target_object_id": "bedroom_desk_0",
2131
+ "target_object_pos": [
2132
+ 0.5761235810100762,
2133
+ 1.1472386206496201,
2134
+ 0.39957492597700656
2135
+ ],
2136
+ "timestamp": 4.55
2137
+ },
2138
+ {
2139
+ "step_id": 92,
2140
+ "phase": "transport",
2141
+ "end_effector_pos": [
2142
+ 0.5562572506304184,
2143
+ 1.1076786682134263,
2144
+ 0.39957492597700656
2145
+ ],
2146
+ "end_effector_quat_wxyz": [
2147
+ 1,
2148
+ 0,
2149
+ 0,
2150
+ 0
2151
+ ],
2152
+ "gripper_width": 0.1,
2153
+ "target_object_id": "bedroom_desk_0",
2154
+ "target_object_pos": [
2155
+ 0.5562572506304184,
2156
+ 1.1076786682134263,
2157
+ 0.39957492597700656
2158
+ ],
2159
+ "timestamp": 4.6
2160
+ },
2161
+ {
2162
+ "step_id": 93,
2163
+ "phase": "transport",
2164
+ "end_effector_pos": [
2165
+ 0.5363909202507606,
2166
+ 1.0681187157772325,
2167
+ 0.39957492597700656
2168
+ ],
2169
+ "end_effector_quat_wxyz": [
2170
+ 1,
2171
+ 0,
2172
+ 0,
2173
+ 0
2174
+ ],
2175
+ "gripper_width": 0.1,
2176
+ "target_object_id": "bedroom_desk_0",
2177
+ "target_object_pos": [
2178
+ 0.5363909202507606,
2179
+ 1.0681187157772325,
2180
+ 0.39957492597700656
2181
+ ],
2182
+ "timestamp": 4.65
2183
+ },
2184
+ {
2185
+ "step_id": 94,
2186
+ "phase": "transport",
2187
+ "end_effector_pos": [
2188
+ 0.5165245898711028,
2189
+ 1.0285587633410387,
2190
+ 0.39957492597700656
2191
+ ],
2192
+ "end_effector_quat_wxyz": [
2193
+ 1,
2194
+ 0,
2195
+ 0,
2196
+ 0
2197
+ ],
2198
+ "gripper_width": 0.1,
2199
+ "target_object_id": "bedroom_desk_0",
2200
+ "target_object_pos": [
2201
+ 0.5165245898711028,
2202
+ 1.0285587633410387,
2203
+ 0.39957492597700656
2204
+ ],
2205
+ "timestamp": 4.7
2206
+ },
2207
+ {
2208
+ "step_id": 95,
2209
+ "phase": "transport",
2210
+ "end_effector_pos": [
2211
+ 0.49665825949144504,
2212
+ 0.9889988109048449,
2213
+ 0.39957492597700656
2214
+ ],
2215
+ "end_effector_quat_wxyz": [
2216
+ 1,
2217
+ 0,
2218
+ 0,
2219
+ 0
2220
+ ],
2221
+ "gripper_width": 0.1,
2222
+ "target_object_id": "bedroom_desk_0",
2223
+ "target_object_pos": [
2224
+ 0.49665825949144504,
2225
+ 0.9889988109048449,
2226
+ 0.39957492597700656
2227
+ ],
2228
+ "timestamp": 4.75
2229
+ },
2230
+ {
2231
+ "step_id": 96,
2232
+ "phase": "transport",
2233
+ "end_effector_pos": [
2234
+ 0.4767919291117872,
2235
+ 0.9494388584686511,
2236
+ 0.39957492597700656
2237
+ ],
2238
+ "end_effector_quat_wxyz": [
2239
+ 1,
2240
+ 0,
2241
+ 0,
2242
+ 0
2243
+ ],
2244
+ "gripper_width": 0.1,
2245
+ "target_object_id": "bedroom_desk_0",
2246
+ "target_object_pos": [
2247
+ 0.4767919291117872,
2248
+ 0.9494388584686511,
2249
+ 0.39957492597700656
2250
+ ],
2251
+ "timestamp": 4.8
2252
+ },
2253
+ {
2254
+ "step_id": 97,
2255
+ "phase": "transport",
2256
+ "end_effector_pos": [
2257
+ 0.45692559873212946,
2258
+ 0.9098789060324574,
2259
+ 0.39957492597700656
2260
+ ],
2261
+ "end_effector_quat_wxyz": [
2262
+ 1,
2263
+ 0,
2264
+ 0,
2265
+ 0
2266
+ ],
2267
+ "gripper_width": 0.1,
2268
+ "target_object_id": "bedroom_desk_0",
2269
+ "target_object_pos": [
2270
+ 0.45692559873212946,
2271
+ 0.9098789060324574,
2272
+ 0.39957492597700656
2273
+ ],
2274
+ "timestamp": 4.85
2275
+ },
2276
+ {
2277
+ "step_id": 98,
2278
+ "phase": "transport",
2279
+ "end_effector_pos": [
2280
+ 0.4370592683524716,
2281
+ 0.8703189535962635,
2282
+ 0.39957492597700656
2283
+ ],
2284
+ "end_effector_quat_wxyz": [
2285
+ 1,
2286
+ 0,
2287
+ 0,
2288
+ 0
2289
+ ],
2290
+ "gripper_width": 0.1,
2291
+ "target_object_id": "bedroom_desk_0",
2292
+ "target_object_pos": [
2293
+ 0.4370592683524716,
2294
+ 0.8703189535962635,
2295
+ 0.39957492597700656
2296
+ ],
2297
+ "timestamp": 4.9
2298
+ },
2299
+ {
2300
+ "step_id": 99,
2301
+ "phase": "transport",
2302
+ "end_effector_pos": [
2303
+ 0.4171929379728138,
2304
+ 0.8307590011600697,
2305
+ 0.39957492597700656
2306
+ ],
2307
+ "end_effector_quat_wxyz": [
2308
+ 1,
2309
+ 0,
2310
+ 0,
2311
+ 0
2312
+ ],
2313
+ "gripper_width": 0.1,
2314
+ "target_object_id": "bedroom_desk_0",
2315
+ "target_object_pos": [
2316
+ 0.4171929379728138,
2317
+ 0.8307590011600697,
2318
+ 0.39957492597700656
2319
+ ],
2320
+ "timestamp": 4.95
2321
+ },
2322
+ {
2323
+ "step_id": 100,
2324
+ "phase": "transport",
2325
+ "end_effector_pos": [
2326
+ 0.397326607593156,
2327
+ 0.7911990487238759,
2328
+ 0.39957492597700656
2329
+ ],
2330
+ "end_effector_quat_wxyz": [
2331
+ 1,
2332
+ 0,
2333
+ 0,
2334
+ 0
2335
+ ],
2336
+ "gripper_width": 0.1,
2337
+ "target_object_id": "bedroom_desk_0",
2338
+ "target_object_pos": [
2339
+ 0.397326607593156,
2340
+ 0.7911990487238759,
2341
+ 0.39957492597700656
2342
+ ],
2343
+ "timestamp": 5.0
2344
+ },
2345
+ {
2346
+ "step_id": 101,
2347
+ "phase": "transport",
2348
+ "end_effector_pos": [
2349
+ 0.37746027721349823,
2350
+ 0.7516390962876821,
2351
+ 0.39957492597700656
2352
+ ],
2353
+ "end_effector_quat_wxyz": [
2354
+ 1,
2355
+ 0,
2356
+ 0,
2357
+ 0
2358
+ ],
2359
+ "gripper_width": 0.1,
2360
+ "target_object_id": "bedroom_desk_0",
2361
+ "target_object_pos": [
2362
+ 0.37746027721349823,
2363
+ 0.7516390962876821,
2364
+ 0.39957492597700656
2365
+ ],
2366
+ "timestamp": 5.05
2367
+ },
2368
+ {
2369
+ "step_id": 102,
2370
+ "phase": "transport",
2371
+ "end_effector_pos": [
2372
+ 0.3575939468338404,
2373
+ 0.7120791438514883,
2374
+ 0.39957492597700656
2375
+ ],
2376
+ "end_effector_quat_wxyz": [
2377
+ 1,
2378
+ 0,
2379
+ 0,
2380
+ 0
2381
+ ],
2382
+ "gripper_width": 0.1,
2383
+ "target_object_id": "bedroom_desk_0",
2384
+ "target_object_pos": [
2385
+ 0.3575939468338404,
2386
+ 0.7120791438514883,
2387
+ 0.39957492597700656
2388
+ ],
2389
+ "timestamp": 5.1
2390
+ },
2391
+ {
2392
+ "step_id": 103,
2393
+ "phase": "transport",
2394
+ "end_effector_pos": [
2395
+ 0.33772761645418264,
2396
+ 0.6725191914152946,
2397
+ 0.39957492597700656
2398
+ ],
2399
+ "end_effector_quat_wxyz": [
2400
+ 1,
2401
+ 0,
2402
+ 0,
2403
+ 0
2404
+ ],
2405
+ "gripper_width": 0.1,
2406
+ "target_object_id": "bedroom_desk_0",
2407
+ "target_object_pos": [
2408
+ 0.33772761645418264,
2409
+ 0.6725191914152946,
2410
+ 0.39957492597700656
2411
+ ],
2412
+ "timestamp": 5.15
2413
+ },
2414
+ {
2415
+ "step_id": 104,
2416
+ "phase": "transport",
2417
+ "end_effector_pos": [
2418
+ 0.31786128607452485,
2419
+ 0.6329592389791008,
2420
+ 0.39957492597700656
2421
+ ],
2422
+ "end_effector_quat_wxyz": [
2423
+ 1,
2424
+ 0,
2425
+ 0,
2426
+ 0
2427
+ ],
2428
+ "gripper_width": 0.1,
2429
+ "target_object_id": "bedroom_desk_0",
2430
+ "target_object_pos": [
2431
+ 0.31786128607452485,
2432
+ 0.6329592389791008,
2433
+ 0.39957492597700656
2434
+ ],
2435
+ "timestamp": 5.2
2436
+ },
2437
+ {
2438
+ "step_id": 105,
2439
+ "phase": "transport",
2440
+ "end_effector_pos": [
2441
+ 0.297994955694867,
2442
+ 0.593399286542907,
2443
+ 0.39957492597700656
2444
+ ],
2445
+ "end_effector_quat_wxyz": [
2446
+ 1,
2447
+ 0,
2448
+ 0,
2449
+ 0
2450
+ ],
2451
+ "gripper_width": 0.1,
2452
+ "target_object_id": "bedroom_desk_0",
2453
+ "target_object_pos": [
2454
+ 0.297994955694867,
2455
+ 0.593399286542907,
2456
+ 0.39957492597700656
2457
+ ],
2458
+ "timestamp": 5.25
2459
+ },
2460
+ {
2461
+ "step_id": 106,
2462
+ "phase": "transport",
2463
+ "end_effector_pos": [
2464
+ 0.2781286253152092,
2465
+ 0.5538393341067132,
2466
+ 0.39957492597700656
2467
+ ],
2468
+ "end_effector_quat_wxyz": [
2469
+ 1,
2470
+ 0,
2471
+ 0,
2472
+ 0
2473
+ ],
2474
+ "gripper_width": 0.1,
2475
+ "target_object_id": "bedroom_desk_0",
2476
+ "target_object_pos": [
2477
+ 0.2781286253152092,
2478
+ 0.5538393341067132,
2479
+ 0.39957492597700656
2480
+ ],
2481
+ "timestamp": 5.3
2482
+ },
2483
+ {
2484
+ "step_id": 107,
2485
+ "phase": "transport",
2486
+ "end_effector_pos": [
2487
+ 0.2582622949355514,
2488
+ 0.5142793816705193,
2489
+ 0.39957492597700656
2490
+ ],
2491
+ "end_effector_quat_wxyz": [
2492
+ 1,
2493
+ 0,
2494
+ 0,
2495
+ 0
2496
+ ],
2497
+ "gripper_width": 0.1,
2498
+ "target_object_id": "bedroom_desk_0",
2499
+ "target_object_pos": [
2500
+ 0.2582622949355514,
2501
+ 0.5142793816705193,
2502
+ 0.39957492597700656
2503
+ ],
2504
+ "timestamp": 5.35
2505
+ },
2506
+ {
2507
+ "step_id": 108,
2508
+ "phase": "transport",
2509
+ "end_effector_pos": [
2510
+ 0.23839596455589362,
2511
+ 0.47471942923432553,
2512
+ 0.39957492597700656
2513
+ ],
2514
+ "end_effector_quat_wxyz": [
2515
+ 1,
2516
+ 0,
2517
+ 0,
2518
+ 0
2519
+ ],
2520
+ "gripper_width": 0.1,
2521
+ "target_object_id": "bedroom_desk_0",
2522
+ "target_object_pos": [
2523
+ 0.23839596455589362,
2524
+ 0.47471942923432553,
2525
+ 0.39957492597700656
2526
+ ],
2527
+ "timestamp": 5.4
2528
+ },
2529
+ {
2530
+ "step_id": 109,
2531
+ "phase": "transport",
2532
+ "end_effector_pos": [
2533
+ 0.21852963417623583,
2534
+ 0.4351594767981317,
2535
+ 0.39957492597700656
2536
+ ],
2537
+ "end_effector_quat_wxyz": [
2538
+ 1,
2539
+ 0,
2540
+ 0,
2541
+ 0
2542
+ ],
2543
+ "gripper_width": 0.1,
2544
+ "target_object_id": "bedroom_desk_0",
2545
+ "target_object_pos": [
2546
+ 0.21852963417623583,
2547
+ 0.4351594767981317,
2548
+ 0.39957492597700656
2549
+ ],
2550
+ "timestamp": 5.45
2551
+ },
2552
+ {
2553
+ "step_id": 110,
2554
+ "phase": "transport",
2555
+ "end_effector_pos": [
2556
+ 0.19866330379657804,
2557
+ 0.3955995243619379,
2558
+ 0.39957492597700656
2559
+ ],
2560
+ "end_effector_quat_wxyz": [
2561
+ 1,
2562
+ 0,
2563
+ 0,
2564
+ 0
2565
+ ],
2566
+ "gripper_width": 0.1,
2567
+ "target_object_id": "bedroom_desk_0",
2568
+ "target_object_pos": [
2569
+ 0.19866330379657804,
2570
+ 0.3955995243619379,
2571
+ 0.39957492597700656
2572
+ ],
2573
+ "timestamp": 5.5
2574
+ },
2575
+ {
2576
+ "step_id": 111,
2577
+ "phase": "transport",
2578
+ "end_effector_pos": [
2579
+ 0.17879697341692025,
2580
+ 0.3560395719257441,
2581
+ 0.39957492597700656
2582
+ ],
2583
+ "end_effector_quat_wxyz": [
2584
+ 1,
2585
+ 0,
2586
+ 0,
2587
+ 0
2588
+ ],
2589
+ "gripper_width": 0.1,
2590
+ "target_object_id": "bedroom_desk_0",
2591
+ "target_object_pos": [
2592
+ 0.17879697341692025,
2593
+ 0.3560395719257441,
2594
+ 0.39957492597700656
2595
+ ],
2596
+ "timestamp": 5.55
2597
+ },
2598
+ {
2599
+ "step_id": 112,
2600
+ "phase": "transport",
2601
+ "end_effector_pos": [
2602
+ 0.15893064303726234,
2603
+ 0.3164796194895503,
2604
+ 0.39957492597700656
2605
+ ],
2606
+ "end_effector_quat_wxyz": [
2607
+ 1,
2608
+ 0,
2609
+ 0,
2610
+ 0
2611
+ ],
2612
+ "gripper_width": 0.1,
2613
+ "target_object_id": "bedroom_desk_0",
2614
+ "target_object_pos": [
2615
+ 0.15893064303726234,
2616
+ 0.3164796194895503,
2617
+ 0.39957492597700656
2618
+ ],
2619
+ "timestamp": 5.6
2620
+ },
2621
+ {
2622
+ "step_id": 113,
2623
+ "phase": "transport",
2624
+ "end_effector_pos": [
2625
+ 0.13906431265760466,
2626
+ 0.2769196670533567,
2627
+ 0.39957492597700656
2628
+ ],
2629
+ "end_effector_quat_wxyz": [
2630
+ 1,
2631
+ 0,
2632
+ 0,
2633
+ 0
2634
+ ],
2635
+ "gripper_width": 0.1,
2636
+ "target_object_id": "bedroom_desk_0",
2637
+ "target_object_pos": [
2638
+ 0.13906431265760466,
2639
+ 0.2769196670533567,
2640
+ 0.39957492597700656
2641
+ ],
2642
+ "timestamp": 5.65
2643
+ },
2644
+ {
2645
+ "step_id": 114,
2646
+ "phase": "transport",
2647
+ "end_effector_pos": [
2648
+ 0.11919798227794687,
2649
+ 0.23735971461716288,
2650
+ 0.39957492597700656
2651
+ ],
2652
+ "end_effector_quat_wxyz": [
2653
+ 1,
2654
+ 0,
2655
+ 0,
2656
+ 0
2657
+ ],
2658
+ "gripper_width": 0.1,
2659
+ "target_object_id": "bedroom_desk_0",
2660
+ "target_object_pos": [
2661
+ 0.11919798227794687,
2662
+ 0.23735971461716288,
2663
+ 0.39957492597700656
2664
+ ],
2665
+ "timestamp": 5.7
2666
+ },
2667
+ {
2668
+ "step_id": 115,
2669
+ "phase": "transport",
2670
+ "end_effector_pos": [
2671
+ 0.09933165189828896,
2672
+ 0.19779976218096906,
2673
+ 0.39957492597700656
2674
+ ],
2675
+ "end_effector_quat_wxyz": [
2676
+ 1,
2677
+ 0,
2678
+ 0,
2679
+ 0
2680
+ ],
2681
+ "gripper_width": 0.1,
2682
+ "target_object_id": "bedroom_desk_0",
2683
+ "target_object_pos": [
2684
+ 0.09933165189828896,
2685
+ 0.19779976218096906,
2686
+ 0.39957492597700656
2687
+ ],
2688
+ "timestamp": 5.75
2689
+ },
2690
+ {
2691
+ "step_id": 116,
2692
+ "phase": "transport",
2693
+ "end_effector_pos": [
2694
+ 0.07946532151863117,
2695
+ 0.15823980974477525,
2696
+ 0.39957492597700656
2697
+ ],
2698
+ "end_effector_quat_wxyz": [
2699
+ 1,
2700
+ 0,
2701
+ 0,
2702
+ 0
2703
+ ],
2704
+ "gripper_width": 0.1,
2705
+ "target_object_id": "bedroom_desk_0",
2706
+ "target_object_pos": [
2707
+ 0.07946532151863117,
2708
+ 0.15823980974477525,
2709
+ 0.39957492597700656
2710
+ ],
2711
+ "timestamp": 5.8
2712
+ },
2713
+ {
2714
+ "step_id": 117,
2715
+ "phase": "transport",
2716
+ "end_effector_pos": [
2717
+ 0.05959899113897338,
2718
+ 0.11867985730858122,
2719
+ 0.39957492597700656
2720
+ ],
2721
+ "end_effector_quat_wxyz": [
2722
+ 1,
2723
+ 0,
2724
+ 0,
2725
+ 0
2726
+ ],
2727
+ "gripper_width": 0.1,
2728
+ "target_object_id": "bedroom_desk_0",
2729
+ "target_object_pos": [
2730
+ 0.05959899113897338,
2731
+ 0.11867985730858122,
2732
+ 0.39957492597700656
2733
+ ],
2734
+ "timestamp": 5.85
2735
+ },
2736
+ {
2737
+ "step_id": 118,
2738
+ "phase": "transport",
2739
+ "end_effector_pos": [
2740
+ 0.039732660759315586,
2741
+ 0.07911990487238763,
2742
+ 0.39957492597700656
2743
+ ],
2744
+ "end_effector_quat_wxyz": [
2745
+ 1,
2746
+ 0,
2747
+ 0,
2748
+ 0
2749
+ ],
2750
+ "gripper_width": 0.1,
2751
+ "target_object_id": "bedroom_desk_0",
2752
+ "target_object_pos": [
2753
+ 0.039732660759315586,
2754
+ 0.07911990487238763,
2755
+ 0.39957492597700656
2756
+ ],
2757
+ "timestamp": 5.9
2758
+ },
2759
+ {
2760
+ "step_id": 119,
2761
+ "phase": "transport",
2762
+ "end_effector_pos": [
2763
+ 0.019866330379657793,
2764
+ 0.03955995243619381,
2765
+ 0.39957492597700656
2766
+ ],
2767
+ "end_effector_quat_wxyz": [
2768
+ 1,
2769
+ 0,
2770
+ 0,
2771
+ 0
2772
+ ],
2773
+ "gripper_width": 0.1,
2774
+ "target_object_id": "bedroom_desk_0",
2775
+ "target_object_pos": [
2776
+ 0.019866330379657793,
2777
+ 0.03955995243619381,
2778
+ 0.39957492597700656
2779
+ ],
2780
+ "timestamp": 5.95
2781
+ },
2782
+ {
2783
+ "step_id": 120,
2784
+ "phase": "place",
2785
+ "end_effector_pos": [
2786
+ 0.0,
2787
+ 0.0,
2788
+ 0.39957492597700656
2789
+ ],
2790
+ "end_effector_quat_wxyz": [
2791
+ 1,
2792
+ 0,
2793
+ 0,
2794
+ 0
2795
+ ],
2796
+ "gripper_width": 0.1,
2797
+ "target_object_id": "bedroom_desk_0",
2798
+ "target_object_pos": [
2799
+ 0.0,
2800
+ 0.0,
2801
+ 0.39957492597700656
2802
+ ],
2803
+ "timestamp": 6.0
2804
+ },
2805
+ {
2806
+ "step_id": 121,
2807
+ "phase": "place",
2808
+ "end_effector_pos": [
2809
+ 0.0,
2810
+ 0.0,
2811
+ 0.39057492597700655
2812
+ ],
2813
+ "end_effector_quat_wxyz": [
2814
+ 1,
2815
+ 0,
2816
+ 0,
2817
+ 0
2818
+ ],
2819
+ "gripper_width": 0.1,
2820
+ "target_object_id": "bedroom_desk_0",
2821
+ "target_object_pos": [
2822
+ 0.0,
2823
+ 0.0,
2824
+ 0.38457492597700654
2825
+ ],
2826
+ "timestamp": 6.05
2827
+ },
2828
+ {
2829
+ "step_id": 122,
2830
+ "phase": "place",
2831
+ "end_effector_pos": [
2832
+ 0.0,
2833
+ 0.0,
2834
+ 0.38157492597700654
2835
+ ],
2836
+ "end_effector_quat_wxyz": [
2837
+ 1,
2838
+ 0,
2839
+ 0,
2840
+ 0
2841
+ ],
2842
+ "gripper_width": 0.1,
2843
+ "target_object_id": "bedroom_desk_0",
2844
+ "target_object_pos": [
2845
+ 0.0,
2846
+ 0.0,
2847
+ 0.3695749259770066
2848
+ ],
2849
+ "timestamp": 6.1
2850
+ },
2851
+ {
2852
+ "step_id": 123,
2853
+ "phase": "place",
2854
+ "end_effector_pos": [
2855
+ 0.0,
2856
+ 0.0,
2857
+ 0.37257492597700653
2858
+ ],
2859
+ "end_effector_quat_wxyz": [
2860
+ 1,
2861
+ 0,
2862
+ 0,
2863
+ 0
2864
+ ],
2865
+ "gripper_width": 0.1,
2866
+ "target_object_id": "bedroom_desk_0",
2867
+ "target_object_pos": [
2868
+ 0.0,
2869
+ 0.0,
2870
+ 0.35457492597700657
2871
+ ],
2872
+ "timestamp": 6.15
2873
+ },
2874
+ {
2875
+ "step_id": 124,
2876
+ "phase": "place",
2877
+ "end_effector_pos": [
2878
+ 0.0,
2879
+ 0.0,
2880
+ 0.3635749259770066
2881
+ ],
2882
+ "end_effector_quat_wxyz": [
2883
+ 1,
2884
+ 0,
2885
+ 0,
2886
+ 0
2887
+ ],
2888
+ "gripper_width": 0.1,
2889
+ "target_object_id": "bedroom_desk_0",
2890
+ "target_object_pos": [
2891
+ 0.0,
2892
+ 0.0,
2893
+ 0.33957492597700656
2894
+ ],
2895
+ "timestamp": 6.2
2896
+ },
2897
+ {
2898
+ "step_id": 125,
2899
+ "phase": "place",
2900
+ "end_effector_pos": [
2901
+ 0.0,
2902
+ 0.0,
2903
+ 0.35457492597700657
2904
+ ],
2905
+ "end_effector_quat_wxyz": [
2906
+ 1,
2907
+ 0,
2908
+ 0,
2909
+ 0
2910
+ ],
2911
+ "gripper_width": 0.1,
2912
+ "target_object_id": "bedroom_desk_0",
2913
+ "target_object_pos": [
2914
+ 0.0,
2915
+ 0.0,
2916
+ 0.32457492597700655
2917
+ ],
2918
+ "timestamp": 6.25
2919
+ },
2920
+ {
2921
+ "step_id": 126,
2922
+ "phase": "place",
2923
+ "end_effector_pos": [
2924
+ 0.0,
2925
+ 0.0,
2926
+ 0.34557492597700656
2927
+ ],
2928
+ "end_effector_quat_wxyz": [
2929
+ 1,
2930
+ 0,
2931
+ 0,
2932
+ 0
2933
+ ],
2934
+ "gripper_width": 0.1,
2935
+ "target_object_id": "bedroom_desk_0",
2936
+ "target_object_pos": [
2937
+ 0.0,
2938
+ 0.0,
2939
+ 0.30957492597700653
2940
+ ],
2941
+ "timestamp": 6.3
2942
+ },
2943
+ {
2944
+ "step_id": 127,
2945
+ "phase": "place",
2946
+ "end_effector_pos": [
2947
+ 0.0,
2948
+ 0.0,
2949
+ 0.33657492597700656
2950
+ ],
2951
+ "end_effector_quat_wxyz": [
2952
+ 1,
2953
+ 0,
2954
+ 0,
2955
+ 0
2956
+ ],
2957
+ "gripper_width": 0.1,
2958
+ "target_object_id": "bedroom_desk_0",
2959
+ "target_object_pos": [
2960
+ 0.0,
2961
+ 0.0,
2962
+ 0.2945749259770066
2963
+ ],
2964
+ "timestamp": 6.35
2965
+ },
2966
+ {
2967
+ "step_id": 128,
2968
+ "phase": "place",
2969
+ "end_effector_pos": [
2970
+ 0.0,
2971
+ 0.0,
2972
+ 0.32757492597700655
2973
+ ],
2974
+ "end_effector_quat_wxyz": [
2975
+ 1,
2976
+ 0,
2977
+ 0,
2978
+ 0
2979
+ ],
2980
+ "gripper_width": 0.1,
2981
+ "target_object_id": "bedroom_desk_0",
2982
+ "target_object_pos": [
2983
+ 0.0,
2984
+ 0.0,
2985
+ 0.27957492597700656
2986
+ ],
2987
+ "timestamp": 6.4
2988
+ },
2989
+ {
2990
+ "step_id": 129,
2991
+ "phase": "place",
2992
+ "end_effector_pos": [
2993
+ 0.0,
2994
+ 0.0,
2995
+ 0.31857492597700654
2996
+ ],
2997
+ "end_effector_quat_wxyz": [
2998
+ 1,
2999
+ 0,
3000
+ 0,
3001
+ 0
3002
+ ],
3003
+ "gripper_width": 0.1,
3004
+ "target_object_id": "bedroom_desk_0",
3005
+ "target_object_pos": [
3006
+ 0.0,
3007
+ 0.0,
3008
+ 0.26457492597700655
3009
+ ],
3010
+ "timestamp": 6.45
3011
+ },
3012
+ {
3013
+ "step_id": 130,
3014
+ "phase": "place",
3015
+ "end_effector_pos": [
3016
+ 0.0,
3017
+ 0.0,
3018
+ 0.30957492597700653
3019
+ ],
3020
+ "end_effector_quat_wxyz": [
3021
+ 1,
3022
+ 0,
3023
+ 0,
3024
+ 0
3025
+ ],
3026
+ "gripper_width": 0.1,
3027
+ "target_object_id": "bedroom_desk_0",
3028
+ "target_object_pos": [
3029
+ 0.0,
3030
+ 0.0,
3031
+ 0.24957492597700656
3032
+ ],
3033
+ "timestamp": 6.5
3034
+ },
3035
+ {
3036
+ "step_id": 131,
3037
+ "phase": "place",
3038
+ "end_effector_pos": [
3039
+ 0.0,
3040
+ 0.0,
3041
+ 0.3005749259770065
3042
+ ],
3043
+ "end_effector_quat_wxyz": [
3044
+ 1,
3045
+ 0,
3046
+ 0,
3047
+ 0
3048
+ ],
3049
+ "gripper_width": 0.1,
3050
+ "target_object_id": "bedroom_desk_0",
3051
+ "target_object_pos": [
3052
+ 0.0,
3053
+ 0.0,
3054
+ 0.23457492597700655
3055
+ ],
3056
+ "timestamp": 6.55
3057
+ },
3058
+ {
3059
+ "step_id": 132,
3060
+ "phase": "place",
3061
+ "end_effector_pos": [
3062
+ 0.0,
3063
+ 0.0,
3064
+ 0.29157492597700657
3065
+ ],
3066
+ "end_effector_quat_wxyz": [
3067
+ 1,
3068
+ 0,
3069
+ 0,
3070
+ 0
3071
+ ],
3072
+ "gripper_width": 0.1,
3073
+ "target_object_id": "bedroom_desk_0",
3074
+ "target_object_pos": [
3075
+ 0.0,
3076
+ 0.0,
3077
+ 0.21957492597700656
3078
+ ],
3079
+ "timestamp": 6.6
3080
+ },
3081
+ {
3082
+ "step_id": 133,
3083
+ "phase": "place",
3084
+ "end_effector_pos": [
3085
+ 0.0,
3086
+ 0.0,
3087
+ 0.28257492597700656
3088
+ ],
3089
+ "end_effector_quat_wxyz": [
3090
+ 1,
3091
+ 0,
3092
+ 0,
3093
+ 0
3094
+ ],
3095
+ "gripper_width": 0.1,
3096
+ "target_object_id": "bedroom_desk_0",
3097
+ "target_object_pos": [
3098
+ 0.0,
3099
+ 0.0,
3100
+ 0.20457492597700655
3101
+ ],
3102
+ "timestamp": 6.65
3103
+ },
3104
+ {
3105
+ "step_id": 134,
3106
+ "phase": "place",
3107
+ "end_effector_pos": [
3108
+ 0.0,
3109
+ 0.0,
3110
+ 0.27357492597700656
3111
+ ],
3112
+ "end_effector_quat_wxyz": [
3113
+ 1,
3114
+ 0,
3115
+ 0,
3116
+ 0
3117
+ ],
3118
+ "gripper_width": 0.1,
3119
+ "target_object_id": "bedroom_desk_0",
3120
+ "target_object_pos": [
3121
+ 0.0,
3122
+ 0.0,
3123
+ 0.18957492597700656
3124
+ ],
3125
+ "timestamp": 6.7
3126
+ },
3127
+ {
3128
+ "step_id": 135,
3129
+ "phase": "place",
3130
+ "end_effector_pos": [
3131
+ 0.0,
3132
+ 0.0,
3133
+ 0.26457492597700655
3134
+ ],
3135
+ "end_effector_quat_wxyz": [
3136
+ 1,
3137
+ 0,
3138
+ 0,
3139
+ 0
3140
+ ],
3141
+ "gripper_width": 0.1,
3142
+ "target_object_id": "bedroom_desk_0",
3143
+ "target_object_pos": [
3144
+ 0.0,
3145
+ 0.0,
3146
+ 0.17457492597700658
3147
+ ],
3148
+ "timestamp": 6.75
3149
+ },
3150
+ {
3151
+ "step_id": 136,
3152
+ "phase": "place",
3153
+ "end_effector_pos": [
3154
+ 0.0,
3155
+ 0.0,
3156
+ 0.2555749259770066
3157
+ ],
3158
+ "end_effector_quat_wxyz": [
3159
+ 1,
3160
+ 0,
3161
+ 0,
3162
+ 0
3163
+ ],
3164
+ "gripper_width": 0.1,
3165
+ "target_object_id": "bedroom_desk_0",
3166
+ "target_object_pos": [
3167
+ 0.0,
3168
+ 0.0,
3169
+ 0.15957492597700657
3170
+ ],
3171
+ "timestamp": 6.8
3172
+ },
3173
+ {
3174
+ "step_id": 137,
3175
+ "phase": "place",
3176
+ "end_effector_pos": [
3177
+ 0.0,
3178
+ 0.0,
3179
+ 0.24657492597700656
3180
+ ],
3181
+ "end_effector_quat_wxyz": [
3182
+ 1,
3183
+ 0,
3184
+ 0,
3185
+ 0
3186
+ ],
3187
+ "gripper_width": 0.1,
3188
+ "target_object_id": "bedroom_desk_0",
3189
+ "target_object_pos": [
3190
+ 0.0,
3191
+ 0.0,
3192
+ 0.14457492597700655
3193
+ ],
3194
+ "timestamp": 6.85
3195
+ },
3196
+ {
3197
+ "step_id": 138,
3198
+ "phase": "place",
3199
+ "end_effector_pos": [
3200
+ 0.0,
3201
+ 0.0,
3202
+ 0.23757492597700655
3203
+ ],
3204
+ "end_effector_quat_wxyz": [
3205
+ 1,
3206
+ 0,
3207
+ 0,
3208
+ 0
3209
+ ],
3210
+ "gripper_width": 0.1,
3211
+ "target_object_id": "bedroom_desk_0",
3212
+ "target_object_pos": [
3213
+ 0.0,
3214
+ 0.0,
3215
+ 0.12957492597700654
3216
+ ],
3217
+ "timestamp": 6.9
3218
+ },
3219
+ {
3220
+ "step_id": 139,
3221
+ "phase": "place",
3222
+ "end_effector_pos": [
3223
+ 0.0,
3224
+ 0.0,
3225
+ 0.22857492597700657
3226
+ ],
3227
+ "end_effector_quat_wxyz": [
3228
+ 1,
3229
+ 0,
3230
+ 0,
3231
+ 0
3232
+ ],
3233
+ "gripper_width": 0.1,
3234
+ "target_object_id": "bedroom_desk_0",
3235
+ "target_object_pos": [
3236
+ 0.0,
3237
+ 0.0,
3238
+ 0.11457492597700658
3239
+ ],
3240
+ "timestamp": 6.95
3241
+ },
3242
+ {
3243
+ "step_id": 140,
3244
+ "phase": "release",
3245
+ "end_effector_pos": [
3246
+ 0.0,
3247
+ 0.0,
3248
+ 0.21957492597700656
3249
+ ],
3250
+ "end_effector_quat_wxyz": [
3251
+ 1,
3252
+ 0,
3253
+ 0,
3254
+ 0
3255
+ ],
3256
+ "gripper_width": 0.0,
3257
+ "target_object_id": "bedroom_desk_0",
3258
+ "target_object_pos": [
3259
+ 0.0,
3260
+ 0.0,
3261
+ 0.09957492597700657
3262
+ ],
3263
+ "timestamp": 7.0
3264
+ },
3265
+ {
3266
+ "step_id": 141,
3267
+ "phase": "release",
3268
+ "end_effector_pos": [
3269
+ 0.0,
3270
+ 0.0,
3271
+ 0.21957492597700656
3272
+ ],
3273
+ "end_effector_quat_wxyz": [
3274
+ 1,
3275
+ 0,
3276
+ 0,
3277
+ 0
3278
+ ],
3279
+ "gripper_width": 0.1,
3280
+ "target_object_id": "bedroom_desk_0",
3281
+ "target_object_pos": [
3282
+ 0.0,
3283
+ 0.0,
3284
+ 0.09957492597700657
3285
+ ],
3286
+ "timestamp": 7.05
3287
+ },
3288
+ {
3289
+ "step_id": 142,
3290
+ "phase": "release",
3291
+ "end_effector_pos": [
3292
+ 0.0,
3293
+ 0.0,
3294
+ 0.21957492597700656
3295
+ ],
3296
+ "end_effector_quat_wxyz": [
3297
+ 1,
3298
+ 0,
3299
+ 0,
3300
+ 0
3301
+ ],
3302
+ "gripper_width": 0.2,
3303
+ "target_object_id": "bedroom_desk_0",
3304
+ "target_object_pos": [
3305
+ 0.0,
3306
+ 0.0,
3307
+ 0.09957492597700657
3308
+ ],
3309
+ "timestamp": 7.1
3310
+ },
3311
+ {
3312
+ "step_id": 143,
3313
+ "phase": "release",
3314
+ "end_effector_pos": [
3315
+ 0.0,
3316
+ 0.0,
3317
+ 0.21957492597700656
3318
+ ],
3319
+ "end_effector_quat_wxyz": [
3320
+ 1,
3321
+ 0,
3322
+ 0,
3323
+ 0
3324
+ ],
3325
+ "gripper_width": 0.3,
3326
+ "target_object_id": "bedroom_desk_0",
3327
+ "target_object_pos": [
3328
+ 0.0,
3329
+ 0.0,
3330
+ 0.09957492597700657
3331
+ ],
3332
+ "timestamp": 7.15
3333
+ },
3334
+ {
3335
+ "step_id": 144,
3336
+ "phase": "release",
3337
+ "end_effector_pos": [
3338
+ 0.0,
3339
+ 0.0,
3340
+ 0.21957492597700656
3341
+ ],
3342
+ "end_effector_quat_wxyz": [
3343
+ 1,
3344
+ 0,
3345
+ 0,
3346
+ 0
3347
+ ],
3348
+ "gripper_width": 0.4,
3349
+ "target_object_id": "bedroom_desk_0",
3350
+ "target_object_pos": [
3351
+ 0.0,
3352
+ 0.0,
3353
+ 0.09957492597700657
3354
+ ],
3355
+ "timestamp": 7.2
3356
+ },
3357
+ {
3358
+ "step_id": 145,
3359
+ "phase": "release",
3360
+ "end_effector_pos": [
3361
+ 0.0,
3362
+ 0.0,
3363
+ 0.21957492597700656
3364
+ ],
3365
+ "end_effector_quat_wxyz": [
3366
+ 1,
3367
+ 0,
3368
+ 0,
3369
+ 0
3370
+ ],
3371
+ "gripper_width": 0.5,
3372
+ "target_object_id": "bedroom_desk_0",
3373
+ "target_object_pos": [
3374
+ 0.0,
3375
+ 0.0,
3376
+ 0.09957492597700657
3377
+ ],
3378
+ "timestamp": 7.25
3379
+ },
3380
+ {
3381
+ "step_id": 146,
3382
+ "phase": "release",
3383
+ "end_effector_pos": [
3384
+ 0.0,
3385
+ 0.0,
3386
+ 0.21957492597700656
3387
+ ],
3388
+ "end_effector_quat_wxyz": [
3389
+ 1,
3390
+ 0,
3391
+ 0,
3392
+ 0
3393
+ ],
3394
+ "gripper_width": 0.6,
3395
+ "target_object_id": "bedroom_desk_0",
3396
+ "target_object_pos": [
3397
+ 0.0,
3398
+ 0.0,
3399
+ 0.09957492597700657
3400
+ ],
3401
+ "timestamp": 7.3
3402
+ },
3403
+ {
3404
+ "step_id": 147,
3405
+ "phase": "release",
3406
+ "end_effector_pos": [
3407
+ 0.0,
3408
+ 0.0,
3409
+ 0.21957492597700656
3410
+ ],
3411
+ "end_effector_quat_wxyz": [
3412
+ 1,
3413
+ 0,
3414
+ 0,
3415
+ 0
3416
+ ],
3417
+ "gripper_width": 0.7,
3418
+ "target_object_id": "bedroom_desk_0",
3419
+ "target_object_pos": [
3420
+ 0.0,
3421
+ 0.0,
3422
+ 0.09957492597700657
3423
+ ],
3424
+ "timestamp": 7.35
3425
+ },
3426
+ {
3427
+ "step_id": 148,
3428
+ "phase": "release",
3429
+ "end_effector_pos": [
3430
+ 0.0,
3431
+ 0.0,
3432
+ 0.21957492597700656
3433
+ ],
3434
+ "end_effector_quat_wxyz": [
3435
+ 1,
3436
+ 0,
3437
+ 0,
3438
+ 0
3439
+ ],
3440
+ "gripper_width": 0.8,
3441
+ "target_object_id": "bedroom_desk_0",
3442
+ "target_object_pos": [
3443
+ 0.0,
3444
+ 0.0,
3445
+ 0.09957492597700657
3446
+ ],
3447
+ "timestamp": 7.4
3448
+ },
3449
+ {
3450
+ "step_id": 149,
3451
+ "phase": "release",
3452
+ "end_effector_pos": [
3453
+ 0.0,
3454
+ 0.0,
3455
+ 0.21957492597700656
3456
+ ],
3457
+ "end_effector_quat_wxyz": [
3458
+ 1,
3459
+ 0,
3460
+ 0,
3461
+ 0
3462
+ ],
3463
+ "gripper_width": 0.9,
3464
+ "target_object_id": "bedroom_desk_0",
3465
+ "target_object_pos": [
3466
+ 0.0,
3467
+ 0.0,
3468
+ 0.09957492597700657
3469
+ ],
3470
+ "timestamp": 7.45
3471
+ }
3472
+ ]
3473
+ }
demos/demo_bedroom_nightstand_to_desk_trajectory.png ADDED

Git LFS Details

  • SHA256: f1abd641c7e3c90c33d91562bcee17283dd49f0e06b0821459da931bb3544145
  • Pointer size: 131 Bytes
  • Size of remote file: 250 kB
demos/demo_bedroom_wardrobe_to_desk.json ADDED
@@ -0,0 +1,3473 @@
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
+ {
2
+ "task": "Move an item near the wardrobe to the desk",
3
+ "scene_id": "bedroom_wardrobe_to_desk",
4
+ "target_object": "bedroom_desk_0",
5
+ "initial_pos": [
6
+ 0.794653215186312,
7
+ 1.5823980974477518,
8
+ -0.000425074022993442
9
+ ],
10
+ "goal_pos": [
11
+ 0.0,
12
+ 0.0,
13
+ 0.09957492597700657
14
+ ],
15
+ "goal_reference": "table",
16
+ "success": true,
17
+ "total_duration_s": 7.5,
18
+ "num_steps": 150,
19
+ "policy_interface": {},
20
+ "confidence": 0.5,
21
+ "trajectory": [
22
+ {
23
+ "step_id": 0,
24
+ "phase": "approach",
25
+ "end_effector_pos": [
26
+ 0.0,
27
+ 0.0,
28
+ 0.8
29
+ ],
30
+ "end_effector_quat_wxyz": [
31
+ 1,
32
+ 0,
33
+ 0,
34
+ 0
35
+ ],
36
+ "gripper_width": 1.0,
37
+ "target_object_id": "bedroom_desk_0",
38
+ "target_object_pos": [
39
+ 0.794653215186312,
40
+ 1.5823980974477518,
41
+ -0.000425074022993442
42
+ ],
43
+ "timestamp": 0.0
44
+ },
45
+ {
46
+ "step_id": 1,
47
+ "phase": "approach",
48
+ "end_effector_pos": [
49
+ 0.026488440506210402,
50
+ 0.052746603248258396,
51
+ 0.7866524975325669
52
+ ],
53
+ "end_effector_quat_wxyz": [
54
+ 1,
55
+ 0,
56
+ 0,
57
+ 0
58
+ ],
59
+ "gripper_width": 1.0,
60
+ "target_object_id": "bedroom_desk_0",
61
+ "target_object_pos": [
62
+ 0.794653215186312,
63
+ 1.5823980974477518,
64
+ -0.000425074022993442
65
+ ],
66
+ "timestamp": 0.05
67
+ },
68
+ {
69
+ "step_id": 2,
70
+ "phase": "approach",
71
+ "end_effector_pos": [
72
+ 0.052976881012420804,
73
+ 0.10549320649651679,
74
+ 0.7733049950651338
75
+ ],
76
+ "end_effector_quat_wxyz": [
77
+ 1,
78
+ 0,
79
+ 0,
80
+ 0
81
+ ],
82
+ "gripper_width": 1.0,
83
+ "target_object_id": "bedroom_desk_0",
84
+ "target_object_pos": [
85
+ 0.794653215186312,
86
+ 1.5823980974477518,
87
+ -0.000425074022993442
88
+ ],
89
+ "timestamp": 0.1
90
+ },
91
+ {
92
+ "step_id": 3,
93
+ "phase": "approach",
94
+ "end_effector_pos": [
95
+ 0.07946532151863121,
96
+ 0.1582398097447752,
97
+ 0.7599574925977007
98
+ ],
99
+ "end_effector_quat_wxyz": [
100
+ 1,
101
+ 0,
102
+ 0,
103
+ 0
104
+ ],
105
+ "gripper_width": 1.0,
106
+ "target_object_id": "bedroom_desk_0",
107
+ "target_object_pos": [
108
+ 0.794653215186312,
109
+ 1.5823980974477518,
110
+ -0.000425074022993442
111
+ ],
112
+ "timestamp": 0.15
113
+ },
114
+ {
115
+ "step_id": 4,
116
+ "phase": "approach",
117
+ "end_effector_pos": [
118
+ 0.10595376202484161,
119
+ 0.21098641299303358,
120
+ 0.7466099901302676
121
+ ],
122
+ "end_effector_quat_wxyz": [
123
+ 1,
124
+ 0,
125
+ 0,
126
+ 0
127
+ ],
128
+ "gripper_width": 1.0,
129
+ "target_object_id": "bedroom_desk_0",
130
+ "target_object_pos": [
131
+ 0.794653215186312,
132
+ 1.5823980974477518,
133
+ -0.000425074022993442
134
+ ],
135
+ "timestamp": 0.2
136
+ },
137
+ {
138
+ "step_id": 5,
139
+ "phase": "approach",
140
+ "end_effector_pos": [
141
+ 0.132442202531052,
142
+ 0.263733016241292,
143
+ 0.7332624876628344
144
+ ],
145
+ "end_effector_quat_wxyz": [
146
+ 1,
147
+ 0,
148
+ 0,
149
+ 0
150
+ ],
151
+ "gripper_width": 1.0,
152
+ "target_object_id": "bedroom_desk_0",
153
+ "target_object_pos": [
154
+ 0.794653215186312,
155
+ 1.5823980974477518,
156
+ -0.000425074022993442
157
+ ],
158
+ "timestamp": 0.25
159
+ },
160
+ {
161
+ "step_id": 6,
162
+ "phase": "approach",
163
+ "end_effector_pos": [
164
+ 0.15893064303726243,
165
+ 0.3164796194895504,
166
+ 0.7199149851954013
167
+ ],
168
+ "end_effector_quat_wxyz": [
169
+ 1,
170
+ 0,
171
+ 0,
172
+ 0
173
+ ],
174
+ "gripper_width": 1.0,
175
+ "target_object_id": "bedroom_desk_0",
176
+ "target_object_pos": [
177
+ 0.794653215186312,
178
+ 1.5823980974477518,
179
+ -0.000425074022993442
180
+ ],
181
+ "timestamp": 0.3
182
+ },
183
+ {
184
+ "step_id": 7,
185
+ "phase": "approach",
186
+ "end_effector_pos": [
187
+ 0.1854190835434728,
188
+ 0.36922622273780875,
189
+ 0.7065674827279682
190
+ ],
191
+ "end_effector_quat_wxyz": [
192
+ 1,
193
+ 0,
194
+ 0,
195
+ 0
196
+ ],
197
+ "gripper_width": 1.0,
198
+ "target_object_id": "bedroom_desk_0",
199
+ "target_object_pos": [
200
+ 0.794653215186312,
201
+ 1.5823980974477518,
202
+ -0.000425074022993442
203
+ ],
204
+ "timestamp": 0.35
205
+ },
206
+ {
207
+ "step_id": 8,
208
+ "phase": "approach",
209
+ "end_effector_pos": [
210
+ 0.21190752404968322,
211
+ 0.42197282598606717,
212
+ 0.6932199802605351
213
+ ],
214
+ "end_effector_quat_wxyz": [
215
+ 1,
216
+ 0,
217
+ 0,
218
+ 0
219
+ ],
220
+ "gripper_width": 1.0,
221
+ "target_object_id": "bedroom_desk_0",
222
+ "target_object_pos": [
223
+ 0.794653215186312,
224
+ 1.5823980974477518,
225
+ -0.000425074022993442
226
+ ],
227
+ "timestamp": 0.4
228
+ },
229
+ {
230
+ "step_id": 9,
231
+ "phase": "approach",
232
+ "end_effector_pos": [
233
+ 0.2383959645558936,
234
+ 0.47471942923432553,
235
+ 0.679872477793102
236
+ ],
237
+ "end_effector_quat_wxyz": [
238
+ 1,
239
+ 0,
240
+ 0,
241
+ 0
242
+ ],
243
+ "gripper_width": 1.0,
244
+ "target_object_id": "bedroom_desk_0",
245
+ "target_object_pos": [
246
+ 0.794653215186312,
247
+ 1.5823980974477518,
248
+ -0.000425074022993442
249
+ ],
250
+ "timestamp": 0.45
251
+ },
252
+ {
253
+ "step_id": 10,
254
+ "phase": "approach",
255
+ "end_effector_pos": [
256
+ 0.264884405062104,
257
+ 0.527466032482584,
258
+ 0.6665249753256689
259
+ ],
260
+ "end_effector_quat_wxyz": [
261
+ 1,
262
+ 0,
263
+ 0,
264
+ 0
265
+ ],
266
+ "gripper_width": 1.0,
267
+ "target_object_id": "bedroom_desk_0",
268
+ "target_object_pos": [
269
+ 0.794653215186312,
270
+ 1.5823980974477518,
271
+ -0.000425074022993442
272
+ ],
273
+ "timestamp": 0.5
274
+ },
275
+ {
276
+ "step_id": 11,
277
+ "phase": "approach",
278
+ "end_effector_pos": [
279
+ 0.2913728455683144,
280
+ 0.5802126357308423,
281
+ 0.6531774728582358
282
+ ],
283
+ "end_effector_quat_wxyz": [
284
+ 1,
285
+ 0,
286
+ 0,
287
+ 0
288
+ ],
289
+ "gripper_width": 1.0,
290
+ "target_object_id": "bedroom_desk_0",
291
+ "target_object_pos": [
292
+ 0.794653215186312,
293
+ 1.5823980974477518,
294
+ -0.000425074022993442
295
+ ],
296
+ "timestamp": 0.55
297
+ },
298
+ {
299
+ "step_id": 12,
300
+ "phase": "approach",
301
+ "end_effector_pos": [
302
+ 0.31786128607452485,
303
+ 0.6329592389791008,
304
+ 0.6398299703908026
305
+ ],
306
+ "end_effector_quat_wxyz": [
307
+ 1,
308
+ 0,
309
+ 0,
310
+ 0
311
+ ],
312
+ "gripper_width": 1.0,
313
+ "target_object_id": "bedroom_desk_0",
314
+ "target_object_pos": [
315
+ 0.794653215186312,
316
+ 1.5823980974477518,
317
+ -0.000425074022993442
318
+ ],
319
+ "timestamp": 0.6
320
+ },
321
+ {
322
+ "step_id": 13,
323
+ "phase": "approach",
324
+ "end_effector_pos": [
325
+ 0.3443497265807352,
326
+ 0.6857058422273592,
327
+ 0.6264824679233696
328
+ ],
329
+ "end_effector_quat_wxyz": [
330
+ 1,
331
+ 0,
332
+ 0,
333
+ 0
334
+ ],
335
+ "gripper_width": 1.0,
336
+ "target_object_id": "bedroom_desk_0",
337
+ "target_object_pos": [
338
+ 0.794653215186312,
339
+ 1.5823980974477518,
340
+ -0.000425074022993442
341
+ ],
342
+ "timestamp": 0.65
343
+ },
344
+ {
345
+ "step_id": 14,
346
+ "phase": "approach",
347
+ "end_effector_pos": [
348
+ 0.3708381670869456,
349
+ 0.7384524454756175,
350
+ 0.6131349654559364
351
+ ],
352
+ "end_effector_quat_wxyz": [
353
+ 1,
354
+ 0,
355
+ 0,
356
+ 0
357
+ ],
358
+ "gripper_width": 1.0,
359
+ "target_object_id": "bedroom_desk_0",
360
+ "target_object_pos": [
361
+ 0.794653215186312,
362
+ 1.5823980974477518,
363
+ -0.000425074022993442
364
+ ],
365
+ "timestamp": 0.7
366
+ },
367
+ {
368
+ "step_id": 15,
369
+ "phase": "approach",
370
+ "end_effector_pos": [
371
+ 0.397326607593156,
372
+ 0.7911990487238759,
373
+ 0.5997874629885033
374
+ ],
375
+ "end_effector_quat_wxyz": [
376
+ 1,
377
+ 0,
378
+ 0,
379
+ 0
380
+ ],
381
+ "gripper_width": 1.0,
382
+ "target_object_id": "bedroom_desk_0",
383
+ "target_object_pos": [
384
+ 0.794653215186312,
385
+ 1.5823980974477518,
386
+ -0.000425074022993442
387
+ ],
388
+ "timestamp": 0.75
389
+ },
390
+ {
391
+ "step_id": 16,
392
+ "phase": "approach",
393
+ "end_effector_pos": [
394
+ 0.42381504809936643,
395
+ 0.8439456519721343,
396
+ 0.5864399605210702
397
+ ],
398
+ "end_effector_quat_wxyz": [
399
+ 1,
400
+ 0,
401
+ 0,
402
+ 0
403
+ ],
404
+ "gripper_width": 1.0,
405
+ "target_object_id": "bedroom_desk_0",
406
+ "target_object_pos": [
407
+ 0.794653215186312,
408
+ 1.5823980974477518,
409
+ -0.000425074022993442
410
+ ],
411
+ "timestamp": 0.8
412
+ },
413
+ {
414
+ "step_id": 17,
415
+ "phase": "approach",
416
+ "end_effector_pos": [
417
+ 0.45030348860557684,
418
+ 0.8966922552203926,
419
+ 0.5730924580536371
420
+ ],
421
+ "end_effector_quat_wxyz": [
422
+ 1,
423
+ 0,
424
+ 0,
425
+ 0
426
+ ],
427
+ "gripper_width": 1.0,
428
+ "target_object_id": "bedroom_desk_0",
429
+ "target_object_pos": [
430
+ 0.794653215186312,
431
+ 1.5823980974477518,
432
+ -0.000425074022993442
433
+ ],
434
+ "timestamp": 0.85
435
+ },
436
+ {
437
+ "step_id": 18,
438
+ "phase": "approach",
439
+ "end_effector_pos": [
440
+ 0.4767919291117872,
441
+ 0.9494388584686511,
442
+ 0.559744955586204
443
+ ],
444
+ "end_effector_quat_wxyz": [
445
+ 1,
446
+ 0,
447
+ 0,
448
+ 0
449
+ ],
450
+ "gripper_width": 1.0,
451
+ "target_object_id": "bedroom_desk_0",
452
+ "target_object_pos": [
453
+ 0.794653215186312,
454
+ 1.5823980974477518,
455
+ -0.000425074022993442
456
+ ],
457
+ "timestamp": 0.9
458
+ },
459
+ {
460
+ "step_id": 19,
461
+ "phase": "approach",
462
+ "end_effector_pos": [
463
+ 0.5032803696179976,
464
+ 1.0021854617169095,
465
+ 0.5463974531187709
466
+ ],
467
+ "end_effector_quat_wxyz": [
468
+ 1,
469
+ 0,
470
+ 0,
471
+ 0
472
+ ],
473
+ "gripper_width": 1.0,
474
+ "target_object_id": "bedroom_desk_0",
475
+ "target_object_pos": [
476
+ 0.794653215186312,
477
+ 1.5823980974477518,
478
+ -0.000425074022993442
479
+ ],
480
+ "timestamp": 0.95
481
+ },
482
+ {
483
+ "step_id": 20,
484
+ "phase": "approach",
485
+ "end_effector_pos": [
486
+ 0.529768810124208,
487
+ 1.054932064965168,
488
+ 0.5330499506513378
489
+ ],
490
+ "end_effector_quat_wxyz": [
491
+ 1,
492
+ 0,
493
+ 0,
494
+ 0
495
+ ],
496
+ "gripper_width": 1.0,
497
+ "target_object_id": "bedroom_desk_0",
498
+ "target_object_pos": [
499
+ 0.794653215186312,
500
+ 1.5823980974477518,
501
+ -0.000425074022993442
502
+ ],
503
+ "timestamp": 1.0
504
+ },
505
+ {
506
+ "step_id": 21,
507
+ "phase": "approach",
508
+ "end_effector_pos": [
509
+ 0.5562572506304184,
510
+ 1.1076786682134263,
511
+ 0.5197024481839045
512
+ ],
513
+ "end_effector_quat_wxyz": [
514
+ 1,
515
+ 0,
516
+ 0,
517
+ 0
518
+ ],
519
+ "gripper_width": 1.0,
520
+ "target_object_id": "bedroom_desk_0",
521
+ "target_object_pos": [
522
+ 0.794653215186312,
523
+ 1.5823980974477518,
524
+ -0.000425074022993442
525
+ ],
526
+ "timestamp": 1.05
527
+ },
528
+ {
529
+ "step_id": 22,
530
+ "phase": "approach",
531
+ "end_effector_pos": [
532
+ 0.5827456911366288,
533
+ 1.1604252714616845,
534
+ 0.5063549457164715
535
+ ],
536
+ "end_effector_quat_wxyz": [
537
+ 1,
538
+ 0,
539
+ 0,
540
+ 0
541
+ ],
542
+ "gripper_width": 1.0,
543
+ "target_object_id": "bedroom_desk_0",
544
+ "target_object_pos": [
545
+ 0.794653215186312,
546
+ 1.5823980974477518,
547
+ -0.000425074022993442
548
+ ],
549
+ "timestamp": 1.1
550
+ },
551
+ {
552
+ "step_id": 23,
553
+ "phase": "approach",
554
+ "end_effector_pos": [
555
+ 0.6092341316428392,
556
+ 1.2131718747099431,
557
+ 0.49300744324903834
558
+ ],
559
+ "end_effector_quat_wxyz": [
560
+ 1,
561
+ 0,
562
+ 0,
563
+ 0
564
+ ],
565
+ "gripper_width": 1.0,
566
+ "target_object_id": "bedroom_desk_0",
567
+ "target_object_pos": [
568
+ 0.794653215186312,
569
+ 1.5823980974477518,
570
+ -0.000425074022993442
571
+ ],
572
+ "timestamp": 1.15
573
+ },
574
+ {
575
+ "step_id": 24,
576
+ "phase": "approach",
577
+ "end_effector_pos": [
578
+ 0.6357225721490497,
579
+ 1.2659184779582016,
580
+ 0.47965994078160523
581
+ ],
582
+ "end_effector_quat_wxyz": [
583
+ 1,
584
+ 0,
585
+ 0,
586
+ 0
587
+ ],
588
+ "gripper_width": 1.0,
589
+ "target_object_id": "bedroom_desk_0",
590
+ "target_object_pos": [
591
+ 0.794653215186312,
592
+ 1.5823980974477518,
593
+ -0.000425074022993442
594
+ ],
595
+ "timestamp": 1.2
596
+ },
597
+ {
598
+ "step_id": 25,
599
+ "phase": "approach",
600
+ "end_effector_pos": [
601
+ 0.6622110126552601,
602
+ 1.31866508120646,
603
+ 0.46631243831417213
604
+ ],
605
+ "end_effector_quat_wxyz": [
606
+ 1,
607
+ 0,
608
+ 0,
609
+ 0
610
+ ],
611
+ "gripper_width": 1.0,
612
+ "target_object_id": "bedroom_desk_0",
613
+ "target_object_pos": [
614
+ 0.794653215186312,
615
+ 1.5823980974477518,
616
+ -0.000425074022993442
617
+ ],
618
+ "timestamp": 1.25
619
+ },
620
+ {
621
+ "step_id": 26,
622
+ "phase": "approach",
623
+ "end_effector_pos": [
624
+ 0.6886994531614704,
625
+ 1.3714116844547184,
626
+ 0.452964935846739
627
+ ],
628
+ "end_effector_quat_wxyz": [
629
+ 1,
630
+ 0,
631
+ 0,
632
+ 0
633
+ ],
634
+ "gripper_width": 1.0,
635
+ "target_object_id": "bedroom_desk_0",
636
+ "target_object_pos": [
637
+ 0.794653215186312,
638
+ 1.5823980974477518,
639
+ -0.000425074022993442
640
+ ],
641
+ "timestamp": 1.3
642
+ },
643
+ {
644
+ "step_id": 27,
645
+ "phase": "approach",
646
+ "end_effector_pos": [
647
+ 0.7151878936676809,
648
+ 1.4241582877029766,
649
+ 0.4396174333793059
650
+ ],
651
+ "end_effector_quat_wxyz": [
652
+ 1,
653
+ 0,
654
+ 0,
655
+ 0
656
+ ],
657
+ "gripper_width": 1.0,
658
+ "target_object_id": "bedroom_desk_0",
659
+ "target_object_pos": [
660
+ 0.794653215186312,
661
+ 1.5823980974477518,
662
+ -0.000425074022993442
663
+ ],
664
+ "timestamp": 1.35
665
+ },
666
+ {
667
+ "step_id": 28,
668
+ "phase": "approach",
669
+ "end_effector_pos": [
670
+ 0.7416763341738912,
671
+ 1.476904890951235,
672
+ 0.42626993091187276
673
+ ],
674
+ "end_effector_quat_wxyz": [
675
+ 1,
676
+ 0,
677
+ 0,
678
+ 0
679
+ ],
680
+ "gripper_width": 1.0,
681
+ "target_object_id": "bedroom_desk_0",
682
+ "target_object_pos": [
683
+ 0.794653215186312,
684
+ 1.5823980974477518,
685
+ -0.000425074022993442
686
+ ],
687
+ "timestamp": 1.4
688
+ },
689
+ {
690
+ "step_id": 29,
691
+ "phase": "approach",
692
+ "end_effector_pos": [
693
+ 0.7681647746801017,
694
+ 1.5296514941994934,
695
+ 0.41292242844443966
696
+ ],
697
+ "end_effector_quat_wxyz": [
698
+ 1,
699
+ 0,
700
+ 0,
701
+ 0
702
+ ],
703
+ "gripper_width": 1.0,
704
+ "target_object_id": "bedroom_desk_0",
705
+ "target_object_pos": [
706
+ 0.794653215186312,
707
+ 1.5823980974477518,
708
+ -0.000425074022993442
709
+ ],
710
+ "timestamp": 1.45
711
+ },
712
+ {
713
+ "step_id": 30,
714
+ "phase": "pre_grasp",
715
+ "end_effector_pos": [
716
+ 0.794653215186312,
717
+ 1.5823980974477518,
718
+ 0.39957492597700656
719
+ ],
720
+ "end_effector_quat_wxyz": [
721
+ 1,
722
+ 0,
723
+ 0,
724
+ 0
725
+ ],
726
+ "gripper_width": 0.8,
727
+ "target_object_id": "bedroom_desk_0",
728
+ "target_object_pos": [
729
+ 0.794653215186312,
730
+ 1.5823980974477518,
731
+ -0.000425074022993442
732
+ ],
733
+ "timestamp": 1.5
734
+ },
735
+ {
736
+ "step_id": 31,
737
+ "phase": "pre_grasp",
738
+ "end_effector_pos": [
739
+ 0.794653215186312,
740
+ 1.5823980974477518,
741
+ 0.38557492597700654
742
+ ],
743
+ "end_effector_quat_wxyz": [
744
+ 1,
745
+ 0,
746
+ 0,
747
+ 0
748
+ ],
749
+ "gripper_width": 0.8,
750
+ "target_object_id": "bedroom_desk_0",
751
+ "target_object_pos": [
752
+ 0.794653215186312,
753
+ 1.5823980974477518,
754
+ -0.000425074022993442
755
+ ],
756
+ "timestamp": 1.55
757
+ },
758
+ {
759
+ "step_id": 32,
760
+ "phase": "pre_grasp",
761
+ "end_effector_pos": [
762
+ 0.794653215186312,
763
+ 1.5823980974477518,
764
+ 0.3715749259770066
765
+ ],
766
+ "end_effector_quat_wxyz": [
767
+ 1,
768
+ 0,
769
+ 0,
770
+ 0
771
+ ],
772
+ "gripper_width": 0.8,
773
+ "target_object_id": "bedroom_desk_0",
774
+ "target_object_pos": [
775
+ 0.794653215186312,
776
+ 1.5823980974477518,
777
+ -0.000425074022993442
778
+ ],
779
+ "timestamp": 1.6
780
+ },
781
+ {
782
+ "step_id": 33,
783
+ "phase": "pre_grasp",
784
+ "end_effector_pos": [
785
+ 0.794653215186312,
786
+ 1.5823980974477518,
787
+ 0.3575749259770066
788
+ ],
789
+ "end_effector_quat_wxyz": [
790
+ 1,
791
+ 0,
792
+ 0,
793
+ 0
794
+ ],
795
+ "gripper_width": 0.8,
796
+ "target_object_id": "bedroom_desk_0",
797
+ "target_object_pos": [
798
+ 0.794653215186312,
799
+ 1.5823980974477518,
800
+ -0.000425074022993442
801
+ ],
802
+ "timestamp": 1.65
803
+ },
804
+ {
805
+ "step_id": 34,
806
+ "phase": "pre_grasp",
807
+ "end_effector_pos": [
808
+ 0.794653215186312,
809
+ 1.5823980974477518,
810
+ 0.34357492597700656
811
+ ],
812
+ "end_effector_quat_wxyz": [
813
+ 1,
814
+ 0,
815
+ 0,
816
+ 0
817
+ ],
818
+ "gripper_width": 0.8,
819
+ "target_object_id": "bedroom_desk_0",
820
+ "target_object_pos": [
821
+ 0.794653215186312,
822
+ 1.5823980974477518,
823
+ -0.000425074022993442
824
+ ],
825
+ "timestamp": 1.7
826
+ },
827
+ {
828
+ "step_id": 35,
829
+ "phase": "pre_grasp",
830
+ "end_effector_pos": [
831
+ 0.794653215186312,
832
+ 1.5823980974477518,
833
+ 0.32957492597700655
834
+ ],
835
+ "end_effector_quat_wxyz": [
836
+ 1,
837
+ 0,
838
+ 0,
839
+ 0
840
+ ],
841
+ "gripper_width": 0.8,
842
+ "target_object_id": "bedroom_desk_0",
843
+ "target_object_pos": [
844
+ 0.794653215186312,
845
+ 1.5823980974477518,
846
+ -0.000425074022993442
847
+ ],
848
+ "timestamp": 1.75
849
+ },
850
+ {
851
+ "step_id": 36,
852
+ "phase": "pre_grasp",
853
+ "end_effector_pos": [
854
+ 0.794653215186312,
855
+ 1.5823980974477518,
856
+ 0.31557492597700654
857
+ ],
858
+ "end_effector_quat_wxyz": [
859
+ 1,
860
+ 0,
861
+ 0,
862
+ 0
863
+ ],
864
+ "gripper_width": 0.8,
865
+ "target_object_id": "bedroom_desk_0",
866
+ "target_object_pos": [
867
+ 0.794653215186312,
868
+ 1.5823980974477518,
869
+ -0.000425074022993442
870
+ ],
871
+ "timestamp": 1.8
872
+ },
873
+ {
874
+ "step_id": 37,
875
+ "phase": "pre_grasp",
876
+ "end_effector_pos": [
877
+ 0.794653215186312,
878
+ 1.5823980974477518,
879
+ 0.3015749259770066
880
+ ],
881
+ "end_effector_quat_wxyz": [
882
+ 1,
883
+ 0,
884
+ 0,
885
+ 0
886
+ ],
887
+ "gripper_width": 0.8,
888
+ "target_object_id": "bedroom_desk_0",
889
+ "target_object_pos": [
890
+ 0.794653215186312,
891
+ 1.5823980974477518,
892
+ -0.000425074022993442
893
+ ],
894
+ "timestamp": 1.85
895
+ },
896
+ {
897
+ "step_id": 38,
898
+ "phase": "pre_grasp",
899
+ "end_effector_pos": [
900
+ 0.794653215186312,
901
+ 1.5823980974477518,
902
+ 0.28757492597700657
903
+ ],
904
+ "end_effector_quat_wxyz": [
905
+ 1,
906
+ 0,
907
+ 0,
908
+ 0
909
+ ],
910
+ "gripper_width": 0.8,
911
+ "target_object_id": "bedroom_desk_0",
912
+ "target_object_pos": [
913
+ 0.794653215186312,
914
+ 1.5823980974477518,
915
+ -0.000425074022993442
916
+ ],
917
+ "timestamp": 1.9
918
+ },
919
+ {
920
+ "step_id": 39,
921
+ "phase": "pre_grasp",
922
+ "end_effector_pos": [
923
+ 0.794653215186312,
924
+ 1.5823980974477518,
925
+ 0.27357492597700656
926
+ ],
927
+ "end_effector_quat_wxyz": [
928
+ 1,
929
+ 0,
930
+ 0,
931
+ 0
932
+ ],
933
+ "gripper_width": 0.8,
934
+ "target_object_id": "bedroom_desk_0",
935
+ "target_object_pos": [
936
+ 0.794653215186312,
937
+ 1.5823980974477518,
938
+ -0.000425074022993442
939
+ ],
940
+ "timestamp": 1.95
941
+ },
942
+ {
943
+ "step_id": 40,
944
+ "phase": "pre_grasp",
945
+ "end_effector_pos": [
946
+ 0.794653215186312,
947
+ 1.5823980974477518,
948
+ 0.2595749259770066
949
+ ],
950
+ "end_effector_quat_wxyz": [
951
+ 1,
952
+ 0,
953
+ 0,
954
+ 0
955
+ ],
956
+ "gripper_width": 0.8,
957
+ "target_object_id": "bedroom_desk_0",
958
+ "target_object_pos": [
959
+ 0.794653215186312,
960
+ 1.5823980974477518,
961
+ -0.000425074022993442
962
+ ],
963
+ "timestamp": 2.0
964
+ },
965
+ {
966
+ "step_id": 41,
967
+ "phase": "pre_grasp",
968
+ "end_effector_pos": [
969
+ 0.794653215186312,
970
+ 1.5823980974477518,
971
+ 0.24557492597700656
972
+ ],
973
+ "end_effector_quat_wxyz": [
974
+ 1,
975
+ 0,
976
+ 0,
977
+ 0
978
+ ],
979
+ "gripper_width": 0.8,
980
+ "target_object_id": "bedroom_desk_0",
981
+ "target_object_pos": [
982
+ 0.794653215186312,
983
+ 1.5823980974477518,
984
+ -0.000425074022993442
985
+ ],
986
+ "timestamp": 2.05
987
+ },
988
+ {
989
+ "step_id": 42,
990
+ "phase": "pre_grasp",
991
+ "end_effector_pos": [
992
+ 0.794653215186312,
993
+ 1.5823980974477518,
994
+ 0.23157492597700657
995
+ ],
996
+ "end_effector_quat_wxyz": [
997
+ 1,
998
+ 0,
999
+ 0,
1000
+ 0
1001
+ ],
1002
+ "gripper_width": 0.8,
1003
+ "target_object_id": "bedroom_desk_0",
1004
+ "target_object_pos": [
1005
+ 0.794653215186312,
1006
+ 1.5823980974477518,
1007
+ -0.000425074022993442
1008
+ ],
1009
+ "timestamp": 2.1
1010
+ },
1011
+ {
1012
+ "step_id": 43,
1013
+ "phase": "pre_grasp",
1014
+ "end_effector_pos": [
1015
+ 0.794653215186312,
1016
+ 1.5823980974477518,
1017
+ 0.21757492597700656
1018
+ ],
1019
+ "end_effector_quat_wxyz": [
1020
+ 1,
1021
+ 0,
1022
+ 0,
1023
+ 0
1024
+ ],
1025
+ "gripper_width": 0.8,
1026
+ "target_object_id": "bedroom_desk_0",
1027
+ "target_object_pos": [
1028
+ 0.794653215186312,
1029
+ 1.5823980974477518,
1030
+ -0.000425074022993442
1031
+ ],
1032
+ "timestamp": 2.15
1033
+ },
1034
+ {
1035
+ "step_id": 44,
1036
+ "phase": "pre_grasp",
1037
+ "end_effector_pos": [
1038
+ 0.794653215186312,
1039
+ 1.5823980974477518,
1040
+ 0.20357492597700658
1041
+ ],
1042
+ "end_effector_quat_wxyz": [
1043
+ 1,
1044
+ 0,
1045
+ 0,
1046
+ 0
1047
+ ],
1048
+ "gripper_width": 0.8,
1049
+ "target_object_id": "bedroom_desk_0",
1050
+ "target_object_pos": [
1051
+ 0.794653215186312,
1052
+ 1.5823980974477518,
1053
+ -0.000425074022993442
1054
+ ],
1055
+ "timestamp": 2.2
1056
+ },
1057
+ {
1058
+ "step_id": 45,
1059
+ "phase": "pre_grasp",
1060
+ "end_effector_pos": [
1061
+ 0.794653215186312,
1062
+ 1.5823980974477518,
1063
+ 0.1895749259770066
1064
+ ],
1065
+ "end_effector_quat_wxyz": [
1066
+ 1,
1067
+ 0,
1068
+ 0,
1069
+ 0
1070
+ ],
1071
+ "gripper_width": 0.8,
1072
+ "target_object_id": "bedroom_desk_0",
1073
+ "target_object_pos": [
1074
+ 0.794653215186312,
1075
+ 1.5823980974477518,
1076
+ -0.000425074022993442
1077
+ ],
1078
+ "timestamp": 2.25
1079
+ },
1080
+ {
1081
+ "step_id": 46,
1082
+ "phase": "pre_grasp",
1083
+ "end_effector_pos": [
1084
+ 0.794653215186312,
1085
+ 1.5823980974477518,
1086
+ 0.17557492597700658
1087
+ ],
1088
+ "end_effector_quat_wxyz": [
1089
+ 1,
1090
+ 0,
1091
+ 0,
1092
+ 0
1093
+ ],
1094
+ "gripper_width": 0.8,
1095
+ "target_object_id": "bedroom_desk_0",
1096
+ "target_object_pos": [
1097
+ 0.794653215186312,
1098
+ 1.5823980974477518,
1099
+ -0.000425074022993442
1100
+ ],
1101
+ "timestamp": 2.3
1102
+ },
1103
+ {
1104
+ "step_id": 47,
1105
+ "phase": "pre_grasp",
1106
+ "end_effector_pos": [
1107
+ 0.794653215186312,
1108
+ 1.5823980974477518,
1109
+ 0.1615749259770066
1110
+ ],
1111
+ "end_effector_quat_wxyz": [
1112
+ 1,
1113
+ 0,
1114
+ 0,
1115
+ 0
1116
+ ],
1117
+ "gripper_width": 0.8,
1118
+ "target_object_id": "bedroom_desk_0",
1119
+ "target_object_pos": [
1120
+ 0.794653215186312,
1121
+ 1.5823980974477518,
1122
+ -0.000425074022993442
1123
+ ],
1124
+ "timestamp": 2.35
1125
+ },
1126
+ {
1127
+ "step_id": 48,
1128
+ "phase": "pre_grasp",
1129
+ "end_effector_pos": [
1130
+ 0.794653215186312,
1131
+ 1.5823980974477518,
1132
+ 0.14757492597700655
1133
+ ],
1134
+ "end_effector_quat_wxyz": [
1135
+ 1,
1136
+ 0,
1137
+ 0,
1138
+ 0
1139
+ ],
1140
+ "gripper_width": 0.8,
1141
+ "target_object_id": "bedroom_desk_0",
1142
+ "target_object_pos": [
1143
+ 0.794653215186312,
1144
+ 1.5823980974477518,
1145
+ -0.000425074022993442
1146
+ ],
1147
+ "timestamp": 2.4
1148
+ },
1149
+ {
1150
+ "step_id": 49,
1151
+ "phase": "pre_grasp",
1152
+ "end_effector_pos": [
1153
+ 0.794653215186312,
1154
+ 1.5823980974477518,
1155
+ 0.1335749259770066
1156
+ ],
1157
+ "end_effector_quat_wxyz": [
1158
+ 1,
1159
+ 0,
1160
+ 0,
1161
+ 0
1162
+ ],
1163
+ "gripper_width": 0.8,
1164
+ "target_object_id": "bedroom_desk_0",
1165
+ "target_object_pos": [
1166
+ 0.794653215186312,
1167
+ 1.5823980974477518,
1168
+ -0.000425074022993442
1169
+ ],
1170
+ "timestamp": 2.45
1171
+ },
1172
+ {
1173
+ "step_id": 50,
1174
+ "phase": "grasp",
1175
+ "end_effector_pos": [
1176
+ 0.794653215186312,
1177
+ 1.5823980974477518,
1178
+ 0.11957492597700657
1179
+ ],
1180
+ "end_effector_quat_wxyz": [
1181
+ 1,
1182
+ 0,
1183
+ 0,
1184
+ 0
1185
+ ],
1186
+ "gripper_width": 1.0,
1187
+ "target_object_id": "bedroom_desk_0",
1188
+ "target_object_pos": [
1189
+ 0.794653215186312,
1190
+ 1.5823980974477518,
1191
+ -0.000425074022993442
1192
+ ],
1193
+ "timestamp": 2.5
1194
+ },
1195
+ {
1196
+ "step_id": 51,
1197
+ "phase": "grasp",
1198
+ "end_effector_pos": [
1199
+ 0.794653215186312,
1200
+ 1.5823980974477518,
1201
+ 0.11957492597700657
1202
+ ],
1203
+ "end_effector_quat_wxyz": [
1204
+ 1,
1205
+ 0,
1206
+ 0,
1207
+ 0
1208
+ ],
1209
+ "gripper_width": 0.91,
1210
+ "target_object_id": "bedroom_desk_0",
1211
+ "target_object_pos": [
1212
+ 0.794653215186312,
1213
+ 1.5823980974477518,
1214
+ -0.000425074022993442
1215
+ ],
1216
+ "timestamp": 2.55
1217
+ },
1218
+ {
1219
+ "step_id": 52,
1220
+ "phase": "grasp",
1221
+ "end_effector_pos": [
1222
+ 0.794653215186312,
1223
+ 1.5823980974477518,
1224
+ 0.11957492597700657
1225
+ ],
1226
+ "end_effector_quat_wxyz": [
1227
+ 1,
1228
+ 0,
1229
+ 0,
1230
+ 0
1231
+ ],
1232
+ "gripper_width": 0.82,
1233
+ "target_object_id": "bedroom_desk_0",
1234
+ "target_object_pos": [
1235
+ 0.794653215186312,
1236
+ 1.5823980974477518,
1237
+ -0.000425074022993442
1238
+ ],
1239
+ "timestamp": 2.6
1240
+ },
1241
+ {
1242
+ "step_id": 53,
1243
+ "phase": "grasp",
1244
+ "end_effector_pos": [
1245
+ 0.794653215186312,
1246
+ 1.5823980974477518,
1247
+ 0.11957492597700657
1248
+ ],
1249
+ "end_effector_quat_wxyz": [
1250
+ 1,
1251
+ 0,
1252
+ 0,
1253
+ 0
1254
+ ],
1255
+ "gripper_width": 0.73,
1256
+ "target_object_id": "bedroom_desk_0",
1257
+ "target_object_pos": [
1258
+ 0.794653215186312,
1259
+ 1.5823980974477518,
1260
+ -0.000425074022993442
1261
+ ],
1262
+ "timestamp": 2.65
1263
+ },
1264
+ {
1265
+ "step_id": 54,
1266
+ "phase": "grasp",
1267
+ "end_effector_pos": [
1268
+ 0.794653215186312,
1269
+ 1.5823980974477518,
1270
+ 0.11957492597700657
1271
+ ],
1272
+ "end_effector_quat_wxyz": [
1273
+ 1,
1274
+ 0,
1275
+ 0,
1276
+ 0
1277
+ ],
1278
+ "gripper_width": 0.6399999999999999,
1279
+ "target_object_id": "bedroom_desk_0",
1280
+ "target_object_pos": [
1281
+ 0.794653215186312,
1282
+ 1.5823980974477518,
1283
+ -0.000425074022993442
1284
+ ],
1285
+ "timestamp": 2.7
1286
+ },
1287
+ {
1288
+ "step_id": 55,
1289
+ "phase": "grasp",
1290
+ "end_effector_pos": [
1291
+ 0.794653215186312,
1292
+ 1.5823980974477518,
1293
+ 0.11957492597700657
1294
+ ],
1295
+ "end_effector_quat_wxyz": [
1296
+ 1,
1297
+ 0,
1298
+ 0,
1299
+ 0
1300
+ ],
1301
+ "gripper_width": 0.55,
1302
+ "target_object_id": "bedroom_desk_0",
1303
+ "target_object_pos": [
1304
+ 0.794653215186312,
1305
+ 1.5823980974477518,
1306
+ -0.000425074022993442
1307
+ ],
1308
+ "timestamp": 2.75
1309
+ },
1310
+ {
1311
+ "step_id": 56,
1312
+ "phase": "grasp",
1313
+ "end_effector_pos": [
1314
+ 0.794653215186312,
1315
+ 1.5823980974477518,
1316
+ 0.11957492597700657
1317
+ ],
1318
+ "end_effector_quat_wxyz": [
1319
+ 1,
1320
+ 0,
1321
+ 0,
1322
+ 0
1323
+ ],
1324
+ "gripper_width": 0.45999999999999996,
1325
+ "target_object_id": "bedroom_desk_0",
1326
+ "target_object_pos": [
1327
+ 0.794653215186312,
1328
+ 1.5823980974477518,
1329
+ -0.000425074022993442
1330
+ ],
1331
+ "timestamp": 2.8
1332
+ },
1333
+ {
1334
+ "step_id": 57,
1335
+ "phase": "grasp",
1336
+ "end_effector_pos": [
1337
+ 0.794653215186312,
1338
+ 1.5823980974477518,
1339
+ 0.11957492597700657
1340
+ ],
1341
+ "end_effector_quat_wxyz": [
1342
+ 1,
1343
+ 0,
1344
+ 0,
1345
+ 0
1346
+ ],
1347
+ "gripper_width": 0.37,
1348
+ "target_object_id": "bedroom_desk_0",
1349
+ "target_object_pos": [
1350
+ 0.794653215186312,
1351
+ 1.5823980974477518,
1352
+ -0.000425074022993442
1353
+ ],
1354
+ "timestamp": 2.85
1355
+ },
1356
+ {
1357
+ "step_id": 58,
1358
+ "phase": "grasp",
1359
+ "end_effector_pos": [
1360
+ 0.794653215186312,
1361
+ 1.5823980974477518,
1362
+ 0.11957492597700657
1363
+ ],
1364
+ "end_effector_quat_wxyz": [
1365
+ 1,
1366
+ 0,
1367
+ 0,
1368
+ 0
1369
+ ],
1370
+ "gripper_width": 0.2799999999999999,
1371
+ "target_object_id": "bedroom_desk_0",
1372
+ "target_object_pos": [
1373
+ 0.794653215186312,
1374
+ 1.5823980974477518,
1375
+ -0.000425074022993442
1376
+ ],
1377
+ "timestamp": 2.9
1378
+ },
1379
+ {
1380
+ "step_id": 59,
1381
+ "phase": "grasp",
1382
+ "end_effector_pos": [
1383
+ 0.794653215186312,
1384
+ 1.5823980974477518,
1385
+ 0.11957492597700657
1386
+ ],
1387
+ "end_effector_quat_wxyz": [
1388
+ 1,
1389
+ 0,
1390
+ 0,
1391
+ 0
1392
+ ],
1393
+ "gripper_width": 0.18999999999999995,
1394
+ "target_object_id": "bedroom_desk_0",
1395
+ "target_object_pos": [
1396
+ 0.794653215186312,
1397
+ 1.5823980974477518,
1398
+ -0.000425074022993442
1399
+ ],
1400
+ "timestamp": 2.95
1401
+ },
1402
+ {
1403
+ "step_id": 60,
1404
+ "phase": "lift",
1405
+ "end_effector_pos": [
1406
+ 0.794653215186312,
1407
+ 1.5823980974477518,
1408
+ 0.11957492597700657
1409
+ ],
1410
+ "end_effector_quat_wxyz": [
1411
+ 1,
1412
+ 0,
1413
+ 0,
1414
+ 0
1415
+ ],
1416
+ "gripper_width": 0.1,
1417
+ "target_object_id": "bedroom_desk_0",
1418
+ "target_object_pos": [
1419
+ 0.794653215186312,
1420
+ 1.5823980974477518,
1421
+ 0.11957492597700657
1422
+ ],
1423
+ "timestamp": 3.0
1424
+ },
1425
+ {
1426
+ "step_id": 61,
1427
+ "phase": "lift",
1428
+ "end_effector_pos": [
1429
+ 0.794653215186312,
1430
+ 1.5823980974477518,
1431
+ 0.13357492597700657
1432
+ ],
1433
+ "end_effector_quat_wxyz": [
1434
+ 1,
1435
+ 0,
1436
+ 0,
1437
+ 0
1438
+ ],
1439
+ "gripper_width": 0.1,
1440
+ "target_object_id": "bedroom_desk_0",
1441
+ "target_object_pos": [
1442
+ 0.794653215186312,
1443
+ 1.5823980974477518,
1444
+ 0.13357492597700657
1445
+ ],
1446
+ "timestamp": 3.05
1447
+ },
1448
+ {
1449
+ "step_id": 62,
1450
+ "phase": "lift",
1451
+ "end_effector_pos": [
1452
+ 0.794653215186312,
1453
+ 1.5823980974477518,
1454
+ 0.14757492597700655
1455
+ ],
1456
+ "end_effector_quat_wxyz": [
1457
+ 1,
1458
+ 0,
1459
+ 0,
1460
+ 0
1461
+ ],
1462
+ "gripper_width": 0.1,
1463
+ "target_object_id": "bedroom_desk_0",
1464
+ "target_object_pos": [
1465
+ 0.794653215186312,
1466
+ 1.5823980974477518,
1467
+ 0.14757492597700655
1468
+ ],
1469
+ "timestamp": 3.1
1470
+ },
1471
+ {
1472
+ "step_id": 63,
1473
+ "phase": "lift",
1474
+ "end_effector_pos": [
1475
+ 0.794653215186312,
1476
+ 1.5823980974477518,
1477
+ 0.16157492597700657
1478
+ ],
1479
+ "end_effector_quat_wxyz": [
1480
+ 1,
1481
+ 0,
1482
+ 0,
1483
+ 0
1484
+ ],
1485
+ "gripper_width": 0.1,
1486
+ "target_object_id": "bedroom_desk_0",
1487
+ "target_object_pos": [
1488
+ 0.794653215186312,
1489
+ 1.5823980974477518,
1490
+ 0.16157492597700657
1491
+ ],
1492
+ "timestamp": 3.15
1493
+ },
1494
+ {
1495
+ "step_id": 64,
1496
+ "phase": "lift",
1497
+ "end_effector_pos": [
1498
+ 0.794653215186312,
1499
+ 1.5823980974477518,
1500
+ 0.17557492597700658
1501
+ ],
1502
+ "end_effector_quat_wxyz": [
1503
+ 1,
1504
+ 0,
1505
+ 0,
1506
+ 0
1507
+ ],
1508
+ "gripper_width": 0.1,
1509
+ "target_object_id": "bedroom_desk_0",
1510
+ "target_object_pos": [
1511
+ 0.794653215186312,
1512
+ 1.5823980974477518,
1513
+ 0.17557492597700658
1514
+ ],
1515
+ "timestamp": 3.2
1516
+ },
1517
+ {
1518
+ "step_id": 65,
1519
+ "phase": "lift",
1520
+ "end_effector_pos": [
1521
+ 0.794653215186312,
1522
+ 1.5823980974477518,
1523
+ 0.18957492597700656
1524
+ ],
1525
+ "end_effector_quat_wxyz": [
1526
+ 1,
1527
+ 0,
1528
+ 0,
1529
+ 0
1530
+ ],
1531
+ "gripper_width": 0.1,
1532
+ "target_object_id": "bedroom_desk_0",
1533
+ "target_object_pos": [
1534
+ 0.794653215186312,
1535
+ 1.5823980974477518,
1536
+ 0.18957492597700656
1537
+ ],
1538
+ "timestamp": 3.25
1539
+ },
1540
+ {
1541
+ "step_id": 66,
1542
+ "phase": "lift",
1543
+ "end_effector_pos": [
1544
+ 0.794653215186312,
1545
+ 1.5823980974477518,
1546
+ 0.20357492597700655
1547
+ ],
1548
+ "end_effector_quat_wxyz": [
1549
+ 1,
1550
+ 0,
1551
+ 0,
1552
+ 0
1553
+ ],
1554
+ "gripper_width": 0.1,
1555
+ "target_object_id": "bedroom_desk_0",
1556
+ "target_object_pos": [
1557
+ 0.794653215186312,
1558
+ 1.5823980974477518,
1559
+ 0.20357492597700655
1560
+ ],
1561
+ "timestamp": 3.3
1562
+ },
1563
+ {
1564
+ "step_id": 67,
1565
+ "phase": "lift",
1566
+ "end_effector_pos": [
1567
+ 0.794653215186312,
1568
+ 1.5823980974477518,
1569
+ 0.21757492597700656
1570
+ ],
1571
+ "end_effector_quat_wxyz": [
1572
+ 1,
1573
+ 0,
1574
+ 0,
1575
+ 0
1576
+ ],
1577
+ "gripper_width": 0.1,
1578
+ "target_object_id": "bedroom_desk_0",
1579
+ "target_object_pos": [
1580
+ 0.794653215186312,
1581
+ 1.5823980974477518,
1582
+ 0.21757492597700656
1583
+ ],
1584
+ "timestamp": 3.35
1585
+ },
1586
+ {
1587
+ "step_id": 68,
1588
+ "phase": "lift",
1589
+ "end_effector_pos": [
1590
+ 0.794653215186312,
1591
+ 1.5823980974477518,
1592
+ 0.23157492597700657
1593
+ ],
1594
+ "end_effector_quat_wxyz": [
1595
+ 1,
1596
+ 0,
1597
+ 0,
1598
+ 0
1599
+ ],
1600
+ "gripper_width": 0.1,
1601
+ "target_object_id": "bedroom_desk_0",
1602
+ "target_object_pos": [
1603
+ 0.794653215186312,
1604
+ 1.5823980974477518,
1605
+ 0.23157492597700657
1606
+ ],
1607
+ "timestamp": 3.4
1608
+ },
1609
+ {
1610
+ "step_id": 69,
1611
+ "phase": "lift",
1612
+ "end_effector_pos": [
1613
+ 0.794653215186312,
1614
+ 1.5823980974477518,
1615
+ 0.2455749259770066
1616
+ ],
1617
+ "end_effector_quat_wxyz": [
1618
+ 1,
1619
+ 0,
1620
+ 0,
1621
+ 0
1622
+ ],
1623
+ "gripper_width": 0.1,
1624
+ "target_object_id": "bedroom_desk_0",
1625
+ "target_object_pos": [
1626
+ 0.794653215186312,
1627
+ 1.5823980974477518,
1628
+ 0.2455749259770066
1629
+ ],
1630
+ "timestamp": 3.45
1631
+ },
1632
+ {
1633
+ "step_id": 70,
1634
+ "phase": "lift",
1635
+ "end_effector_pos": [
1636
+ 0.794653215186312,
1637
+ 1.5823980974477518,
1638
+ 0.25957492597700654
1639
+ ],
1640
+ "end_effector_quat_wxyz": [
1641
+ 1,
1642
+ 0,
1643
+ 0,
1644
+ 0
1645
+ ],
1646
+ "gripper_width": 0.1,
1647
+ "target_object_id": "bedroom_desk_0",
1648
+ "target_object_pos": [
1649
+ 0.794653215186312,
1650
+ 1.5823980974477518,
1651
+ 0.25957492597700654
1652
+ ],
1653
+ "timestamp": 3.5
1654
+ },
1655
+ {
1656
+ "step_id": 71,
1657
+ "phase": "lift",
1658
+ "end_effector_pos": [
1659
+ 0.794653215186312,
1660
+ 1.5823980974477518,
1661
+ 0.27357492597700656
1662
+ ],
1663
+ "end_effector_quat_wxyz": [
1664
+ 1,
1665
+ 0,
1666
+ 0,
1667
+ 0
1668
+ ],
1669
+ "gripper_width": 0.1,
1670
+ "target_object_id": "bedroom_desk_0",
1671
+ "target_object_pos": [
1672
+ 0.794653215186312,
1673
+ 1.5823980974477518,
1674
+ 0.27357492597700656
1675
+ ],
1676
+ "timestamp": 3.55
1677
+ },
1678
+ {
1679
+ "step_id": 72,
1680
+ "phase": "lift",
1681
+ "end_effector_pos": [
1682
+ 0.794653215186312,
1683
+ 1.5823980974477518,
1684
+ 0.28757492597700657
1685
+ ],
1686
+ "end_effector_quat_wxyz": [
1687
+ 1,
1688
+ 0,
1689
+ 0,
1690
+ 0
1691
+ ],
1692
+ "gripper_width": 0.1,
1693
+ "target_object_id": "bedroom_desk_0",
1694
+ "target_object_pos": [
1695
+ 0.794653215186312,
1696
+ 1.5823980974477518,
1697
+ 0.28757492597700657
1698
+ ],
1699
+ "timestamp": 3.6
1700
+ },
1701
+ {
1702
+ "step_id": 73,
1703
+ "phase": "lift",
1704
+ "end_effector_pos": [
1705
+ 0.794653215186312,
1706
+ 1.5823980974477518,
1707
+ 0.3015749259770066
1708
+ ],
1709
+ "end_effector_quat_wxyz": [
1710
+ 1,
1711
+ 0,
1712
+ 0,
1713
+ 0
1714
+ ],
1715
+ "gripper_width": 0.1,
1716
+ "target_object_id": "bedroom_desk_0",
1717
+ "target_object_pos": [
1718
+ 0.794653215186312,
1719
+ 1.5823980974477518,
1720
+ 0.3015749259770066
1721
+ ],
1722
+ "timestamp": 3.65
1723
+ },
1724
+ {
1725
+ "step_id": 74,
1726
+ "phase": "lift",
1727
+ "end_effector_pos": [
1728
+ 0.794653215186312,
1729
+ 1.5823980974477518,
1730
+ 0.31557492597700654
1731
+ ],
1732
+ "end_effector_quat_wxyz": [
1733
+ 1,
1734
+ 0,
1735
+ 0,
1736
+ 0
1737
+ ],
1738
+ "gripper_width": 0.1,
1739
+ "target_object_id": "bedroom_desk_0",
1740
+ "target_object_pos": [
1741
+ 0.794653215186312,
1742
+ 1.5823980974477518,
1743
+ 0.31557492597700654
1744
+ ],
1745
+ "timestamp": 3.7
1746
+ },
1747
+ {
1748
+ "step_id": 75,
1749
+ "phase": "lift",
1750
+ "end_effector_pos": [
1751
+ 0.794653215186312,
1752
+ 1.5823980974477518,
1753
+ 0.32957492597700655
1754
+ ],
1755
+ "end_effector_quat_wxyz": [
1756
+ 1,
1757
+ 0,
1758
+ 0,
1759
+ 0
1760
+ ],
1761
+ "gripper_width": 0.1,
1762
+ "target_object_id": "bedroom_desk_0",
1763
+ "target_object_pos": [
1764
+ 0.794653215186312,
1765
+ 1.5823980974477518,
1766
+ 0.32957492597700655
1767
+ ],
1768
+ "timestamp": 3.75
1769
+ },
1770
+ {
1771
+ "step_id": 76,
1772
+ "phase": "lift",
1773
+ "end_effector_pos": [
1774
+ 0.794653215186312,
1775
+ 1.5823980974477518,
1776
+ 0.34357492597700656
1777
+ ],
1778
+ "end_effector_quat_wxyz": [
1779
+ 1,
1780
+ 0,
1781
+ 0,
1782
+ 0
1783
+ ],
1784
+ "gripper_width": 0.1,
1785
+ "target_object_id": "bedroom_desk_0",
1786
+ "target_object_pos": [
1787
+ 0.794653215186312,
1788
+ 1.5823980974477518,
1789
+ 0.34357492597700656
1790
+ ],
1791
+ "timestamp": 3.8
1792
+ },
1793
+ {
1794
+ "step_id": 77,
1795
+ "phase": "lift",
1796
+ "end_effector_pos": [
1797
+ 0.794653215186312,
1798
+ 1.5823980974477518,
1799
+ 0.3575749259770065
1800
+ ],
1801
+ "end_effector_quat_wxyz": [
1802
+ 1,
1803
+ 0,
1804
+ 0,
1805
+ 0
1806
+ ],
1807
+ "gripper_width": 0.1,
1808
+ "target_object_id": "bedroom_desk_0",
1809
+ "target_object_pos": [
1810
+ 0.794653215186312,
1811
+ 1.5823980974477518,
1812
+ 0.3575749259770065
1813
+ ],
1814
+ "timestamp": 3.85
1815
+ },
1816
+ {
1817
+ "step_id": 78,
1818
+ "phase": "lift",
1819
+ "end_effector_pos": [
1820
+ 0.794653215186312,
1821
+ 1.5823980974477518,
1822
+ 0.3715749259770066
1823
+ ],
1824
+ "end_effector_quat_wxyz": [
1825
+ 1,
1826
+ 0,
1827
+ 0,
1828
+ 0
1829
+ ],
1830
+ "gripper_width": 0.1,
1831
+ "target_object_id": "bedroom_desk_0",
1832
+ "target_object_pos": [
1833
+ 0.794653215186312,
1834
+ 1.5823980974477518,
1835
+ 0.3715749259770066
1836
+ ],
1837
+ "timestamp": 3.9
1838
+ },
1839
+ {
1840
+ "step_id": 79,
1841
+ "phase": "lift",
1842
+ "end_effector_pos": [
1843
+ 0.794653215186312,
1844
+ 1.5823980974477518,
1845
+ 0.38557492597700654
1846
+ ],
1847
+ "end_effector_quat_wxyz": [
1848
+ 1,
1849
+ 0,
1850
+ 0,
1851
+ 0
1852
+ ],
1853
+ "gripper_width": 0.1,
1854
+ "target_object_id": "bedroom_desk_0",
1855
+ "target_object_pos": [
1856
+ 0.794653215186312,
1857
+ 1.5823980974477518,
1858
+ 0.38557492597700654
1859
+ ],
1860
+ "timestamp": 3.95
1861
+ },
1862
+ {
1863
+ "step_id": 80,
1864
+ "phase": "transport",
1865
+ "end_effector_pos": [
1866
+ 0.794653215186312,
1867
+ 1.5823980974477518,
1868
+ 0.39957492597700656
1869
+ ],
1870
+ "end_effector_quat_wxyz": [
1871
+ 1,
1872
+ 0,
1873
+ 0,
1874
+ 0
1875
+ ],
1876
+ "gripper_width": 0.1,
1877
+ "target_object_id": "bedroom_desk_0",
1878
+ "target_object_pos": [
1879
+ 0.794653215186312,
1880
+ 1.5823980974477518,
1881
+ 0.39957492597700656
1882
+ ],
1883
+ "timestamp": 4.0
1884
+ },
1885
+ {
1886
+ "step_id": 81,
1887
+ "phase": "transport",
1888
+ "end_effector_pos": [
1889
+ 0.7747868848066543,
1890
+ 1.542838145011558,
1891
+ 0.39957492597700656
1892
+ ],
1893
+ "end_effector_quat_wxyz": [
1894
+ 1,
1895
+ 0,
1896
+ 0,
1897
+ 0
1898
+ ],
1899
+ "gripper_width": 0.1,
1900
+ "target_object_id": "bedroom_desk_0",
1901
+ "target_object_pos": [
1902
+ 0.7747868848066543,
1903
+ 1.542838145011558,
1904
+ 0.39957492597700656
1905
+ ],
1906
+ "timestamp": 4.05
1907
+ },
1908
+ {
1909
+ "step_id": 82,
1910
+ "phase": "transport",
1911
+ "end_effector_pos": [
1912
+ 0.7549205544269965,
1913
+ 1.5032781925753642,
1914
+ 0.39957492597700656
1915
+ ],
1916
+ "end_effector_quat_wxyz": [
1917
+ 1,
1918
+ 0,
1919
+ 0,
1920
+ 0
1921
+ ],
1922
+ "gripper_width": 0.1,
1923
+ "target_object_id": "bedroom_desk_0",
1924
+ "target_object_pos": [
1925
+ 0.7549205544269965,
1926
+ 1.5032781925753642,
1927
+ 0.39957492597700656
1928
+ ],
1929
+ "timestamp": 4.1
1930
+ },
1931
+ {
1932
+ "step_id": 83,
1933
+ "phase": "transport",
1934
+ "end_effector_pos": [
1935
+ 0.7350542240473387,
1936
+ 1.4637182401391704,
1937
+ 0.39957492597700656
1938
+ ],
1939
+ "end_effector_quat_wxyz": [
1940
+ 1,
1941
+ 0,
1942
+ 0,
1943
+ 0
1944
+ ],
1945
+ "gripper_width": 0.1,
1946
+ "target_object_id": "bedroom_desk_0",
1947
+ "target_object_pos": [
1948
+ 0.7350542240473387,
1949
+ 1.4637182401391704,
1950
+ 0.39957492597700656
1951
+ ],
1952
+ "timestamp": 4.15
1953
+ },
1954
+ {
1955
+ "step_id": 84,
1956
+ "phase": "transport",
1957
+ "end_effector_pos": [
1958
+ 0.7151878936676809,
1959
+ 1.4241582877029766,
1960
+ 0.39957492597700656
1961
+ ],
1962
+ "end_effector_quat_wxyz": [
1963
+ 1,
1964
+ 0,
1965
+ 0,
1966
+ 0
1967
+ ],
1968
+ "gripper_width": 0.1,
1969
+ "target_object_id": "bedroom_desk_0",
1970
+ "target_object_pos": [
1971
+ 0.7151878936676809,
1972
+ 1.4241582877029766,
1973
+ 0.39957492597700656
1974
+ ],
1975
+ "timestamp": 4.2
1976
+ },
1977
+ {
1978
+ "step_id": 85,
1979
+ "phase": "transport",
1980
+ "end_effector_pos": [
1981
+ 0.6953215632880231,
1982
+ 1.3845983352667828,
1983
+ 0.39957492597700656
1984
+ ],
1985
+ "end_effector_quat_wxyz": [
1986
+ 1,
1987
+ 0,
1988
+ 0,
1989
+ 0
1990
+ ],
1991
+ "gripper_width": 0.1,
1992
+ "target_object_id": "bedroom_desk_0",
1993
+ "target_object_pos": [
1994
+ 0.6953215632880231,
1995
+ 1.3845983352667828,
1996
+ 0.39957492597700656
1997
+ ],
1998
+ "timestamp": 4.25
1999
+ },
2000
+ {
2001
+ "step_id": 86,
2002
+ "phase": "transport",
2003
+ "end_effector_pos": [
2004
+ 0.6754552329083653,
2005
+ 1.3450383828305892,
2006
+ 0.39957492597700656
2007
+ ],
2008
+ "end_effector_quat_wxyz": [
2009
+ 1,
2010
+ 0,
2011
+ 0,
2012
+ 0
2013
+ ],
2014
+ "gripper_width": 0.1,
2015
+ "target_object_id": "bedroom_desk_0",
2016
+ "target_object_pos": [
2017
+ 0.6754552329083653,
2018
+ 1.3450383828305892,
2019
+ 0.39957492597700656
2020
+ ],
2021
+ "timestamp": 4.3
2022
+ },
2023
+ {
2024
+ "step_id": 87,
2025
+ "phase": "transport",
2026
+ "end_effector_pos": [
2027
+ 0.6555889025287074,
2028
+ 1.3054784303943952,
2029
+ 0.39957492597700656
2030
+ ],
2031
+ "end_effector_quat_wxyz": [
2032
+ 1,
2033
+ 0,
2034
+ 0,
2035
+ 0
2036
+ ],
2037
+ "gripper_width": 0.1,
2038
+ "target_object_id": "bedroom_desk_0",
2039
+ "target_object_pos": [
2040
+ 0.6555889025287074,
2041
+ 1.3054784303943952,
2042
+ 0.39957492597700656
2043
+ ],
2044
+ "timestamp": 4.35
2045
+ },
2046
+ {
2047
+ "step_id": 88,
2048
+ "phase": "transport",
2049
+ "end_effector_pos": [
2050
+ 0.6357225721490496,
2051
+ 1.2659184779582016,
2052
+ 0.39957492597700656
2053
+ ],
2054
+ "end_effector_quat_wxyz": [
2055
+ 1,
2056
+ 0,
2057
+ 0,
2058
+ 0
2059
+ ],
2060
+ "gripper_width": 0.1,
2061
+ "target_object_id": "bedroom_desk_0",
2062
+ "target_object_pos": [
2063
+ 0.6357225721490496,
2064
+ 1.2659184779582016,
2065
+ 0.39957492597700656
2066
+ ],
2067
+ "timestamp": 4.4
2068
+ },
2069
+ {
2070
+ "step_id": 89,
2071
+ "phase": "transport",
2072
+ "end_effector_pos": [
2073
+ 0.6158562417693918,
2074
+ 1.2263585255220077,
2075
+ 0.39957492597700656
2076
+ ],
2077
+ "end_effector_quat_wxyz": [
2078
+ 1,
2079
+ 0,
2080
+ 0,
2081
+ 0
2082
+ ],
2083
+ "gripper_width": 0.1,
2084
+ "target_object_id": "bedroom_desk_0",
2085
+ "target_object_pos": [
2086
+ 0.6158562417693918,
2087
+ 1.2263585255220077,
2088
+ 0.39957492597700656
2089
+ ],
2090
+ "timestamp": 4.45
2091
+ },
2092
+ {
2093
+ "step_id": 90,
2094
+ "phase": "transport",
2095
+ "end_effector_pos": [
2096
+ 0.595989911389734,
2097
+ 1.186798573085814,
2098
+ 0.39957492597700656
2099
+ ],
2100
+ "end_effector_quat_wxyz": [
2101
+ 1,
2102
+ 0,
2103
+ 0,
2104
+ 0
2105
+ ],
2106
+ "gripper_width": 0.1,
2107
+ "target_object_id": "bedroom_desk_0",
2108
+ "target_object_pos": [
2109
+ 0.595989911389734,
2110
+ 1.186798573085814,
2111
+ 0.39957492597700656
2112
+ ],
2113
+ "timestamp": 4.5
2114
+ },
2115
+ {
2116
+ "step_id": 91,
2117
+ "phase": "transport",
2118
+ "end_effector_pos": [
2119
+ 0.5761235810100762,
2120
+ 1.1472386206496201,
2121
+ 0.39957492597700656
2122
+ ],
2123
+ "end_effector_quat_wxyz": [
2124
+ 1,
2125
+ 0,
2126
+ 0,
2127
+ 0
2128
+ ],
2129
+ "gripper_width": 0.1,
2130
+ "target_object_id": "bedroom_desk_0",
2131
+ "target_object_pos": [
2132
+ 0.5761235810100762,
2133
+ 1.1472386206496201,
2134
+ 0.39957492597700656
2135
+ ],
2136
+ "timestamp": 4.55
2137
+ },
2138
+ {
2139
+ "step_id": 92,
2140
+ "phase": "transport",
2141
+ "end_effector_pos": [
2142
+ 0.5562572506304184,
2143
+ 1.1076786682134263,
2144
+ 0.39957492597700656
2145
+ ],
2146
+ "end_effector_quat_wxyz": [
2147
+ 1,
2148
+ 0,
2149
+ 0,
2150
+ 0
2151
+ ],
2152
+ "gripper_width": 0.1,
2153
+ "target_object_id": "bedroom_desk_0",
2154
+ "target_object_pos": [
2155
+ 0.5562572506304184,
2156
+ 1.1076786682134263,
2157
+ 0.39957492597700656
2158
+ ],
2159
+ "timestamp": 4.6
2160
+ },
2161
+ {
2162
+ "step_id": 93,
2163
+ "phase": "transport",
2164
+ "end_effector_pos": [
2165
+ 0.5363909202507606,
2166
+ 1.0681187157772325,
2167
+ 0.39957492597700656
2168
+ ],
2169
+ "end_effector_quat_wxyz": [
2170
+ 1,
2171
+ 0,
2172
+ 0,
2173
+ 0
2174
+ ],
2175
+ "gripper_width": 0.1,
2176
+ "target_object_id": "bedroom_desk_0",
2177
+ "target_object_pos": [
2178
+ 0.5363909202507606,
2179
+ 1.0681187157772325,
2180
+ 0.39957492597700656
2181
+ ],
2182
+ "timestamp": 4.65
2183
+ },
2184
+ {
2185
+ "step_id": 94,
2186
+ "phase": "transport",
2187
+ "end_effector_pos": [
2188
+ 0.5165245898711028,
2189
+ 1.0285587633410387,
2190
+ 0.39957492597700656
2191
+ ],
2192
+ "end_effector_quat_wxyz": [
2193
+ 1,
2194
+ 0,
2195
+ 0,
2196
+ 0
2197
+ ],
2198
+ "gripper_width": 0.1,
2199
+ "target_object_id": "bedroom_desk_0",
2200
+ "target_object_pos": [
2201
+ 0.5165245898711028,
2202
+ 1.0285587633410387,
2203
+ 0.39957492597700656
2204
+ ],
2205
+ "timestamp": 4.7
2206
+ },
2207
+ {
2208
+ "step_id": 95,
2209
+ "phase": "transport",
2210
+ "end_effector_pos": [
2211
+ 0.49665825949144504,
2212
+ 0.9889988109048449,
2213
+ 0.39957492597700656
2214
+ ],
2215
+ "end_effector_quat_wxyz": [
2216
+ 1,
2217
+ 0,
2218
+ 0,
2219
+ 0
2220
+ ],
2221
+ "gripper_width": 0.1,
2222
+ "target_object_id": "bedroom_desk_0",
2223
+ "target_object_pos": [
2224
+ 0.49665825949144504,
2225
+ 0.9889988109048449,
2226
+ 0.39957492597700656
2227
+ ],
2228
+ "timestamp": 4.75
2229
+ },
2230
+ {
2231
+ "step_id": 96,
2232
+ "phase": "transport",
2233
+ "end_effector_pos": [
2234
+ 0.4767919291117872,
2235
+ 0.9494388584686511,
2236
+ 0.39957492597700656
2237
+ ],
2238
+ "end_effector_quat_wxyz": [
2239
+ 1,
2240
+ 0,
2241
+ 0,
2242
+ 0
2243
+ ],
2244
+ "gripper_width": 0.1,
2245
+ "target_object_id": "bedroom_desk_0",
2246
+ "target_object_pos": [
2247
+ 0.4767919291117872,
2248
+ 0.9494388584686511,
2249
+ 0.39957492597700656
2250
+ ],
2251
+ "timestamp": 4.8
2252
+ },
2253
+ {
2254
+ "step_id": 97,
2255
+ "phase": "transport",
2256
+ "end_effector_pos": [
2257
+ 0.45692559873212946,
2258
+ 0.9098789060324574,
2259
+ 0.39957492597700656
2260
+ ],
2261
+ "end_effector_quat_wxyz": [
2262
+ 1,
2263
+ 0,
2264
+ 0,
2265
+ 0
2266
+ ],
2267
+ "gripper_width": 0.1,
2268
+ "target_object_id": "bedroom_desk_0",
2269
+ "target_object_pos": [
2270
+ 0.45692559873212946,
2271
+ 0.9098789060324574,
2272
+ 0.39957492597700656
2273
+ ],
2274
+ "timestamp": 4.85
2275
+ },
2276
+ {
2277
+ "step_id": 98,
2278
+ "phase": "transport",
2279
+ "end_effector_pos": [
2280
+ 0.4370592683524716,
2281
+ 0.8703189535962635,
2282
+ 0.39957492597700656
2283
+ ],
2284
+ "end_effector_quat_wxyz": [
2285
+ 1,
2286
+ 0,
2287
+ 0,
2288
+ 0
2289
+ ],
2290
+ "gripper_width": 0.1,
2291
+ "target_object_id": "bedroom_desk_0",
2292
+ "target_object_pos": [
2293
+ 0.4370592683524716,
2294
+ 0.8703189535962635,
2295
+ 0.39957492597700656
2296
+ ],
2297
+ "timestamp": 4.9
2298
+ },
2299
+ {
2300
+ "step_id": 99,
2301
+ "phase": "transport",
2302
+ "end_effector_pos": [
2303
+ 0.4171929379728138,
2304
+ 0.8307590011600697,
2305
+ 0.39957492597700656
2306
+ ],
2307
+ "end_effector_quat_wxyz": [
2308
+ 1,
2309
+ 0,
2310
+ 0,
2311
+ 0
2312
+ ],
2313
+ "gripper_width": 0.1,
2314
+ "target_object_id": "bedroom_desk_0",
2315
+ "target_object_pos": [
2316
+ 0.4171929379728138,
2317
+ 0.8307590011600697,
2318
+ 0.39957492597700656
2319
+ ],
2320
+ "timestamp": 4.95
2321
+ },
2322
+ {
2323
+ "step_id": 100,
2324
+ "phase": "transport",
2325
+ "end_effector_pos": [
2326
+ 0.397326607593156,
2327
+ 0.7911990487238759,
2328
+ 0.39957492597700656
2329
+ ],
2330
+ "end_effector_quat_wxyz": [
2331
+ 1,
2332
+ 0,
2333
+ 0,
2334
+ 0
2335
+ ],
2336
+ "gripper_width": 0.1,
2337
+ "target_object_id": "bedroom_desk_0",
2338
+ "target_object_pos": [
2339
+ 0.397326607593156,
2340
+ 0.7911990487238759,
2341
+ 0.39957492597700656
2342
+ ],
2343
+ "timestamp": 5.0
2344
+ },
2345
+ {
2346
+ "step_id": 101,
2347
+ "phase": "transport",
2348
+ "end_effector_pos": [
2349
+ 0.37746027721349823,
2350
+ 0.7516390962876821,
2351
+ 0.39957492597700656
2352
+ ],
2353
+ "end_effector_quat_wxyz": [
2354
+ 1,
2355
+ 0,
2356
+ 0,
2357
+ 0
2358
+ ],
2359
+ "gripper_width": 0.1,
2360
+ "target_object_id": "bedroom_desk_0",
2361
+ "target_object_pos": [
2362
+ 0.37746027721349823,
2363
+ 0.7516390962876821,
2364
+ 0.39957492597700656
2365
+ ],
2366
+ "timestamp": 5.05
2367
+ },
2368
+ {
2369
+ "step_id": 102,
2370
+ "phase": "transport",
2371
+ "end_effector_pos": [
2372
+ 0.3575939468338404,
2373
+ 0.7120791438514883,
2374
+ 0.39957492597700656
2375
+ ],
2376
+ "end_effector_quat_wxyz": [
2377
+ 1,
2378
+ 0,
2379
+ 0,
2380
+ 0
2381
+ ],
2382
+ "gripper_width": 0.1,
2383
+ "target_object_id": "bedroom_desk_0",
2384
+ "target_object_pos": [
2385
+ 0.3575939468338404,
2386
+ 0.7120791438514883,
2387
+ 0.39957492597700656
2388
+ ],
2389
+ "timestamp": 5.1
2390
+ },
2391
+ {
2392
+ "step_id": 103,
2393
+ "phase": "transport",
2394
+ "end_effector_pos": [
2395
+ 0.33772761645418264,
2396
+ 0.6725191914152946,
2397
+ 0.39957492597700656
2398
+ ],
2399
+ "end_effector_quat_wxyz": [
2400
+ 1,
2401
+ 0,
2402
+ 0,
2403
+ 0
2404
+ ],
2405
+ "gripper_width": 0.1,
2406
+ "target_object_id": "bedroom_desk_0",
2407
+ "target_object_pos": [
2408
+ 0.33772761645418264,
2409
+ 0.6725191914152946,
2410
+ 0.39957492597700656
2411
+ ],
2412
+ "timestamp": 5.15
2413
+ },
2414
+ {
2415
+ "step_id": 104,
2416
+ "phase": "transport",
2417
+ "end_effector_pos": [
2418
+ 0.31786128607452485,
2419
+ 0.6329592389791008,
2420
+ 0.39957492597700656
2421
+ ],
2422
+ "end_effector_quat_wxyz": [
2423
+ 1,
2424
+ 0,
2425
+ 0,
2426
+ 0
2427
+ ],
2428
+ "gripper_width": 0.1,
2429
+ "target_object_id": "bedroom_desk_0",
2430
+ "target_object_pos": [
2431
+ 0.31786128607452485,
2432
+ 0.6329592389791008,
2433
+ 0.39957492597700656
2434
+ ],
2435
+ "timestamp": 5.2
2436
+ },
2437
+ {
2438
+ "step_id": 105,
2439
+ "phase": "transport",
2440
+ "end_effector_pos": [
2441
+ 0.297994955694867,
2442
+ 0.593399286542907,
2443
+ 0.39957492597700656
2444
+ ],
2445
+ "end_effector_quat_wxyz": [
2446
+ 1,
2447
+ 0,
2448
+ 0,
2449
+ 0
2450
+ ],
2451
+ "gripper_width": 0.1,
2452
+ "target_object_id": "bedroom_desk_0",
2453
+ "target_object_pos": [
2454
+ 0.297994955694867,
2455
+ 0.593399286542907,
2456
+ 0.39957492597700656
2457
+ ],
2458
+ "timestamp": 5.25
2459
+ },
2460
+ {
2461
+ "step_id": 106,
2462
+ "phase": "transport",
2463
+ "end_effector_pos": [
2464
+ 0.2781286253152092,
2465
+ 0.5538393341067132,
2466
+ 0.39957492597700656
2467
+ ],
2468
+ "end_effector_quat_wxyz": [
2469
+ 1,
2470
+ 0,
2471
+ 0,
2472
+ 0
2473
+ ],
2474
+ "gripper_width": 0.1,
2475
+ "target_object_id": "bedroom_desk_0",
2476
+ "target_object_pos": [
2477
+ 0.2781286253152092,
2478
+ 0.5538393341067132,
2479
+ 0.39957492597700656
2480
+ ],
2481
+ "timestamp": 5.3
2482
+ },
2483
+ {
2484
+ "step_id": 107,
2485
+ "phase": "transport",
2486
+ "end_effector_pos": [
2487
+ 0.2582622949355514,
2488
+ 0.5142793816705193,
2489
+ 0.39957492597700656
2490
+ ],
2491
+ "end_effector_quat_wxyz": [
2492
+ 1,
2493
+ 0,
2494
+ 0,
2495
+ 0
2496
+ ],
2497
+ "gripper_width": 0.1,
2498
+ "target_object_id": "bedroom_desk_0",
2499
+ "target_object_pos": [
2500
+ 0.2582622949355514,
2501
+ 0.5142793816705193,
2502
+ 0.39957492597700656
2503
+ ],
2504
+ "timestamp": 5.35
2505
+ },
2506
+ {
2507
+ "step_id": 108,
2508
+ "phase": "transport",
2509
+ "end_effector_pos": [
2510
+ 0.23839596455589362,
2511
+ 0.47471942923432553,
2512
+ 0.39957492597700656
2513
+ ],
2514
+ "end_effector_quat_wxyz": [
2515
+ 1,
2516
+ 0,
2517
+ 0,
2518
+ 0
2519
+ ],
2520
+ "gripper_width": 0.1,
2521
+ "target_object_id": "bedroom_desk_0",
2522
+ "target_object_pos": [
2523
+ 0.23839596455589362,
2524
+ 0.47471942923432553,
2525
+ 0.39957492597700656
2526
+ ],
2527
+ "timestamp": 5.4
2528
+ },
2529
+ {
2530
+ "step_id": 109,
2531
+ "phase": "transport",
2532
+ "end_effector_pos": [
2533
+ 0.21852963417623583,
2534
+ 0.4351594767981317,
2535
+ 0.39957492597700656
2536
+ ],
2537
+ "end_effector_quat_wxyz": [
2538
+ 1,
2539
+ 0,
2540
+ 0,
2541
+ 0
2542
+ ],
2543
+ "gripper_width": 0.1,
2544
+ "target_object_id": "bedroom_desk_0",
2545
+ "target_object_pos": [
2546
+ 0.21852963417623583,
2547
+ 0.4351594767981317,
2548
+ 0.39957492597700656
2549
+ ],
2550
+ "timestamp": 5.45
2551
+ },
2552
+ {
2553
+ "step_id": 110,
2554
+ "phase": "transport",
2555
+ "end_effector_pos": [
2556
+ 0.19866330379657804,
2557
+ 0.3955995243619379,
2558
+ 0.39957492597700656
2559
+ ],
2560
+ "end_effector_quat_wxyz": [
2561
+ 1,
2562
+ 0,
2563
+ 0,
2564
+ 0
2565
+ ],
2566
+ "gripper_width": 0.1,
2567
+ "target_object_id": "bedroom_desk_0",
2568
+ "target_object_pos": [
2569
+ 0.19866330379657804,
2570
+ 0.3955995243619379,
2571
+ 0.39957492597700656
2572
+ ],
2573
+ "timestamp": 5.5
2574
+ },
2575
+ {
2576
+ "step_id": 111,
2577
+ "phase": "transport",
2578
+ "end_effector_pos": [
2579
+ 0.17879697341692025,
2580
+ 0.3560395719257441,
2581
+ 0.39957492597700656
2582
+ ],
2583
+ "end_effector_quat_wxyz": [
2584
+ 1,
2585
+ 0,
2586
+ 0,
2587
+ 0
2588
+ ],
2589
+ "gripper_width": 0.1,
2590
+ "target_object_id": "bedroom_desk_0",
2591
+ "target_object_pos": [
2592
+ 0.17879697341692025,
2593
+ 0.3560395719257441,
2594
+ 0.39957492597700656
2595
+ ],
2596
+ "timestamp": 5.55
2597
+ },
2598
+ {
2599
+ "step_id": 112,
2600
+ "phase": "transport",
2601
+ "end_effector_pos": [
2602
+ 0.15893064303726234,
2603
+ 0.3164796194895503,
2604
+ 0.39957492597700656
2605
+ ],
2606
+ "end_effector_quat_wxyz": [
2607
+ 1,
2608
+ 0,
2609
+ 0,
2610
+ 0
2611
+ ],
2612
+ "gripper_width": 0.1,
2613
+ "target_object_id": "bedroom_desk_0",
2614
+ "target_object_pos": [
2615
+ 0.15893064303726234,
2616
+ 0.3164796194895503,
2617
+ 0.39957492597700656
2618
+ ],
2619
+ "timestamp": 5.6
2620
+ },
2621
+ {
2622
+ "step_id": 113,
2623
+ "phase": "transport",
2624
+ "end_effector_pos": [
2625
+ 0.13906431265760466,
2626
+ 0.2769196670533567,
2627
+ 0.39957492597700656
2628
+ ],
2629
+ "end_effector_quat_wxyz": [
2630
+ 1,
2631
+ 0,
2632
+ 0,
2633
+ 0
2634
+ ],
2635
+ "gripper_width": 0.1,
2636
+ "target_object_id": "bedroom_desk_0",
2637
+ "target_object_pos": [
2638
+ 0.13906431265760466,
2639
+ 0.2769196670533567,
2640
+ 0.39957492597700656
2641
+ ],
2642
+ "timestamp": 5.65
2643
+ },
2644
+ {
2645
+ "step_id": 114,
2646
+ "phase": "transport",
2647
+ "end_effector_pos": [
2648
+ 0.11919798227794687,
2649
+ 0.23735971461716288,
2650
+ 0.39957492597700656
2651
+ ],
2652
+ "end_effector_quat_wxyz": [
2653
+ 1,
2654
+ 0,
2655
+ 0,
2656
+ 0
2657
+ ],
2658
+ "gripper_width": 0.1,
2659
+ "target_object_id": "bedroom_desk_0",
2660
+ "target_object_pos": [
2661
+ 0.11919798227794687,
2662
+ 0.23735971461716288,
2663
+ 0.39957492597700656
2664
+ ],
2665
+ "timestamp": 5.7
2666
+ },
2667
+ {
2668
+ "step_id": 115,
2669
+ "phase": "transport",
2670
+ "end_effector_pos": [
2671
+ 0.09933165189828896,
2672
+ 0.19779976218096906,
2673
+ 0.39957492597700656
2674
+ ],
2675
+ "end_effector_quat_wxyz": [
2676
+ 1,
2677
+ 0,
2678
+ 0,
2679
+ 0
2680
+ ],
2681
+ "gripper_width": 0.1,
2682
+ "target_object_id": "bedroom_desk_0",
2683
+ "target_object_pos": [
2684
+ 0.09933165189828896,
2685
+ 0.19779976218096906,
2686
+ 0.39957492597700656
2687
+ ],
2688
+ "timestamp": 5.75
2689
+ },
2690
+ {
2691
+ "step_id": 116,
2692
+ "phase": "transport",
2693
+ "end_effector_pos": [
2694
+ 0.07946532151863117,
2695
+ 0.15823980974477525,
2696
+ 0.39957492597700656
2697
+ ],
2698
+ "end_effector_quat_wxyz": [
2699
+ 1,
2700
+ 0,
2701
+ 0,
2702
+ 0
2703
+ ],
2704
+ "gripper_width": 0.1,
2705
+ "target_object_id": "bedroom_desk_0",
2706
+ "target_object_pos": [
2707
+ 0.07946532151863117,
2708
+ 0.15823980974477525,
2709
+ 0.39957492597700656
2710
+ ],
2711
+ "timestamp": 5.8
2712
+ },
2713
+ {
2714
+ "step_id": 117,
2715
+ "phase": "transport",
2716
+ "end_effector_pos": [
2717
+ 0.05959899113897338,
2718
+ 0.11867985730858122,
2719
+ 0.39957492597700656
2720
+ ],
2721
+ "end_effector_quat_wxyz": [
2722
+ 1,
2723
+ 0,
2724
+ 0,
2725
+ 0
2726
+ ],
2727
+ "gripper_width": 0.1,
2728
+ "target_object_id": "bedroom_desk_0",
2729
+ "target_object_pos": [
2730
+ 0.05959899113897338,
2731
+ 0.11867985730858122,
2732
+ 0.39957492597700656
2733
+ ],
2734
+ "timestamp": 5.85
2735
+ },
2736
+ {
2737
+ "step_id": 118,
2738
+ "phase": "transport",
2739
+ "end_effector_pos": [
2740
+ 0.039732660759315586,
2741
+ 0.07911990487238763,
2742
+ 0.39957492597700656
2743
+ ],
2744
+ "end_effector_quat_wxyz": [
2745
+ 1,
2746
+ 0,
2747
+ 0,
2748
+ 0
2749
+ ],
2750
+ "gripper_width": 0.1,
2751
+ "target_object_id": "bedroom_desk_0",
2752
+ "target_object_pos": [
2753
+ 0.039732660759315586,
2754
+ 0.07911990487238763,
2755
+ 0.39957492597700656
2756
+ ],
2757
+ "timestamp": 5.9
2758
+ },
2759
+ {
2760
+ "step_id": 119,
2761
+ "phase": "transport",
2762
+ "end_effector_pos": [
2763
+ 0.019866330379657793,
2764
+ 0.03955995243619381,
2765
+ 0.39957492597700656
2766
+ ],
2767
+ "end_effector_quat_wxyz": [
2768
+ 1,
2769
+ 0,
2770
+ 0,
2771
+ 0
2772
+ ],
2773
+ "gripper_width": 0.1,
2774
+ "target_object_id": "bedroom_desk_0",
2775
+ "target_object_pos": [
2776
+ 0.019866330379657793,
2777
+ 0.03955995243619381,
2778
+ 0.39957492597700656
2779
+ ],
2780
+ "timestamp": 5.95
2781
+ },
2782
+ {
2783
+ "step_id": 120,
2784
+ "phase": "place",
2785
+ "end_effector_pos": [
2786
+ 0.0,
2787
+ 0.0,
2788
+ 0.39957492597700656
2789
+ ],
2790
+ "end_effector_quat_wxyz": [
2791
+ 1,
2792
+ 0,
2793
+ 0,
2794
+ 0
2795
+ ],
2796
+ "gripper_width": 0.1,
2797
+ "target_object_id": "bedroom_desk_0",
2798
+ "target_object_pos": [
2799
+ 0.0,
2800
+ 0.0,
2801
+ 0.39957492597700656
2802
+ ],
2803
+ "timestamp": 6.0
2804
+ },
2805
+ {
2806
+ "step_id": 121,
2807
+ "phase": "place",
2808
+ "end_effector_pos": [
2809
+ 0.0,
2810
+ 0.0,
2811
+ 0.39057492597700655
2812
+ ],
2813
+ "end_effector_quat_wxyz": [
2814
+ 1,
2815
+ 0,
2816
+ 0,
2817
+ 0
2818
+ ],
2819
+ "gripper_width": 0.1,
2820
+ "target_object_id": "bedroom_desk_0",
2821
+ "target_object_pos": [
2822
+ 0.0,
2823
+ 0.0,
2824
+ 0.38457492597700654
2825
+ ],
2826
+ "timestamp": 6.05
2827
+ },
2828
+ {
2829
+ "step_id": 122,
2830
+ "phase": "place",
2831
+ "end_effector_pos": [
2832
+ 0.0,
2833
+ 0.0,
2834
+ 0.38157492597700654
2835
+ ],
2836
+ "end_effector_quat_wxyz": [
2837
+ 1,
2838
+ 0,
2839
+ 0,
2840
+ 0
2841
+ ],
2842
+ "gripper_width": 0.1,
2843
+ "target_object_id": "bedroom_desk_0",
2844
+ "target_object_pos": [
2845
+ 0.0,
2846
+ 0.0,
2847
+ 0.3695749259770066
2848
+ ],
2849
+ "timestamp": 6.1
2850
+ },
2851
+ {
2852
+ "step_id": 123,
2853
+ "phase": "place",
2854
+ "end_effector_pos": [
2855
+ 0.0,
2856
+ 0.0,
2857
+ 0.37257492597700653
2858
+ ],
2859
+ "end_effector_quat_wxyz": [
2860
+ 1,
2861
+ 0,
2862
+ 0,
2863
+ 0
2864
+ ],
2865
+ "gripper_width": 0.1,
2866
+ "target_object_id": "bedroom_desk_0",
2867
+ "target_object_pos": [
2868
+ 0.0,
2869
+ 0.0,
2870
+ 0.35457492597700657
2871
+ ],
2872
+ "timestamp": 6.15
2873
+ },
2874
+ {
2875
+ "step_id": 124,
2876
+ "phase": "place",
2877
+ "end_effector_pos": [
2878
+ 0.0,
2879
+ 0.0,
2880
+ 0.3635749259770066
2881
+ ],
2882
+ "end_effector_quat_wxyz": [
2883
+ 1,
2884
+ 0,
2885
+ 0,
2886
+ 0
2887
+ ],
2888
+ "gripper_width": 0.1,
2889
+ "target_object_id": "bedroom_desk_0",
2890
+ "target_object_pos": [
2891
+ 0.0,
2892
+ 0.0,
2893
+ 0.33957492597700656
2894
+ ],
2895
+ "timestamp": 6.2
2896
+ },
2897
+ {
2898
+ "step_id": 125,
2899
+ "phase": "place",
2900
+ "end_effector_pos": [
2901
+ 0.0,
2902
+ 0.0,
2903
+ 0.35457492597700657
2904
+ ],
2905
+ "end_effector_quat_wxyz": [
2906
+ 1,
2907
+ 0,
2908
+ 0,
2909
+ 0
2910
+ ],
2911
+ "gripper_width": 0.1,
2912
+ "target_object_id": "bedroom_desk_0",
2913
+ "target_object_pos": [
2914
+ 0.0,
2915
+ 0.0,
2916
+ 0.32457492597700655
2917
+ ],
2918
+ "timestamp": 6.25
2919
+ },
2920
+ {
2921
+ "step_id": 126,
2922
+ "phase": "place",
2923
+ "end_effector_pos": [
2924
+ 0.0,
2925
+ 0.0,
2926
+ 0.34557492597700656
2927
+ ],
2928
+ "end_effector_quat_wxyz": [
2929
+ 1,
2930
+ 0,
2931
+ 0,
2932
+ 0
2933
+ ],
2934
+ "gripper_width": 0.1,
2935
+ "target_object_id": "bedroom_desk_0",
2936
+ "target_object_pos": [
2937
+ 0.0,
2938
+ 0.0,
2939
+ 0.30957492597700653
2940
+ ],
2941
+ "timestamp": 6.3
2942
+ },
2943
+ {
2944
+ "step_id": 127,
2945
+ "phase": "place",
2946
+ "end_effector_pos": [
2947
+ 0.0,
2948
+ 0.0,
2949
+ 0.33657492597700656
2950
+ ],
2951
+ "end_effector_quat_wxyz": [
2952
+ 1,
2953
+ 0,
2954
+ 0,
2955
+ 0
2956
+ ],
2957
+ "gripper_width": 0.1,
2958
+ "target_object_id": "bedroom_desk_0",
2959
+ "target_object_pos": [
2960
+ 0.0,
2961
+ 0.0,
2962
+ 0.2945749259770066
2963
+ ],
2964
+ "timestamp": 6.35
2965
+ },
2966
+ {
2967
+ "step_id": 128,
2968
+ "phase": "place",
2969
+ "end_effector_pos": [
2970
+ 0.0,
2971
+ 0.0,
2972
+ 0.32757492597700655
2973
+ ],
2974
+ "end_effector_quat_wxyz": [
2975
+ 1,
2976
+ 0,
2977
+ 0,
2978
+ 0
2979
+ ],
2980
+ "gripper_width": 0.1,
2981
+ "target_object_id": "bedroom_desk_0",
2982
+ "target_object_pos": [
2983
+ 0.0,
2984
+ 0.0,
2985
+ 0.27957492597700656
2986
+ ],
2987
+ "timestamp": 6.4
2988
+ },
2989
+ {
2990
+ "step_id": 129,
2991
+ "phase": "place",
2992
+ "end_effector_pos": [
2993
+ 0.0,
2994
+ 0.0,
2995
+ 0.31857492597700654
2996
+ ],
2997
+ "end_effector_quat_wxyz": [
2998
+ 1,
2999
+ 0,
3000
+ 0,
3001
+ 0
3002
+ ],
3003
+ "gripper_width": 0.1,
3004
+ "target_object_id": "bedroom_desk_0",
3005
+ "target_object_pos": [
3006
+ 0.0,
3007
+ 0.0,
3008
+ 0.26457492597700655
3009
+ ],
3010
+ "timestamp": 6.45
3011
+ },
3012
+ {
3013
+ "step_id": 130,
3014
+ "phase": "place",
3015
+ "end_effector_pos": [
3016
+ 0.0,
3017
+ 0.0,
3018
+ 0.30957492597700653
3019
+ ],
3020
+ "end_effector_quat_wxyz": [
3021
+ 1,
3022
+ 0,
3023
+ 0,
3024
+ 0
3025
+ ],
3026
+ "gripper_width": 0.1,
3027
+ "target_object_id": "bedroom_desk_0",
3028
+ "target_object_pos": [
3029
+ 0.0,
3030
+ 0.0,
3031
+ 0.24957492597700656
3032
+ ],
3033
+ "timestamp": 6.5
3034
+ },
3035
+ {
3036
+ "step_id": 131,
3037
+ "phase": "place",
3038
+ "end_effector_pos": [
3039
+ 0.0,
3040
+ 0.0,
3041
+ 0.3005749259770065
3042
+ ],
3043
+ "end_effector_quat_wxyz": [
3044
+ 1,
3045
+ 0,
3046
+ 0,
3047
+ 0
3048
+ ],
3049
+ "gripper_width": 0.1,
3050
+ "target_object_id": "bedroom_desk_0",
3051
+ "target_object_pos": [
3052
+ 0.0,
3053
+ 0.0,
3054
+ 0.23457492597700655
3055
+ ],
3056
+ "timestamp": 6.55
3057
+ },
3058
+ {
3059
+ "step_id": 132,
3060
+ "phase": "place",
3061
+ "end_effector_pos": [
3062
+ 0.0,
3063
+ 0.0,
3064
+ 0.29157492597700657
3065
+ ],
3066
+ "end_effector_quat_wxyz": [
3067
+ 1,
3068
+ 0,
3069
+ 0,
3070
+ 0
3071
+ ],
3072
+ "gripper_width": 0.1,
3073
+ "target_object_id": "bedroom_desk_0",
3074
+ "target_object_pos": [
3075
+ 0.0,
3076
+ 0.0,
3077
+ 0.21957492597700656
3078
+ ],
3079
+ "timestamp": 6.6
3080
+ },
3081
+ {
3082
+ "step_id": 133,
3083
+ "phase": "place",
3084
+ "end_effector_pos": [
3085
+ 0.0,
3086
+ 0.0,
3087
+ 0.28257492597700656
3088
+ ],
3089
+ "end_effector_quat_wxyz": [
3090
+ 1,
3091
+ 0,
3092
+ 0,
3093
+ 0
3094
+ ],
3095
+ "gripper_width": 0.1,
3096
+ "target_object_id": "bedroom_desk_0",
3097
+ "target_object_pos": [
3098
+ 0.0,
3099
+ 0.0,
3100
+ 0.20457492597700655
3101
+ ],
3102
+ "timestamp": 6.65
3103
+ },
3104
+ {
3105
+ "step_id": 134,
3106
+ "phase": "place",
3107
+ "end_effector_pos": [
3108
+ 0.0,
3109
+ 0.0,
3110
+ 0.27357492597700656
3111
+ ],
3112
+ "end_effector_quat_wxyz": [
3113
+ 1,
3114
+ 0,
3115
+ 0,
3116
+ 0
3117
+ ],
3118
+ "gripper_width": 0.1,
3119
+ "target_object_id": "bedroom_desk_0",
3120
+ "target_object_pos": [
3121
+ 0.0,
3122
+ 0.0,
3123
+ 0.18957492597700656
3124
+ ],
3125
+ "timestamp": 6.7
3126
+ },
3127
+ {
3128
+ "step_id": 135,
3129
+ "phase": "place",
3130
+ "end_effector_pos": [
3131
+ 0.0,
3132
+ 0.0,
3133
+ 0.26457492597700655
3134
+ ],
3135
+ "end_effector_quat_wxyz": [
3136
+ 1,
3137
+ 0,
3138
+ 0,
3139
+ 0
3140
+ ],
3141
+ "gripper_width": 0.1,
3142
+ "target_object_id": "bedroom_desk_0",
3143
+ "target_object_pos": [
3144
+ 0.0,
3145
+ 0.0,
3146
+ 0.17457492597700658
3147
+ ],
3148
+ "timestamp": 6.75
3149
+ },
3150
+ {
3151
+ "step_id": 136,
3152
+ "phase": "place",
3153
+ "end_effector_pos": [
3154
+ 0.0,
3155
+ 0.0,
3156
+ 0.2555749259770066
3157
+ ],
3158
+ "end_effector_quat_wxyz": [
3159
+ 1,
3160
+ 0,
3161
+ 0,
3162
+ 0
3163
+ ],
3164
+ "gripper_width": 0.1,
3165
+ "target_object_id": "bedroom_desk_0",
3166
+ "target_object_pos": [
3167
+ 0.0,
3168
+ 0.0,
3169
+ 0.15957492597700657
3170
+ ],
3171
+ "timestamp": 6.8
3172
+ },
3173
+ {
3174
+ "step_id": 137,
3175
+ "phase": "place",
3176
+ "end_effector_pos": [
3177
+ 0.0,
3178
+ 0.0,
3179
+ 0.24657492597700656
3180
+ ],
3181
+ "end_effector_quat_wxyz": [
3182
+ 1,
3183
+ 0,
3184
+ 0,
3185
+ 0
3186
+ ],
3187
+ "gripper_width": 0.1,
3188
+ "target_object_id": "bedroom_desk_0",
3189
+ "target_object_pos": [
3190
+ 0.0,
3191
+ 0.0,
3192
+ 0.14457492597700655
3193
+ ],
3194
+ "timestamp": 6.85
3195
+ },
3196
+ {
3197
+ "step_id": 138,
3198
+ "phase": "place",
3199
+ "end_effector_pos": [
3200
+ 0.0,
3201
+ 0.0,
3202
+ 0.23757492597700655
3203
+ ],
3204
+ "end_effector_quat_wxyz": [
3205
+ 1,
3206
+ 0,
3207
+ 0,
3208
+ 0
3209
+ ],
3210
+ "gripper_width": 0.1,
3211
+ "target_object_id": "bedroom_desk_0",
3212
+ "target_object_pos": [
3213
+ 0.0,
3214
+ 0.0,
3215
+ 0.12957492597700654
3216
+ ],
3217
+ "timestamp": 6.9
3218
+ },
3219
+ {
3220
+ "step_id": 139,
3221
+ "phase": "place",
3222
+ "end_effector_pos": [
3223
+ 0.0,
3224
+ 0.0,
3225
+ 0.22857492597700657
3226
+ ],
3227
+ "end_effector_quat_wxyz": [
3228
+ 1,
3229
+ 0,
3230
+ 0,
3231
+ 0
3232
+ ],
3233
+ "gripper_width": 0.1,
3234
+ "target_object_id": "bedroom_desk_0",
3235
+ "target_object_pos": [
3236
+ 0.0,
3237
+ 0.0,
3238
+ 0.11457492597700658
3239
+ ],
3240
+ "timestamp": 6.95
3241
+ },
3242
+ {
3243
+ "step_id": 140,
3244
+ "phase": "release",
3245
+ "end_effector_pos": [
3246
+ 0.0,
3247
+ 0.0,
3248
+ 0.21957492597700656
3249
+ ],
3250
+ "end_effector_quat_wxyz": [
3251
+ 1,
3252
+ 0,
3253
+ 0,
3254
+ 0
3255
+ ],
3256
+ "gripper_width": 0.0,
3257
+ "target_object_id": "bedroom_desk_0",
3258
+ "target_object_pos": [
3259
+ 0.0,
3260
+ 0.0,
3261
+ 0.09957492597700657
3262
+ ],
3263
+ "timestamp": 7.0
3264
+ },
3265
+ {
3266
+ "step_id": 141,
3267
+ "phase": "release",
3268
+ "end_effector_pos": [
3269
+ 0.0,
3270
+ 0.0,
3271
+ 0.21957492597700656
3272
+ ],
3273
+ "end_effector_quat_wxyz": [
3274
+ 1,
3275
+ 0,
3276
+ 0,
3277
+ 0
3278
+ ],
3279
+ "gripper_width": 0.1,
3280
+ "target_object_id": "bedroom_desk_0",
3281
+ "target_object_pos": [
3282
+ 0.0,
3283
+ 0.0,
3284
+ 0.09957492597700657
3285
+ ],
3286
+ "timestamp": 7.05
3287
+ },
3288
+ {
3289
+ "step_id": 142,
3290
+ "phase": "release",
3291
+ "end_effector_pos": [
3292
+ 0.0,
3293
+ 0.0,
3294
+ 0.21957492597700656
3295
+ ],
3296
+ "end_effector_quat_wxyz": [
3297
+ 1,
3298
+ 0,
3299
+ 0,
3300
+ 0
3301
+ ],
3302
+ "gripper_width": 0.2,
3303
+ "target_object_id": "bedroom_desk_0",
3304
+ "target_object_pos": [
3305
+ 0.0,
3306
+ 0.0,
3307
+ 0.09957492597700657
3308
+ ],
3309
+ "timestamp": 7.1
3310
+ },
3311
+ {
3312
+ "step_id": 143,
3313
+ "phase": "release",
3314
+ "end_effector_pos": [
3315
+ 0.0,
3316
+ 0.0,
3317
+ 0.21957492597700656
3318
+ ],
3319
+ "end_effector_quat_wxyz": [
3320
+ 1,
3321
+ 0,
3322
+ 0,
3323
+ 0
3324
+ ],
3325
+ "gripper_width": 0.3,
3326
+ "target_object_id": "bedroom_desk_0",
3327
+ "target_object_pos": [
3328
+ 0.0,
3329
+ 0.0,
3330
+ 0.09957492597700657
3331
+ ],
3332
+ "timestamp": 7.15
3333
+ },
3334
+ {
3335
+ "step_id": 144,
3336
+ "phase": "release",
3337
+ "end_effector_pos": [
3338
+ 0.0,
3339
+ 0.0,
3340
+ 0.21957492597700656
3341
+ ],
3342
+ "end_effector_quat_wxyz": [
3343
+ 1,
3344
+ 0,
3345
+ 0,
3346
+ 0
3347
+ ],
3348
+ "gripper_width": 0.4,
3349
+ "target_object_id": "bedroom_desk_0",
3350
+ "target_object_pos": [
3351
+ 0.0,
3352
+ 0.0,
3353
+ 0.09957492597700657
3354
+ ],
3355
+ "timestamp": 7.2
3356
+ },
3357
+ {
3358
+ "step_id": 145,
3359
+ "phase": "release",
3360
+ "end_effector_pos": [
3361
+ 0.0,
3362
+ 0.0,
3363
+ 0.21957492597700656
3364
+ ],
3365
+ "end_effector_quat_wxyz": [
3366
+ 1,
3367
+ 0,
3368
+ 0,
3369
+ 0
3370
+ ],
3371
+ "gripper_width": 0.5,
3372
+ "target_object_id": "bedroom_desk_0",
3373
+ "target_object_pos": [
3374
+ 0.0,
3375
+ 0.0,
3376
+ 0.09957492597700657
3377
+ ],
3378
+ "timestamp": 7.25
3379
+ },
3380
+ {
3381
+ "step_id": 146,
3382
+ "phase": "release",
3383
+ "end_effector_pos": [
3384
+ 0.0,
3385
+ 0.0,
3386
+ 0.21957492597700656
3387
+ ],
3388
+ "end_effector_quat_wxyz": [
3389
+ 1,
3390
+ 0,
3391
+ 0,
3392
+ 0
3393
+ ],
3394
+ "gripper_width": 0.6,
3395
+ "target_object_id": "bedroom_desk_0",
3396
+ "target_object_pos": [
3397
+ 0.0,
3398
+ 0.0,
3399
+ 0.09957492597700657
3400
+ ],
3401
+ "timestamp": 7.3
3402
+ },
3403
+ {
3404
+ "step_id": 147,
3405
+ "phase": "release",
3406
+ "end_effector_pos": [
3407
+ 0.0,
3408
+ 0.0,
3409
+ 0.21957492597700656
3410
+ ],
3411
+ "end_effector_quat_wxyz": [
3412
+ 1,
3413
+ 0,
3414
+ 0,
3415
+ 0
3416
+ ],
3417
+ "gripper_width": 0.7,
3418
+ "target_object_id": "bedroom_desk_0",
3419
+ "target_object_pos": [
3420
+ 0.0,
3421
+ 0.0,
3422
+ 0.09957492597700657
3423
+ ],
3424
+ "timestamp": 7.35
3425
+ },
3426
+ {
3427
+ "step_id": 148,
3428
+ "phase": "release",
3429
+ "end_effector_pos": [
3430
+ 0.0,
3431
+ 0.0,
3432
+ 0.21957492597700656
3433
+ ],
3434
+ "end_effector_quat_wxyz": [
3435
+ 1,
3436
+ 0,
3437
+ 0,
3438
+ 0
3439
+ ],
3440
+ "gripper_width": 0.8,
3441
+ "target_object_id": "bedroom_desk_0",
3442
+ "target_object_pos": [
3443
+ 0.0,
3444
+ 0.0,
3445
+ 0.09957492597700657
3446
+ ],
3447
+ "timestamp": 7.4
3448
+ },
3449
+ {
3450
+ "step_id": 149,
3451
+ "phase": "release",
3452
+ "end_effector_pos": [
3453
+ 0.0,
3454
+ 0.0,
3455
+ 0.21957492597700656
3456
+ ],
3457
+ "end_effector_quat_wxyz": [
3458
+ 1,
3459
+ 0,
3460
+ 0,
3461
+ 0
3462
+ ],
3463
+ "gripper_width": 0.9,
3464
+ "target_object_id": "bedroom_desk_0",
3465
+ "target_object_pos": [
3466
+ 0.0,
3467
+ 0.0,
3468
+ 0.09957492597700657
3469
+ ],
3470
+ "timestamp": 7.45
3471
+ }
3472
+ ]
3473
+ }
demos/demo_bedroom_wardrobe_to_desk_trajectory.png ADDED

Git LFS Details

  • SHA256: 4965db52e39a661b4d5a15d27ca20d8ab2d95667c253739d44008734fd7629d1
  • Pointer size: 131 Bytes
  • Size of remote file: 249 kB
docs/scene_types_zh.md ADDED
@@ -0,0 +1,186 @@
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
+ # SceneSmith 各类场景说明
2
+
3
+ > 本文档回答:SceneSmith 适合生成哪类场景,机器人能操作什么物体,以及哪些操作不支持。
4
+
5
+ ---
6
+
7
+ ## 1. 桌面场景(Tabletop Manipulation)
8
+
9
+ **最适合 SceneSmith 的场景类型**。
10
+
11
+ ### 能生成什么
12
+
13
+ 通过 `manipuland_agent` 可以在桌面上放置:
14
+
15
+ | 类别 | 具体物体 |
16
+ |------|---------|
17
+ | 食物/水果 | 苹果、橙子、香蕉、面包 |
18
+ | 餐具 | 盘子、碗、杯子、刀叉 |
19
+ | 文具 | 书本、笔记本、钢笔、尺子 |
20
+ | 电子产品 | 手机、遥控器、鼠标 |
21
+ | 装饰品 | 花瓶、小雕像、相框 |
22
+ | 组合体 | 装了水果的碗、叠放的书 |
23
+
24
+ ### 怎么生成桌面场景
25
+
26
+ ```
27
+ scene_prompt: "A kitchen counter with a wooden cutting board,
28
+ a ceramic bowl filled with apples and oranges, a glass of water,
29
+ a butter knife, and a small herb plant pot."
30
+ ```
31
+
32
+ 关键配置:`manipuland_agent` 会自动分析每件家具的支撑面,在支撑面上生成小物件。
33
+
34
+ ### 抓取可行性
35
+
36
+ 每个 manipuland 的 SDF 包含:
37
+ - 精确的碰撞几何体(VHACD 近似凸分解)
38
+ - 质量 + 摩擦系数
39
+ - 完整的 bounding box
40
+
41
+ 可以用 `policy_interface.py` 获取抓取目标位姿:
42
+ ```bash
43
+ python scripts/robot_eval/policy_interface.py \
44
+ --task "Pick the apple from the bowl and place it on the plate" \
45
+ --scene-state outputs/.../house_state.json \
46
+ --dmd outputs/.../house.dmd.yaml
47
+ ```
48
+
49
+ ---
50
+
51
+ ## 2. 柔性物体(Deformable Objects)
52
+
53
+ **SceneSmith 不支持**。
54
+
55
+ ### 原因
56
+
57
+ SceneSmith 的整个 pipeline 基于**刚体假设**:
58
+ - Drake 仿真:刚体多体动力学
59
+ - SDF 格式:刚体碰撞几何
60
+ - VHACD 分解:只适用于刚体
61
+
62
+ 柔性物体(布料、毛绒玩具、橡皮泥)需要:
63
+ - FEM (Finite Element Method) 求解器
64
+ - 粒子系统
65
+ - 布料仿真(Position-Based Dynamics 等)
66
+
67
+ ### 变通方案
68
+
69
+ 1. 用 SceneSmith 生成**刚体背景场景**(桌子、椅子、柜子)
70
+ 2. 用 `scripts/export_scene_to_mujoco.py` 转换为 MuJoCo XML
71
+ 3. 在 MuJoCo 中用 `composite` 元素添加布料
72
+ 4. 或在 Isaac Sim 中用 FEM solver 添加柔性物体
73
+
74
+ ---
75
+
76
+ ## 3. 流体(Fluid / Liquid)
77
+
78
+ **SceneSmith 不支持**。
79
+
80
+ ### 原因
81
+
82
+ 同上,Drake 不包含流体仿真。`house.dmd.yaml` 只有刚体 Directives。
83
+
84
+ "倒水"这类任务需要:
85
+ - SPH (Smoothed Particle Hydrodynamics)
86
+ - FLIP Fluid
87
+ - FluidLab、Taichi Physics 等
88
+
89
+ ### 变通方案
90
+
91
+ 1. 用 SceneSmith 生成**杯子、瓶子的几何体**(SDF包含容器形状)
92
+ 2. 将容器几何体导入 FluidLab / Taichi
93
+ 3. 在流体仿真器中加入液体粒子
94
+
95
+ 注意:SceneSmith 生成的杯子是**视觉上的外壳**,不一定有精确的内部空腔几何体用于流体边界。
96
+
97
+ ---
98
+
99
+ ## 4. 常见场景类型
100
+
101
+ SceneSmith 论文中验证过的场景类型:
102
+
103
+ | 场景 | 典型任务 | 特点 |
104
+ |------|---------|------|
105
+ | 卧室 | 整理床头柜、拿取衣物 | 床、衣柜等大件家具 + 小件 |
106
+ | 厨房 | pick-and-place 食物 | 橱柜、水果、厨具,最适合操作 |
107
+ | 客厅 | 整理茶几 | 沙发、书架、遥控器、书本 |
108
+ | 办公室 | 文具整理、拿取文件 | 桌面小物件最丰富 |
109
+ | 社区中心 | 多人活动场景 | 乒乓球桌、椅子等 |
110
+
111
+ ### 最适合操作的场景
112
+
113
+ **厨房** 和 **办公桌** 是操作任务密度最高的:
114
+ - 物体种类多(水果、餐具、文具)
115
+ - 桌面支撑面大
116
+ - 物体尺寸适合抓取(0.05m ~ 0.3m)
117
+
118
+ ### 提示词技巧
119
+
120
+ - **明确指定物体**:"with a red apple, a ceramic plate, and a glass of water" 比 "with food" 更好
121
+ - **指定初始状态**:"apple is on the counter, not on the plate" 避免场景自动把任务solve了
122
+ - **避免过于复杂**:单个房间建议 5-10 个 manipuland,太多会让 agent 超时
123
+
124
+ ---
125
+
126
+ ## 5. Demo采集(Demonstration Collection)
127
+
128
+ ### 当前能力(本次实现)
129
+
130
+ 本次实现了基于 SceneSmith 输出的 **脚本化 demo 采集**:
131
+
132
+ ```
133
+ SceneSmith 场景 → policy_interface → 目标位姿
134
+
135
+ 几何轨迹规划(home→approach→grasp→lift→transport→place)
136
+
137
+ demo JSON + 轨迹可视化 PNG
138
+ ```
139
+
140
+ **产出**:
141
+ - `demo_*.json`:完整轨迹(每步 50ms,包含 EE 位姿 + 夹爪宽度)
142
+ - `demo_*_trajectory.png`:4子图可视化
143
+
144
+ ### 真实 Demo 采集的正确方案
145
+
146
+ SceneSmith 官方没有提供 demo 采集代码。正确路径是:
147
+
148
+ ```
149
+ 1. python scripts/robot_eval/policy_interface.py → 获取目标位姿
150
+
151
+ 2. 加载场景到仿真器:
152
+ drake_sim = load_scene(house.dmd.yaml) # 或 MuJoCo/Isaac
153
+
154
+ 3. 加入 robot URDF(如 Franka Panda):
155
+ drake_sim.add_robot("franka_panda.urdf", base_pose)
156
+
157
+ 4. 运行 controller:
158
+ - scripted: 几何规划(本次实现的方式)
159
+ - teleop: 人工示教
160
+ - policy rollout: 用已有 policy 采样
161
+
162
+ 5. 记录每步 (obs, action) → dataset
163
+
164
+ 6. python scripts/robot_eval/validate.py → 验证 success
165
+ ```
166
+
167
+ ### Demo 数据格式(与主流兼容)
168
+
169
+ 本次采集的 JSON 格式可以直接转换为:
170
+ - **RLDS (tensorflow_datasets)**:`(observation, action, reward, discount)` 格式
171
+ - **LeRobot**:`lerobot` 库的 episode 格式
172
+ - **HDF5**:标准 robot learning 数据格式
173
+
174
+ 转换示例:
175
+ ```python
176
+ import json
177
+ import numpy as np
178
+
179
+ with open("demo_bedroom_nightstand_to_desk.json") as f:
180
+ demo = json.load(f)
181
+
182
+ # 转换为 numpy arrays
183
+ ee_traj = np.array([s["end_effector_pos"] for s in demo["trajectory"]])
184
+ gripper = np.array([s["gripper_width"] for s in demo["trajectory"]])
185
+ # shape: (150, 3) and (150,)
186
+ ```
scenes/scene_01_bedroom/README.md ADDED
@@ -0,0 +1,54 @@
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
+ # Scene 01: Bedroom(卧室)
2
+
3
+ **提示词**:
4
+ > A cozy bedroom with a queen bed against the wall, two nightstands with lamps, a wardrobe in the corner, and a small desk with a chair near the window.
5
+
6
+ **运行时间**: 1小时57分钟 | **GPU**: NVIDIA L40S 48GB | **Backend**: Hunyuan3D-2
7
+
8
+ ## 生成物体
9
+
10
+ | 物体 ID | 类型 | 位置 (x, y, z) |
11
+ |---------|------|---------------|
12
+ | desk_0 | furniture | (0.79, 1.58, 0.0) |
13
+ | nightstand_0 | furniture | (-0.55, -1.73, 0.0) |
14
+ | nightstand_1 | furniture | (0.62, -1.73, 0.0) |
15
+ | rug_0 | furniture | (-0.01, -0.39, 0.0) |
16
+ | wardrobe_0 | furniture | (2.06, -1.53, 0.0) |
17
+ | north/south/east/west walls | wall | — |
18
+
19
+ ## 渲染图像(各阶段)
20
+
21
+ | 阶段 | 图像 |
22
+ |------|------|
23
+ | 平面图 | `renders/floor_plan.png` |
24
+ | 家具布局(俯视) | `renders/furniture_top.png` |
25
+ | 家具布局(侧视 0-3) | `renders/furniture_side*.png` |
26
+ | 墙面装饰(俯视) | `renders/wall_top.png` |
27
+ | 墙面(北墙正交) | `renders/wall_north.png` |
28
+ | 天花板 | `renders/ceiling_top.png` |
29
+
30
+ ## 飞行视频
31
+
32
+ `flythrough.mp4` — 120帧,1280×720,24fps,5秒环绕飞行
33
+
34
+ ## 仿真文件
35
+
36
+ - `sim_files/house_state.json` — 所有物体元数据(位姿、bbox、SDF路径)
37
+ - `sim_files/house.dmd.yaml` — Drake Directives,可直接加载到 Drake 仿真
38
+
39
+ ## 加载到 Drake
40
+
41
+ ```python
42
+ from scenesmith.robot_eval.dmd_scene import load_scene_for_validation
43
+ from pathlib import Path
44
+
45
+ scene = load_scene_for_validation(
46
+ scene_state_path=Path("sim_files/house_state.json"),
47
+ dmd_path=Path("sim_files/house.dmd.yaml"),
48
+ )
49
+ scene.finalize()
50
+
51
+ # 查询物体位姿
52
+ pose = scene.get_object_pose("bedroom_desk_0")
53
+ print(pose.translation()) # [0.79, 1.58, 0.0]
54
+ ```
scenes/scene_01_bedroom/flythrough.mp4 ADDED
@@ -0,0 +1,3 @@
 
 
 
 
1
+ version https://git-lfs.github.com/spec/v1
2
+ oid sha256:425ce94263e4764c41cb35940ae4bf84f2de0e43a57b029ee788d27a7ed4db71
3
+ size 1108627
scenes/scene_01_bedroom/renders/ceiling_top.png ADDED

Git LFS Details

  • SHA256: 46e06acb4512315102ca3083fa5482c2512e8f1871c8638cb76287e87a250650
  • Pointer size: 131 Bytes
  • Size of remote file: 202 kB
scenes/scene_01_bedroom/renders/floor_plan.png ADDED

Git LFS Details

  • SHA256: c62bfe29d85a1db3d6738333562cd02ca94561af180a4af08eb70fff46c9b53a
  • Pointer size: 131 Bytes
  • Size of remote file: 775 kB
scenes/scene_01_bedroom/renders/furniture_side0.png ADDED

Git LFS Details

  • SHA256: 88aa11a921ab7ac7b66629d8a774776043285c57e15f9290c35ad4f0aeac79aa
  • Pointer size: 131 Bytes
  • Size of remote file: 141 kB
scenes/scene_01_bedroom/renders/furniture_side1.png ADDED

Git LFS Details

  • SHA256: 5ef0d7c571d68c70fd2f076db8b7efedd2659f3106f6bf88da55ca6ce08c51c6
  • Pointer size: 131 Bytes
  • Size of remote file: 141 kB
scenes/scene_01_bedroom/renders/furniture_side2.png ADDED

Git LFS Details

  • SHA256: 7bad49f108fe2e9a26e5f575eaf2e56d99d2446234c5d3400855db6c5754784d
  • Pointer size: 131 Bytes
  • Size of remote file: 143 kB
scenes/scene_01_bedroom/renders/furniture_side3.png ADDED

Git LFS Details

  • SHA256: 9efcf101684ed618e8d6a26b91f9a127bccfb7a76a892a167a739ae4cc1c60c0
  • Pointer size: 131 Bytes
  • Size of remote file: 145 kB
scenes/scene_01_bedroom/renders/furniture_top.png ADDED

Git LFS Details

  • SHA256: 3340d32c20ca0e60c8e14e1256d62d76717a6ce23cd570787a74ee5c0bcac33d
  • Pointer size: 131 Bytes
  • Size of remote file: 850 kB
scenes/scene_01_bedroom/renders/wall_north.png ADDED

Git LFS Details

  • SHA256: 239418aec9eb1648af3f7761dd9adf50f8b81aed5ede818e3bb7e6bf38777e3c
  • Pointer size: 131 Bytes
  • Size of remote file: 151 kB
scenes/scene_01_bedroom/renders/wall_top.png ADDED

Git LFS Details

  • SHA256: dc4b725a4efbd8115d928b48f432e551255a83b535b5e9d4591b389886a31b37
  • Pointer size: 131 Bytes
  • Size of remote file: 216 kB
scenes/scene_01_bedroom/sim_files/house.dmd.yaml ADDED
@@ -0,0 +1,68 @@
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
+ directives:
2
+ - add_frame:
3
+ name: house_frame
4
+ X_PF:
5
+ base_frame: world
6
+ translation: [0, 0, 0]
7
+ - add_frame:
8
+ name: room_bedroom_frame
9
+ X_PF:
10
+ base_frame: house_frame
11
+ translation: [2.4, 1.95, 0]
12
+ - add_model:
13
+ name: room_geometry_bedroom
14
+ file: package://scene/room_geometry/room_geometry_bedroom.sdf
15
+ - add_model:
16
+ name: bedroom_desk_0
17
+ file: package://scene/room_bedroom/generated_assets/furniture/sdf/desk_1784878751/model_table_1.sdf
18
+ default_free_body_pose:
19
+ E_body_1:
20
+ base_frame: room_bedroom_frame
21
+ translation: [0.794653215186312, 1.5823980974477518, -0.000425074022993442]
22
+ rotation: !AngleAxis
23
+ angle_deg: 179.9999999779917
24
+ axis: [1.30429129429051e-05, -2.3520016260105125e-05, 0.9999999996383456]
25
+ - add_model:
26
+ name: bedroom_nightstand_0
27
+ file: package://scene/room_bedroom/generated_assets/furniture/sdf/nightstand_1784879096/cabinet_10.sdf
28
+ default_free_body_pose:
29
+ E_body_3:
30
+ base_frame: room_bedroom_frame
31
+ translation: [-0.5515806267995962, -1.7292800000000002, 0.0]
32
+ rotation: !AngleAxis
33
+ angle_deg: 0.0
34
+ axis: [1.0, 0.0, 0.0]
35
+ - add_model:
36
+ name: bedroom_nightstand_1
37
+ file: package://scene/room_bedroom/generated_assets/furniture/sdf/nightstand_1784879096/cabinet_10.sdf
38
+ default_free_body_pose:
39
+ E_body_3:
40
+ base_frame: room_bedroom_frame
41
+ translation: [0.6150018891853233, -1.7292800000000002, 0.0]
42
+ rotation: !AngleAxis
43
+ angle_deg: 0.0
44
+ axis: [1.0, 0.0, 0.0]
45
+ - add_model:
46
+ name: bedroom_rug_0
47
+ file: package://scene/room_bedroom/generated_assets/furniture/sdf/rug_1784879222/rug.sdf
48
+ - add_weld:
49
+ parent: room_bedroom_frame
50
+ child: bedroom_rug_0::base_link
51
+ X_PC:
52
+ translation: [-0.009502794958756021, -0.3870638220842441, 0.0]
53
+ rotation: !AngleAxis
54
+ angle_deg: 1.3461174262076736
55
+ axis: [0.0, 0.0, -1.0]
56
+ - add_model:
57
+ name: bedroom_wardrobe_0
58
+ file: package://scene/room_bedroom/generated_assets/furniture/sdf/wardrobe_1784878729/model_refrigerator_1.sdf
59
+ default_free_body_pose:
60
+ E_body_16:
61
+ base_frame: room_bedroom_frame
62
+ translation: [2.0616769217858426, -1.5281223076091117, 0.001000000000000092]
63
+ rotation: !AngleAxis
64
+ angle_deg: 89.81231529899297
65
+ axis: [0.0, 0.0, 1.0]
66
+ - add_weld:
67
+ parent: room_bedroom_frame
68
+ child: room_geometry_bedroom::room_geometry_body_link
scenes/scene_01_bedroom/sim_files/house_state.json ADDED
The diff for this file is too large to render. See raw diff