-
Notifications
You must be signed in to change notification settings - Fork 0
/
pose_data_wrist_right.p
446 lines (446 loc) · 3.58 KB
/
pose_data_wrist_right.p
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
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
(lp0
(lp1
I3
aI3
aa(lp2
ccopy_reg
_reconstructor
p3
(cgeometry_msgs.msg._PoseStamped
PoseStamped
p4
c__builtin__
object
p5
Ntp6
Rp7
(lp8
g3
(cstd_msgs.msg._Header
Header
p9
g5
Ntp10
Rp11
(lp12
I0
ag3
(crospy.rostime
Time
p13
g5
Ntp14
Rp15
(lp16
I1440994804
aI921081305
abaS'two_tool_wrist_sca_shaft_link'
p17
abag3
(cgeometry_msgs.msg._Pose
Pose
p18
g5
Ntp19
Rp20
(lp21
g3
(cgeometry_msgs.msg._Point
Point
p22
g5
Ntp23
Rp24
(lp25
F0.013493221471618513
aF-0.15648542904978988
aF-0.12627620717874977
abag3
(cgeometry_msgs.msg._Quaternion
Quaternion
p26
g5
Ntp27
Rp28
(lp29
F0.49812812312682336
aF-0.5009066187187129
aF0.5144790102884225
aF0.48607847128481224
abababag3
(g4
g5
Ntp30
Rp31
(lp32
g3
(g9
g5
Ntp33
Rp34
(lp35
I0
ag3
(g13
g5
Ntp36
Rp37
(lp38
I1440994821
aI351806879
abag17
abag3
(g18
g5
Ntp39
Rp40
(lp41
g3
(g22
g5
Ntp42
Rp43
(lp44
F0.010774324056870517
aF-0.14935156466839677
aF-0.12116621456803905
abag3
(g26
g5
Ntp45
Rp46
(lp47
F0.4928217983853977
aF-0.5284466391672042
aF0.5036864734886035
aF0.47346674752688067
abababag3
(g4
g5
Ntp48
Rp49
(lp50
g3
(g9
g5
Ntp51
Rp52
(lp53
I0
ag3
(g13
g5
Ntp54
Rp55
(lp56
I1440994833
aI929760456
abag17
abag3
(g18
g5
Ntp57
Rp58
(lp59
g3
(g22
g5
Ntp60
Rp61
(lp62
F-0.017218375326315018
aF-0.15210444478402768
aF-0.10663068539296089
abag3
(g26
g5
Ntp63
Rp64
(lp65
F0.4517432059641987
aF-0.5541720012740624
aF0.46482870377140817
aF0.5222602272998408
abababag3
(g4
g5
Ntp66
Rp67
(lp68
g3
(g9
g5
Ntp69
Rp70
(lp71
I0
ag3
(g13
g5
Ntp72
Rp73
(lp74
I1440994850
aI197229624
abag17
abag3
(g18
g5
Ntp75
Rp76
(lp77
g3
(g22
g5
Ntp78
Rp79
(lp80
F0.026982943484984184
aF-0.1572528559107138
aF-0.12260596631353068
abag3
(g26
g5
Ntp81
Rp82
(lp83
F0.4703290670024945
aF-0.5198330604025482
aF0.5205791186176352
aF0.48740285114509757
abababag3
(g4
g5
Ntp84
Rp85
(lp86
g3
(g9
g5
Ntp87
Rp88
(lp89
I0
ag3
(g13
g5
Ntp90
Rp91
(lp92
I1440994862
aI213704586
abag17
abag3
(g18
g5
Ntp93
Rp94
(lp95
g3
(g22
g5
Ntp96
Rp97
(lp98
F0.02056843719975291
aF-0.15246651755875246
aF-0.11561258382313314
abag3
(g26
g5
Ntp99
Rp100
(lp101
F0.4904539444318497
aF-0.5206509948872127
aF0.5019490685943339
aF0.48623513082815867
abababag3
(g4
g5
Ntp102
Rp103
(lp104
g3
(g9
g5
Ntp105
Rp106
(lp107
I0
ag3
(g13
g5
Ntp108
Rp109
(lp110
I1440994884
aI18095970
abag17
abag3
(g18
g5
Ntp111
Rp112
(lp113
g3
(g22
g5
Ntp114
Rp115
(lp116
F0.011771096586745473
aF-0.1508272038033035
aF-0.10700180976818191
abag3
(g26
g5
Ntp117
Rp118
(lp119
F0.4813440074443755
aF-0.5345638038652577
aF0.4861759807332518
aF0.4961677154476659
abababag3
(g4
g5
Ntp120
Rp121
(lp122
g3
(g9
g5
Ntp123
Rp124
(lp125
I0
ag3
(g13
g5
Ntp126
Rp127
(lp128
I1440994902
aI512433052
abag17
abag3
(g18
g5
Ntp129
Rp130
(lp131
g3
(g22
g5
Ntp132
Rp133
(lp134
F0.008591514371178853
aF-0.15636065057355533
aF-0.12897370553604415
abag3
(g26
g5
Ntp135
Rp136
(lp137
F0.5177784088132077
aF-0.49218238550689
aF0.4488929018743601
aF0.5368027397568178
abababag3
(g4
g5
Ntp138
Rp139
(lp140
g3
(g9
g5
Ntp141
Rp142
(lp143
I0
ag3
(g13
g5
Ntp144
Rp145
(lp146
I1440994918
aI276946068
abag17
abag3
(g18
g5
Ntp147
Rp148
(lp149
g3
(g22
g5
Ntp150
Rp151
(lp152
F0.021871379561429517
aF-0.1592927976421177
aF-0.10793258967178301
abag3
(g26
g5
Ntp153
Rp154
(lp155
F0.46063478792917506
aF-0.525351323295603
aF0.4909804642859865
aF0.5203458109281947
abababag3
(g4
g5
Ntp156
Rp157
(lp158
g3
(g9
g5
Ntp159
Rp160
(lp161
I0
ag3
(g13
g5
Ntp162
Rp163
(lp164
I1440994933
aI222431898
abag17
abag3
(g18
g5
Ntp165
Rp166
(lp167
g3
(g22
g5
Ntp168
Rp169
(lp170
F0.022203801925741014
aF-0.15547229826713188
aF-0.09894672402743336
abag3
(g26
g5
Ntp171
Rp172
(lp173
F0.47460894821004374
aF-0.5223854094169069
aF0.48945719168693036
aF0.5121440108145658
abababaa.