-
Notifications
You must be signed in to change notification settings - Fork 1
/
ikea_stefan_without_bottom_cont_grasp.yaml
369 lines (369 loc) · 17.3 KB
/
ikea_stefan_without_bottom_cont_grasp.yaml
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
grasp_points:
- lower_bound: [0.372193, 0.433552, -0.343003]
upper_bound: [0.456989, 0.892439, -0.343003]
orientation: [0, 0, 0.635042, 0.772478]
distance: 0.466656
- lower_bound: [0.456989, 0.892439, -0.0268026]
upper_bound: [0.372193, 0.433552, -0.0268026]
orientation: [-0.635042, 0.772478, 0, 0]
distance: 0.466656
- lower_bound: [0.372716, 0.439042, -0.0268026]
upper_bound: [0.456956, 0.892278, -0.0268026]
orientation: [0.765507, 0.643428, 0, 0]
distance: 0.460997
- lower_bound: [0.456956, 0.892278, -0.343003]
upper_bound: [0.372716, 0.439042, -0.343003]
orientation: [0, -0, -0.765507, 0.643428]
distance: 0.460997
- lower_bound: [-0.00785, 0, 0]
upper_bound: [-0.00785, 0.376545, 0]
orientation: [0.5, 0.5, 0.5, 0.5]
distance: 0.376545
- lower_bound: [-0.00785, 0.376545, 0]
upper_bound: [-0.00785, 0, 0]
orientation: [0.5, -0.5, 0.5, -0.5]
distance: 0.376545
- lower_bound: [-0.00785, 0.00990909, -0.369805]
upper_bound: [-0.00785, 0.376545, -0.369805]
orientation: [0.5, 0.5, 0.5, 0.5]
distance: 0.366636
- lower_bound: [0.415209, 0.00940348, -0.0345961]
upper_bound: [0.383497, 0.362036, -0.0345961]
orientation: [0.477083, 0.521912, -0.521912, -0.477083]
distance: 0.354056
- lower_bound: [0.383497, 0.362036, -0.0345961]
upper_bound: [0.415209, 0.00940348, -0.0345961]
orientation: [0.521912, -0.477083, -0.477083, 0.521912]
distance: 0.354056
- lower_bound: [0.383497, 0.362036, -0.335209]
upper_bound: [0.415209, 0.00940348, -0.335209]
orientation: [0.521912, -0.477083, -0.477083, 0.521912]
distance: 0.354056
- lower_bound: [0.370297, 0.1225, -0.030693]
upper_bound: [0.0243411, 0.1225, -0.000425774]
orientation: [0.0308436, 0.706434, 0.706434, -0.0308436]
distance: 0.347278
- lower_bound: [0.0261032, 0.1225, -0.000579933]
upper_bound: [0.371197, 0.1225, -0.0307717]
orientation: [-0.706434, 0.0308436, 0.0308436, 0.706434]
distance: 0.346412
- lower_bound: [0.371197, 0.1225, -0.339034]
upper_bound: [0.0261032, 0.1225, -0.369225]
orientation: [-0.0308436, 0.706433, 0.706434, 0.0308435]
distance: 0.346412
- lower_bound: [0.367056, 0.13025, -0.336635]
upper_bound: [0.0260337, 0.13025, -0.366471]
orientation: [0, 0.999048, 0, 0.0436194]
distance: 0.342325
- lower_bound: [0.0260337, 0.13025, -0.00333436]
upper_bound: [0.367056, 0.13025, -0.0331699]
orientation: [-0, 0.0436194, -0, 0.999048]
distance: 0.342325
- lower_bound: [0.360653, 0.13025, -0.342716]
upper_bound: [0.0245808, 0.13025, -0.372119]
orientation: [-0.0436194, 0, 0.999048, -0]
distance: 0.337356
- lower_bound: [0.0245808, 0.13025, 0.00231376]
upper_bound: [0.360653, 0.13025, -0.0270887]
orientation: [0.999048, 0, -0.0436194, 0]
distance: 0.337356
- lower_bound: [0.361097, 0.13025, -0.0326486]
upper_bound: [0.0258635, 0.13025, -0.00331947]
orientation: [0.0436194, 0, 0.999048, 0]
distance: 0.336514
- lower_bound: [0.0258635, 0.13025, -0.366486]
upper_bound: [0.361097, 0.13025, -0.337157]
orientation: [0.999048, 0, 0.0436194, -0]
distance: 0.336514
- lower_bound: [0.0247558, 0.13025, -0.372104]
upper_bound: [0.35672, 0.13025, -0.343061]
orientation: [0, -0.0436194, -0, 0.999048]
distance: 0.333232
- lower_bound: [0.35672, 0.13025, -0.0267446]
upper_bound: [0.0247558, 0.13025, 0.00229845]
orientation: [0, 0.999048, 0, -0.0436194]
distance: 0.333232
- lower_bound: [0.0245162, 0.138, -0.000441089]
upper_bound: [0.35648, 0.138, -0.0294842]
orientation: [0.706434, 0.0308436, -0.0308436, 0.706434]
distance: 0.333232
- lower_bound: [0.0262734, 0.138, -0.36921]
upper_bound: [0.357266, 0.138, -0.340252]
orientation: [0.706434, -0.0308436, 0.0308436, 0.706434]
distance: 0.332256
- lower_bound: [0.357266, 0.138, -0.0295529]
upper_bound: [0.0262734, 0.138, -0.000594828]
orientation: [-0.0308436, 0.706434, -0.706434, -0.0308436]
distance: 0.332256
- lower_bound: [-0.00215, 0.4105, -0.346321]
upper_bound: [-0.00215, 0.4105, -0.0253794]
orientation: [0.707107, 0, 0.707107, 0]
distance: 0.320941
- lower_bound: [-0.00215, 0.4105, -0.0253794]
upper_bound: [-0.00215, 0.4105, -0.346321]
orientation: [0, 0.707107, 0, 0.707107]
distance: 0.320941
- lower_bound: [0.0236157, 0.410196, -0.372551]
upper_bound: [0.341669, 0.399089, -0.339102]
orientation: [-0.000913389, -0.052328, -0.0174285, 0.998477]
distance: 0.32
- lower_bound: [0.0260982, 0.42812, -0.369591]
upper_bound: [0.344151, 0.417013, -0.336142]
orientation: [0.705384, -0.0493253, 0.0246777, 0.706676]
distance: 0.32
- lower_bound: [0.341669, 0.399089, -0.0307033]
upper_bound: [0.0236157, 0.410196, 0.0027458]
orientation: [0.0174285, 0.998477, 0.000913388, -0.052328]
distance: 0.32
- lower_bound: [0.344151, 0.417013, -0.0336635]
upper_bound: [0.0260982, 0.42812, -0.000214355]
orientation: [-0.0246777, 0.706676, -0.705384, -0.0493253]
distance: 0.32
- lower_bound: [0.0269102, 0.410081, -0.366674]
upper_bound: [0.343288, 0.399033, -0.333401]
orientation: [0.998477, -0.0174284, 0.052328, 0.000913386]
distance: 0.318315
- lower_bound: [0.342947, 0.381034, -0.336136]
upper_bound: [0.0265693, 0.392082, -0.369409]
orientation: [-0.0246778, 0.706676, 0.705384, 0.0493253]
distance: 0.318315
- lower_bound: [0.341721, 0.399087, -0.339096]
upper_bound: [0.0253433, 0.410135, -0.372369]
orientation: [-0.052328, 0.000913385, 0.998477, 0.0174284]
distance: 0.318315
- lower_bound: [0.0253433, 0.410135, 0.00256412]
upper_bound: [0.341721, 0.399087, -0.0307088]
orientation: [0.998477, -0.0174284, -0.052328, -0.000913385]
distance: 0.318315
- lower_bound: [0.343288, 0.399033, -0.0364039]
upper_bound: [0.0269102, 0.410081, -0.00313097]
orientation: [0.052328, -0.000913385, 0.998477, 0.0174284]
distance: 0.318315
- lower_bound: [0.0265693, 0.392082, -0.000396036]
upper_bound: [0.342947, 0.381034, -0.033669]
orientation: [-0.705384, 0.0493252, 0.0246777, 0.706676]
distance: 0.318315
- lower_bound: [0.343236, 0.399034, -0.333407]
upper_bound: [0.0351219, 0.409794, -0.365811]
orientation: [0.0174285, 0.998477, -0.000913388, 0.052328]
distance: 0.31
- lower_bound: [0.0351219, 0.409794, -0.00399458]
upper_bound: [0.343236, 0.399034, -0.0363984]
orientation: [0.000913388, 0.052328, -0.0174285, 0.998477]
distance: 0.31
- lower_bound: [0.340806, 0.381108, -0.0334437]
upper_bound: [0.0540882, 0.391121, -0.00329015]
orientation: [0.0493252, 0.705384, 0.706676, -0.0246777]
distance: 0.288473
- lower_bound: [0.00035, 0.428, -0.326262]
upper_bound: [0.00035, 0.428, -0.0454382]
orientation: [0.5, -0.5, 0.5, 0.5]
distance: 0.280824
- lower_bound: [0.00035, 0.393, -0.326262]
upper_bound: [0.00035, 0.393, -0.0454382]
orientation: [0.5, 0.5, 0.5, -0.5]
distance: 0.280824
- lower_bound: [0.00035, 0.428, -0.0454382]
upper_bound: [0.00035, 0.428, -0.326262]
orientation: [0.5, 0.5, -0.5, 0.5]
distance: 0.280824
- lower_bound: [0.364048, 0.397227, -0.309903]
upper_bound: [0.364048, 0.397227, -0.0599026]
orientation: [0.707107, 0, 0.707107, 0]
distance: 0.25
- lower_bound: [0.369048, 0.397227, -0.0599026]
upper_bound: [0.369048, 0.397227, -0.309903]
orientation: [0.707107, 0, -0.707107, 0]
distance: 0.25
- lower_bound: [0.369048, 0.397227, -0.309903]
upper_bound: [0.369048, 0.397227, -0.0599026]
orientation: [0, -0.707107, 0, 0.707107]
distance: 0.25
- lower_bound: [0.364048, 0.397227, -0.0599026]
upper_bound: [0.364048, 0.397227, -0.309903]
orientation: [0, 0.707107, 0, 0.707107]
distance: 0.25
- lower_bound: [0, 0.376545, -0.00785]
upper_bound: [0, 0.158545, -0.00785]
orientation: [0, 0, -0.707107, 0.707107]
distance: 0.218
- lower_bound: [0.00785, 0.376545, 0]
upper_bound: [0.00785, 0.158545, 0]
orientation: [0.5, -0.5, -0.5, 0.5]
distance: 0.218
- lower_bound: [0, 0.376545, 0.00785]
upper_bound: [0, 0.158545, 0.00785]
orientation: [0.707107, -0.707107, 0, -0]
distance: 0.218
- lower_bound: [0.00785, 0.376545, -0.369805]
upper_bound: [0.00785, 0.158545, -0.369805]
orientation: [0.5, -0.5, -0.5, 0.5]
distance: 0.218
- lower_bound: [0, 0.376545, -0.361955]
upper_bound: [0, 0.158545, -0.361955]
orientation: [0.707107, -0.707107, 0, -0]
distance: 0.218
- lower_bound: [0, 0.376545, -0.377655]
upper_bound: [0, 0.158545, -0.377655]
orientation: [0, 0, -0.707107, 0.707107]
distance: 0.218
- lower_bound: [0.370694, 0.370508, -0.0267895]
upper_bound: [0.392397, 0.161177, -0.0267895]
orientation: [0.747218, -0.664579, 3.50261e-06, -3.93816e-06]
distance: 0.210454
- lower_bound: [0.366548, 0.379727, -0.0799026]
upper_bound: [0.366548, 0.379727, -0.289903]
orientation: [0.5, -0.5, -0.5, -0.5]
distance: 0.21
- lower_bound: [0.366548, 0.414727, -0.0799026]
upper_bound: [0.366548, 0.414727, -0.289903]
orientation: [0.5, 0.5, -0.5, 0.5]
distance: 0.21
- lower_bound: [0.366548, 0.379727, -0.289903]
upper_bound: [0.366548, 0.379727, -0.0799026]
orientation: [0.5, 0.5, 0.5, -0.5]
distance: 0.21
- lower_bound: [0.366548, 0.414727, -0.289903]
upper_bound: [0.366548, 0.414727, -0.0799026]
orientation: [0.5, -0.5, 0.5, 0.5]
distance: 0.21
- lower_bound: [0.371675, 0.360973, -0.343016]
upper_bound: [0.392542, 0.159716, -0.343016]
orientation: [1.93757e-16, -1.77115e-16, -0.674697, 0.738095]
distance: 0.202337
- lower_bound: [0.371675, 0.360973, -0.0424026]
upper_bound: [0.392542, 0.159716, -0.0424026]
orientation: [-1.49674e-17, 1.36818e-17, -0.674697, 0.738095]
distance: 0.202337
- lower_bound: [0.371727, 0.36054, -0.327403]
upper_bound: [0.392397, 0.161177, -0.327403]
orientation: [0.747218, -0.664579, -2.91975e-07, 3.28282e-07]
distance: 0.200432
- lower_bound: [0.359945, 0.359156, -0.0345961]
upper_bound: [0.382158, 0.170063, -0.0345961]
orientation: [-0.528363, 0.469928, -0.469928, 0.528363]
distance: 0.190393
- lower_bound: [0.370691, 0.370567, -0.0267895]
upper_bound: [0.383304, 0.248881, -0.0277405]
orientation: [0.747213, -0.664573, -0.00290475, -0.0025835]
distance: 0.122341
- lower_bound: [0.383304, 0.248881, -0.342065]
upper_bound: [0.370691, 0.370567, -0.343016]
orientation: [-0.00290472, 0.00258347, 0.747213, 0.664573]
distance: 0.122341
- lower_bound: [0.408933, 0.00168556, -0.343016]
upper_bound: [0.397565, 0.111336, -0.343016]
orientation: [3.50265e-06, 3.93821e-06, 0.747218, 0.664579]
distance: 0.110238
- lower_bound: [0.408933, 0.00168555, -0.0424026]
upper_bound: [0.397565, 0.111336, -0.0424026]
orientation: [-2.91975e-07, -3.28282e-07, 0.747218, 0.664579]
distance: 0.110238
- lower_bound: [0.402033, 0.000875031, -0.0345961]
upper_bound: [0.389173, 0.11035, -0.0345961]
orientation: [0.469928, 0.528363, 0.528363, 0.469928]
distance: 0.110228
- lower_bound: [0.402033, 0.000875031, -0.335209]
upper_bound: [0.389173, 0.11035, -0.335209]
orientation: [0.469928, 0.528363, 0.528363, 0.469928]
distance: 0.110228
- lower_bound: [0.372193, 0.433552, -0.0424026]
upper_bound: [0.391675, 0.541023, -0.0424026]
orientation: [0, 0, 0.635042, 0.772478]
distance: 0.109222
- lower_bound: [0.361094, 0.43574, -0.335209]
upper_bound: [0.382219, 0.542887, -0.335203]
orientation: [0.546224, 0.449043, 0.449043, 0.546224]
distance: 0.10921
- lower_bound: [0.361094, 0.43574, -0.0346026]
upper_bound: [0.382219, 0.542887, -0.0346026]
orientation: [0.546224, 0.449043, 0.449043, 0.546224]
distance: 0.10921
- lower_bound: [0, 0, 0.00785]
upper_bound: [0, 0.109, 0.00785]
orientation: [0.707107, 0.707107, 0, 0]
distance: 0.109
- lower_bound: [0, 0, -0.00785]
upper_bound: [0, 0.109, -0.00785]
orientation: [0, 0, 0.707107, 0.707107]
distance: 0.109
- lower_bound: [0, 1.36073e-15, -0.377655]
upper_bound: [0, 0.109, -0.377655]
orientation: [0, 0, 0.707107, 0.707107]
distance: 0.109
- lower_bound: [0.408193, 0.00877255, -0.0267897]
upper_bound: [0.397759, 0.109401, -0.0267897]
orientation: [0.674697, 0.738095, -0, 0]
distance: 0.101168
- lower_bound: [0.408193, 0.00877255, -0.327403]
upper_bound: [0.397759, 0.109401, -0.327403]
orientation: [0.674697, 0.738095, 0, 0]
distance: 0.101168
- lower_bound: [0.372716, 0.439042, -0.327403]
upper_bound: [0.391029, 0.537572, -0.327403]
orientation: [0.765507, 0.643428, 0, 0]
distance: 0.100217
- lower_bound: [0.383324, 0.43719, -0.0346026]
upper_bound: [0.400561, 0.535907, -0.0346026]
orientation: [-0.541295, -0.454972, 0.454972, 0.541295]
distance: 0.100211
- lower_bound: [0.00785, 0.00990909, 0]
upper_bound: [0.00785, 0.109, 0]
orientation: [0.5, 0.5, -0.5, -0.5]
distance: 0.0990909
- lower_bound: [0, 0.00990909, -0.361955]
upper_bound: [0, 0.109, -0.361955]
orientation: [0.707107, 0.707107, 0, 0]
distance: 0.0990909
- lower_bound: [0.400884, 0.079321, -0.0277198]
upper_bound: [0.408942, 0.00159673, -0.0267898]
orientation: [0.747205, -0.664567, 0.00443144, 0.00397166]
distance: 0.0781464
- lower_bound: [0.408942, 0.00159673, -0.343015]
upper_bound: [0.400884, 0.079321, -0.342085]
orientation: [0.00443139, -0.00397162, 0.747205, 0.664567]
distance: 0.0781464
- lower_bound: [0.408947, 0.00155303, -0.343017]
upper_bound: [0.403971, 0.0495464, -0.34216]
orientation: [0.00663674, -0.00590274, 0.747189, 0.664552]
distance: 0.0482583
- lower_bound: [0.403971, 0.0495464, -0.0276456]
upper_bound: [0.408947, 0.00155303, -0.0267885]
orientation: [0.747189, -0.664552, 0.00663673, 0.00590272]
distance: 0.0482583
- lower_bound: [0.00285, 0.4105, -0.0253794]
upper_bound: [0.00285, 0.4105, -0.0654971]
orientation: [0.707107, 0, -0.707107, -0]
distance: 0.0401177
- lower_bound: [0.36106, 0.43558, -0.0346026]
upper_bound: [0.369671, 0.474725, -0.0346026]
orientation: [0.551097, 0.443048, 0.443048, 0.551097]
distance: 0.0400809
- lower_bound: [0, 0.0075, 0.01535]
upper_bound: [0, 0.0075, -0.01535]
orientation: [0.5, -0.5, -0.5, -0.5]
distance: 0.0307
- lower_bound: [0.01535, 0.0075, 0]
upper_bound: [-0.01535, 0.0075, 0]
orientation: [0, 0.707107, 0.707107, 0]
distance: 0.0307
- lower_bound: [0, 0.0075, -0.01535]
upper_bound: [0, 0.0075, 0.01535]
orientation: [0.5, 0.5, 0.5, -0.5]
distance: 0.0307
- lower_bound: [0.455586, 0.884903, -0.319903]
upper_bound: [0.455586, 0.884903, -0.350503]
orientation: [0.541295, 0.454972, -0.541295, 0.454972]
distance: 0.0306
- lower_bound: [0.455619, 0.885065, -0.350503]
upper_bound: [0.455619, 0.885065, -0.319903]
orientation: [0.449043, -0.546224, 0.449043, 0.546224]
distance: 0.0306
- lower_bound: [0.455619, 0.885065, -0.0499026]
upper_bound: [0.455619, 0.885065, -0.0193026]
orientation: [0.449043, -0.546224, 0.449043, 0.546224]
distance: 0.0306
- lower_bound: [0.455586, 0.884903, -0.0193026]
upper_bound: [0.455586, 0.884903, -0.0499026]
orientation: [0.541295, 0.454972, -0.541295, 0.454972]
distance: 0.0306