Debian Codegraph @

data/skel/test/double_pendulum_with_base.skel

raw
1 <?xml version='1.0'?>
2 <skel version="1.0">
3 <world name="world 1">
4 <physics>
5 <time_step>0.001</time_step>
6 <gravity>0 0 -9.81</gravity>
7 <collision_detector>fcl_mesh</collision_detector>
8 </physics>
9
10 <skeleton name="ground skeleton">
11 <body name="ground">
12 <transformation>0 0 -0.55 0 0 0</transformation>
13 <visualization_shape>
14 <transformation>0 0 0 0 0 0</transformation>
15 <geometry>
16 <box>
17 <size>10.0 10.0 0.1</size>
18 </box>
19 </geometry>
20 </visualization_shape>
21 <collision_shape>
22 <transformation>0 0 0 0 0 0</transformation>
23 <geometry>
24 <box>
25 <size>10.0 10.0 0.1</size>
26 </box>
27 </geometry>
28 </collision_shape>
29 </body>
30 <joint type="weld" name="joint 1">
31 <parent>world</parent>
32 <child>ground</child>
33 </joint>
34 </skeleton>
35
36 <skeleton name="double_pendulum_with_base">
37 <transformation>0 2.1 0 0 0 0</transformation>
38 <body name="base">
39 <transformation>0 0 0 0 0 0</transformation>
40 <inertia>
41 <mass>100</mass>
42 </inertia>
43 <visualization_shape>
44 <transformation>0 0 0.01 0 0 0</transformation>
45 <geometry>
46 <cylinder>
47 <radius>0.8</radius>
48 <height>0.02</height>
49 </cylinder>
50 </geometry>
51 </visualization_shape>
52 <visualization_shape>
53 <transformation>-0.275 0 1.1 0 0 0</transformation>
54 <geometry>
55 <box>
56 <size>0.2 0.2 2.2</size>
57 </box>
58 </geometry>
59 </visualization_shape>
60 <collision_shape>
61 <transformation>0 0 0.01 0 0 0</transformation>
62 <geometry>
63 <cylinder>
64 <radius>0.8</radius>
65 <height>0.02</height>
66 </cylinder>
67 </geometry>
68 </collision_shape>
69 <collision_shape>
70 <transformation>-0.275 0 1.1 0 0 0</transformation>
71 <geometry>
72 <box>
73 <size>0.2 0.2 2.2</size>
74 </box>
75 </geometry>
76 </collision_shape>
77 </body>
78 <body name="upper_link">
79 <transformation>0 0 2.1 -1.5708 0 0</transformation>
80 <inertia>
81 <mass>1</mass>
82 <offset>0 0 0.5</offset>
83 </inertia>
84 <visualization_shape>
85 <transformation>-0.05 0 0 0 1.5708 0</transformation>
86 <geometry>
87 <cylinder>
88 <radius>0.1</radius>
89 <height>0.3</height>
90 </cylinder>
91 </geometry>
92 </visualization_shape>
93 <visualization_shape>
94 <transformation>0 0 1.0 0 1.5708 0</transformation>
95 <geometry>
96 <cylinder>
97 <radius>0.1</radius>
98 <height>0.2</height>
99 </cylinder>
100 </geometry>
101 </visualization_shape>
102 <visualization_shape>
103 <transformation>0 0 0.5 0 0 0</transformation>
104 <geometry>
105 <cylinder>
106 <radius>0.1</radius>
107 <height>0.9</height>
108 </cylinder>
109 </geometry>
110 </visualization_shape>
111 <collision_shape>
112 <transformation>-0.05 0 0 0 1.5708 0</transformation>
113 <geometry>
114 <cylinder>
115 <radius>0.1</radius>
116 <height>0.3</height>
117 </cylinder>
118 </geometry>
119 </collision_shape>
120 <collision_shape>
121 <transformation>0 0 1.0 0 1.5708 0</transformation>
122 <geometry>
123 <cylinder>
124 <radius>0.1</radius>
125 <height>0.2</height>
126 </cylinder>
127 </geometry>
128 </collision_shape>
129 <collision_shape>
130 <transformation>0 0 0.5 0 0 0</transformation>
131 <geometry>
132 <cylinder>
133 <radius>0.1</radius>
134 <height>0.9</height>
135 </cylinder>
136 </geometry>
137 </collision_shape>
138 </body>
139 <body name="lower_link">
140 <transformation>0.25 1.0 2.1 -2 0 0</transformation>
141 <inertia>
142 <mass>1</mass>
143 <offset>0 0 0.5</offset>
144 </inertia>
145 <visualization_shape>
146 <transformation>0 0 0 0 1.5708 0</transformation>
147 <geometry>
148 <cylinder>
149 <radius>0.08</radius>
150 <height>0.3</height>
151 </cylinder>
152 </geometry>
153 </visualization_shape>
154 <visualization_shape>
155 <transformation>0 0 0.5 0 0 0</transformation>
156 <geometry>
157 <cylinder>
158 <radius>0.1</radius>
159 <height>0.9</height>
160 </cylinder>
161 </geometry>
162 </visualization_shape>
163 <collision_shape>
164 <transformation>0 0 0 0 1.5708 0</transformation>
165 <geometry>
166 <cylinder>
167 <radius>0.08</radius>
168 <height>0.3</height>
169 </cylinder>
170 </geometry>
171 </collision_shape>
172 <collision_shape>
173 <transformation>0 0 0.5 0 0 0</transformation>
174 <geometry>
175 <cylinder>
176 <radius>0.1</radius>
177 <height>0.9</height>
178 </cylinder>
179 </geometry>
180 </collision_shape>
181 </body>
182 <joint type="free" name="joint 1">
183 <parent>world</parent>
184 <child>base</child>
185 <transformation>0 0 0 0 0 0</transformation>
186 </joint>
187 <joint type="revolute" name="joint 2">
188 <parent>base</parent>
189 <child>upper_link</child>
190 <transformation>0 0 0 0 0 0</transformation>
191 <axis>
192 <xyz>1 0 0</xyz>
193 </axis>
194 </joint>
195 <joint type="revolute" name="joint 3">
196 <parent>upper_link</parent>
197 <child>lower_link</child>
198 <transformation>0 0 0 0 0 0</transformation>
199 <axis>
200 <xyz>1 0 0</xyz>
201 </axis>
202 </joint>
203 </skeleton>
204
205 <skeleton name="double_pendulum_with_base">
206 <transformation>0 -2.1 0 0 0 3.1416</transformation>
207 <body name="base">
208 <transformation>0 0 0 0 0 0</transformation>
209 <inertia>
210 <mass>100</mass>
211 </inertia>
212 <visualization_shape>
213 <transformation>0 0 0.01 0 0 0</transformation>
214 <geometry>
215 <cylinder>
216 <radius>0.8</radius>
217 <height>0.02</height>
218 </cylinder>
219 </geometry>
220 </visualization_shape>
221 <visualization_shape>
222 <transformation>-0.275 0 1.1 0 0 0</transformation>
223 <geometry>
224 <box>
225 <size>0.2 0.2 2.2</size>
226 </box>
227 </geometry>
228 </visualization_shape>
229 <collision_shape>
230 <transformation>0 0 0.01 0 0 0</transformation>
231 <geometry>
232 <cylinder>
233 <radius>0.8</radius>
234 <height>0.02</height>
235 </cylinder>
236 </geometry>
237 </collision_shape>
238 <collision_shape>
239 <transformation>-0.275 0 1.1 0 0 0</transformation>
240 <geometry>
241 <box>
242 <size>0.2 0.2 2.2</size>
243 </box>
244 </geometry>
245 </collision_shape>
246 </body>
247 <body name="upper_link">
248 <transformation>0 0 2.1 -1.5708 0 0</transformation>
249 <inertia>
250 <mass>1</mass>
251 <offset>0 0 0.5</offset>
252 </inertia>
253 <visualization_shape>
254 <transformation>-0.05 0 0 0 1.5708 0</transformation>
255 <geometry>
256 <cylinder>
257 <radius>0.1</radius>
258 <height>0.3</height>
259 </cylinder>
260 </geometry>
261 </visualization_shape>
262 <visualization_shape>
263 <transformation>0 0 1.0 0 1.5708 0</transformation>
264 <geometry>
265 <cylinder>
266 <radius>0.1</radius>
267 <height>0.2</height>
268 </cylinder>
269 </geometry>
270 </visualization_shape>
271 <visualization_shape>
272 <transformation>0 0 0.5 0 0 0</transformation>
273 <geometry>
274 <cylinder>
275 <radius>0.1</radius>
276 <height>0.9</height>
277 </cylinder>
278 </geometry>
279 </visualization_shape>
280 <collision_shape>
281 <transformation>-0.05 0 0 0 1.5708 0</transformation>
282 <geometry>
283 <cylinder>
284 <radius>0.1</radius>
285 <height>0.3</height>
286 </cylinder>
287 </geometry>
288 </collision_shape>
289 <collision_shape>
290 <transformation>0 0 1.0 0 1.5708 0</transformation>
291 <geometry>
292 <cylinder>
293 <radius>0.1</radius>
294 <height>0.2</height>
295 </cylinder>
296 </geometry>
297 </collision_shape>
298 <collision_shape>
299 <transformation>0 0 0.5 0 0 0</transformation>
300 <geometry>
301 <cylinder>
302 <radius>0.1</radius>
303 <height>0.9</height>
304 </cylinder>
305 </geometry>
306 </collision_shape>
307 </body>
308 <body name="lower_link">
309 <transformation>0.25 1.0 2.1 -2 0 0</transformation>
310 <inertia>
311 <mass>1</mass>
312 <offset>0 0 0.5</offset>
313 </inertia>
314 <visualization_shape>
315 <transformation>0 0 0 0 1.5708 0</transformation>
316 <geometry>
317 <cylinder>
318 <radius>0.08</radius>
319 <height>0.3</height>
320 </cylinder>
321 </geometry>
322 </visualization_shape>
323 <visualization_shape>
324 <transformation>0 0 0.5 0 0 0</transformation>
325 <geometry>
326 <cylinder>
327 <radius>0.1</radius>
328 <height>0.9</height>
329 </cylinder>
330 </geometry>
331 </visualization_shape>
332 <collision_shape>
333 <transformation>0 0 0 0 1.5708 0</transformation>
334 <geometry>
335 <cylinder>
336 <radius>0.08</radius>
337 <height>0.3</height>
338 </cylinder>
339 </geometry>
340 </collision_shape>
341 <collision_shape>
342 <transformation>0 0 0.5 0 0 0</transformation>
343 <geometry>
344 <cylinder>
345 <radius>0.1</radius>
346 <height>0.9</height>
347 </cylinder>
348 </geometry>
349 </collision_shape>
350 </body>
351 <joint type="free" name="joint 1">
352 <parent>world</parent>
353 <child>base</child>
354 <transformation>0 0 0 0 0 0</transformation>
355 </joint>
356 <joint type="revolute" name="joint 2">
357 <parent>base</parent>
358 <child>upper_link</child>
359 <transformation>0 0 0 0 0 0</transformation>
360 <axis>
361 <xyz>1 0 0</xyz>
362 </axis>
363 </joint>
364 <joint type="revolute" name="joint 3">
365 <parent>upper_link</parent>
366 <child>lower_link</child>
367 <transformation>0 0 0 0 0 0</transformation>
368 <axis>
369 <xyz>1 0 0</xyz>
370 </axis>
371 </joint>
372 </skeleton>
373
374 <skeleton name="double_pendulum_with_base">
375 <transformation>-2.1 0 0 0 0 1.5708</transformation>
376 <body name="base">
377 <transformation>0 0 0 0 0 0</transformation>
378 <inertia>
379 <mass>100</mass>
380 </inertia>
381 <visualization_shape>
382 <transformation>0 0 0.01 0 0 0</transformation>
383 <geometry>
384 <cylinder>
385 <radius>0.8</radius>
386 <height>0.02</height>
387 </cylinder>
388 </geometry>
389 </visualization_shape>
390 <visualization_shape>
391 <transformation>-0.275 0 1.1 0 0 0</transformation>
392 <geometry>
393 <box>
394 <size>0.2 0.2 2.2</size>
395 </box>
396 </geometry>
397 </visualization_shape>
398 <collision_shape>
399 <transformation>0 0 0.01 0 0 0</transformation>
400 <geometry>
401 <cylinder>
402 <radius>0.8</radius>
403 <height>0.02</height>
404 </cylinder>
405 </geometry>
406 </collision_shape>
407 <collision_shape>
408 <transformation>-0.275 0 1.1 0 0 0</transformation>
409 <geometry>
410 <box>
411 <size>0.2 0.2 2.2</size>
412 </box>
413 </geometry>
414 </collision_shape>
415 </body>
416 <body name="upper_link">
417 <transformation>0 0 2.1 -1.5708 0 0</transformation>
418 <inertia>
419 <mass>1</mass>
420 <offset>0 0 0.5</offset>
421 </inertia>
422 <visualization_shape>
423 <transformation>-0.05 0 0 0 1.5708 0</transformation>
424 <geometry>
425 <cylinder>
426 <radius>0.1</radius>
427 <height>0.3</height>
428 </cylinder>
429 </geometry>
430 </visualization_shape>
431 <visualization_shape>
432 <transformation>0 0 1.0 0 1.5708 0</transformation>
433 <geometry>
434 <cylinder>
435 <radius>0.1</radius>
436 <height>0.2</height>
437 </cylinder>
438 </geometry>
439 </visualization_shape>
440 <visualization_shape>
441 <transformation>0 0 0.5 0 0 0</transformation>
442 <geometry>
443 <cylinder>
444 <radius>0.1</radius>
445 <height>0.9</height>
446 </cylinder>
447 </geometry>
448 </visualization_shape>
449 <collision_shape>
450 <transformation>-0.05 0 0 0 1.5708 0</transformation>
451 <geometry>
452 <cylinder>
453 <radius>0.1</radius>
454 <height>0.3</height>
455 </cylinder>
456 </geometry>
457 </collision_shape>
458 <collision_shape>
459 <transformation>0 0 1.0 0 1.5708 0</transformation>
460 <geometry>
461 <cylinder>
462 <radius>0.1</radius>
463 <height>0.2</height>
464 </cylinder>
465 </geometry>
466 </collision_shape>
467 <collision_shape>
468 <transformation>0 0 0.5 0 0 0</transformation>
469 <geometry>
470 <cylinder>
471 <radius>0.1</radius>
472 <height>0.9</height>
473 </cylinder>
474 </geometry>
475 </collision_shape>
476 </body>
477 <body name="lower_link">
478 <transformation>0.25 1.0 2.1 -2 0 0</transformation>
479 <inertia>
480 <mass>1</mass>
481 <offset>0 0 0.5</offset>
482 </inertia>
483 <visualization_shape>
484 <transformation>0 0 0 0 1.5708 0</transformation>
485 <geometry>
486 <cylinder>
487 <radius>0.08</radius>
488 <height>0.3</height>
489 </cylinder>
490 </geometry>
491 </visualization_shape>
492 <visualization_shape>
493 <transformation>0 0 0.5 0 0 0</transformation>
494 <geometry>
495 <cylinder>
496 <radius>0.1</radius>
497 <height>0.9</height>
498 </cylinder>
499 </geometry>
500 </visualization_shape>
501 <collision_shape>
502 <transformation>0 0 0 0 1.5708 0</transformation>
503 <geometry>
504 <cylinder>
505 <radius>0.08</radius>
506 <height>0.3</height>
507 </cylinder>
508 </geometry>
509 </collision_shape>
510 <collision_shape>
511 <transformation>0 0 0.5 0 0 0</transformation>
512 <geometry>
513 <cylinder>
514 <radius>0.1</radius>
515 <height>0.9</height>
516 </cylinder>
517 </geometry>
518 </collision_shape>
519 </body>
520 <joint type="free" name="joint 1">
521 <parent>world</parent>
522 <child>base</child>
523 <transformation>0 0 0 0 0 0</transformation>
524 </joint>
525 <joint type="revolute" name="joint 2">
526 <parent>base</parent>
527 <child>upper_link</child>
528 <transformation>0 0 0 0 0 0</transformation>
529 <axis>
530 <xyz>1 0 0</xyz>
531 </axis>
532 </joint>
533 <joint type="revolute" name="joint 3">
534 <parent>upper_link</parent>
535 <child>lower_link</child>
536 <transformation>0 0 0 0 0 0</transformation>
537 <axis>
538 <xyz>1 0 0</xyz>
539 </axis>
540 </joint>
541 </skeleton>
542
543 <skeleton name="double_pendulum_with_base">
544 <transformation>2.1 0 0 0 0 -1.5708</transformation>
545 <body name="base">
546 <transformation>0 0 0 0 0 0</transformation>
547 <inertia>
548 <mass>100</mass>
549 </inertia>
550 <visualization_shape>
551 <transformation>0 0 0.01 0 0 0</transformation>
552 <geometry>
553 <cylinder>
554 <radius>0.8</radius>
555 <height>0.02</height>
556 </cylinder>
557 </geometry>
558 </visualization_shape>
559 <visualization_shape>
560 <transformation>-0.275 0 1.1 0 0 0</transformation>
561 <geometry>
562 <box>
563 <size>0.2 0.2 2.2</size>
564 </box>
565 </geometry>
566 </visualization_shape>
567 <collision_shape>
568 <transformation>0 0 0.01 0 0 0</transformation>
569 <geometry>
570 <cylinder>
571 <radius>0.8</radius>
572 <height>0.02</height>
573 </cylinder>
574 </geometry>
575 </collision_shape>
576 <collision_shape>
577 <transformation>-0.275 0 1.1 0 0 0</transformation>
578 <geometry>
579 <box>
580 <size>0.2 0.2 2.2</size>
581 </box>
582 </geometry>
583 </collision_shape>
584 </body>
585 <body name="upper_link">
586 <transformation>0 0 2.1 -1.5708 0 0</transformation>
587 <inertia>
588 <mass>1</mass>
589 <offset>0 0 0.5</offset>
590 </inertia>
591 <visualization_shape>
592 <transformation>-0.05 0 0 0 1.5708 0</transformation>
593 <geometry>
594 <cylinder>
595 <radius>0.1</radius>
596 <height>0.3</height>
597 </cylinder>
598 </geometry>
599 </visualization_shape>
600 <visualization_shape>
601 <transformation>0 0 1.0 0 1.5708 0</transformation>
602 <geometry>
603 <cylinder>
604 <radius>0.1</radius>
605 <height>0.2</height>
606 </cylinder>
607 </geometry>
608 </visualization_shape>
609 <visualization_shape>
610 <transformation>0 0 0.5 0 0 0</transformation>
611 <geometry>
612 <cylinder>
613 <radius>0.1</radius>
614 <height>0.9</height>
615 </cylinder>
616 </geometry>
617 </visualization_shape>
618 <collision_shape>
619 <transformation>-0.05 0 0 0 1.5708 0</transformation>
620 <geometry>
621 <cylinder>
622 <radius>0.1</radius>
623 <height>0.3</height>
624 </cylinder>
625 </geometry>
626 </collision_shape>
627 <collision_shape>
628 <transformation>0 0 1.0 0 1.5708 0</transformation>
629 <geometry>
630 <cylinder>
631 <radius>0.1</radius>
632 <height>0.2</height>
633 </cylinder>
634 </geometry>
635 </collision_shape>
636 <collision_shape>
637 <transformation>0 0 0.5 0 0 0</transformation>
638 <geometry>
639 <cylinder>
640 <radius>0.1</radius>
641 <height>0.9</height>
642 </cylinder>
643 </geometry>
644 </collision_shape>
645 </body>
646 <body name="lower_link">
647 <transformation>0.25 1.0 2.1 -2 0 0</transformation>
648 <inertia>
649 <mass>1</mass>
650 <offset>0 0 0.5</offset>
651 </inertia>
652 <visualization_shape>
653 <transformation>0 0 0 0 1.5708 0</transformation>
654 <geometry>
655 <cylinder>
656 <radius>0.08</radius>
657 <height>0.3</height>
658 </cylinder>
659 </geometry>
660 </visualization_shape>
661 <visualization_shape>
662 <transformation>0 0 0.5 0 0 0</transformation>
663 <geometry>
664 <cylinder>
665 <radius>0.1</radius>
666 <height>0.9</height>
667 </cylinder>
668 </geometry>
669 </visualization_shape>
670 <collision_shape>
671 <transformation>0 0 0 0 1.5708 0</transformation>
672 <geometry>
673 <cylinder>
674 <radius>0.08</radius>
675 <height>0.3</height>
676 </cylinder>
677 </geometry>
678 </collision_shape>
679 <collision_shape>
680 <transformation>0 0 0.5 0 0 0</transformation>
681 <geometry>
682 <cylinder>
683 <radius>0.1</radius>
684 <height>0.9</height>
685 </cylinder>
686 </geometry>
687 </collision_shape>
688 </body>
689 <joint type="free" name="joint 1">
690 <parent>world</parent>
691 <child>base</child>
692 <transformation>0 0 0 0 0 0</transformation>
693 </joint>
694 <joint type="revolute" name="joint 2">
695 <parent>base</parent>
696 <child>upper_link</child>
697 <transformation>0 0 0 0 0 0</transformation>
698 <axis>
699 <xyz>1 0 0</xyz>
700 </axis>
701 </joint>
702 <joint type="revolute" name="joint 3">
703 <parent>upper_link</parent>
704 <child>lower_link</child>
705 <transformation>0 0 0 0 0 0</transformation>
706 <axis>
707 <xyz>1 0 0</xyz>
708 </axis>
709 </joint>
710 </skeleton>
711
712 <skeleton name="double_pendulum_with_base">
713 <transformation>1.48 1.48 0 0 0 -0.7854</transformation>
714 <body name="base">
715 <transformation>0 0 0 0 0 0</transformation>
716 <inertia>
717 <mass>100</mass>
718 </inertia>
719 <visualization_shape>
720 <transformation>0 0 0.01 0 0 0</transformation>
721 <geometry>
722 <cylinder>
723 <radius>0.8</radius>
724 <height>0.02</height>
725 </cylinder>
726 </geometry>
727 </visualization_shape>
728 <visualization_shape>
729 <transformation>-0.275 0 1.1 0 0 0</transformation>
730 <geometry>
731 <box>
732 <size>0.2 0.2 2.2</size>
733 </box>
734 </geometry>
735 </visualization_shape>
736 <collision_shape>
737 <transformation>0 0 0.01 0 0 0</transformation>
738 <geometry>
739 <cylinder>
740 <radius>0.8</radius>
741 <height>0.02</height>
742 </cylinder>
743 </geometry>
744 </collision_shape>
745 <collision_shape>
746 <transformation>-0.275 0 1.1 0 0 0</transformation>
747 <geometry>
748 <box>
749 <size>0.2 0.2 2.2</size>
750 </box>
751 </geometry>
752 </collision_shape>
753 </body>
754 <body name="upper_link">
755 <transformation>0 0 2.1 -1.5708 0 0</transformation>
756 <inertia>
757 <mass>1</mass>
758 <offset>0 0 0.5</offset>
759 </inertia>
760 <visualization_shape>
761 <transformation>-0.05 0 0 0 1.5708 0</transformation>
762 <geometry>
763 <cylinder>
764 <radius>0.1</radius>
765 <height>0.3</height>
766 </cylinder>
767 </geometry>
768 </visualization_shape>
769 <visualization_shape>
770 <transformation>0 0 1.0 0 1.5708 0</transformation>
771 <geometry>
772 <cylinder>
773 <radius>0.1</radius>
774 <height>0.2</height>
775 </cylinder>
776 </geometry>
777 </visualization_shape>
778 <visualization_shape>
779 <transformation>0 0 0.5 0 0 0</transformation>
780 <geometry>
781 <cylinder>
782 <radius>0.1</radius>
783 <height>0.9</height>
784 </cylinder>
785 </geometry>
786 </visualization_shape>
787 <collision_shape>
788 <transformation>-0.05 0 0 0 1.5708 0</transformation>
789 <geometry>
790 <cylinder>
791 <radius>0.1</radius>
792 <height>0.3</height>
793 </cylinder>
794 </geometry>
795 </collision_shape>
796 <collision_shape>
797 <transformation>0 0 1.0 0 1.5708 0</transformation>
798 <geometry>
799 <cylinder>
800 <radius>0.1</radius>
801 <height>0.2</height>
802 </cylinder>
803 </geometry>
804 </collision_shape>
805 <collision_shape>
806 <transformation>0 0 0.5 0 0 0</transformation>
807 <geometry>
808 <cylinder>
809 <radius>0.1</radius>
810 <height>0.9</height>
811 </cylinder>
812 </geometry>
813 </collision_shape>
814 </body>
815 <body name="lower_link">
816 <transformation>0.25 1.0 2.1 -2 0 0</transformation>
817 <inertia>
818 <mass>1</mass>
819 <offset>0 0 0.5</offset>
820 </inertia>
821 <visualization_shape>
822 <transformation>0 0 0 0 1.5708 0</transformation>
823 <geometry>
824 <cylinder>
825 <radius>0.08</radius>
826 <height>0.3</height>
827 </cylinder>
828 </geometry>
829 </visualization_shape>
830 <visualization_shape>
831 <transformation>0 0 0.5 0 0 0</transformation>
832 <geometry>
833 <cylinder>
834 <radius>0.1</radius>
835 <height>0.9</height>
836 </cylinder>
837 </geometry>
838 </visualization_shape>
839 <collision_shape>
840 <transformation>0 0 0 0 1.5708 0</transformation>
841 <geometry>
842 <cylinder>
843 <radius>0.08</radius>
844 <height>0.3</height>
845 </cylinder>
846 </geometry>
847 </collision_shape>
848 <collision_shape>
849 <transformation>0 0 0.5 0 0 0</transformation>
850 <geometry>
851 <cylinder>
852 <radius>0.1</radius>
853 <height>0.9</height>
854 </cylinder>
855 </geometry>
856 </collision_shape>
857 </body>
858 <joint type="free" name="joint 1">
859 <parent>world</parent>
860 <child>base</child>
861 <transformation>0 0 0 0 0 0</transformation>
862 </joint>
863 <joint type="revolute" name="joint 2">
864 <parent>base</parent>
865 <child>upper_link</child>
866 <transformation>0 0 0 0 0 0</transformation>
867 <axis>
868 <xyz>1 0 0</xyz>
869 </axis>
870 </joint>
871 <joint type="revolute" name="joint 3">
872 <parent>upper_link</parent>
873 <child>lower_link</child>
874 <transformation>0 0 0 0 0 0</transformation>
875 <axis>
876 <xyz>1 0 0</xyz>
877 </axis>
878 </joint>
879 </skeleton>
880
881 <skeleton name="double_pendulum_with_base">
882 <transformation>1.48 -1.48 0 0 0 -2.3562</transformation>
883 <body name="base">
884 <transformation>0 0 0 0 0 0</transformation>
885 <inertia>
886 <mass>100</mass>
887 </inertia>
888 <visualization_shape>
889 <transformation>0 0 0.01 0 0 0</transformation>
890 <geometry>
891 <cylinder>
892 <radius>0.8</radius>
893 <height>0.02</height>
894 </cylinder>
895 </geometry>
896 </visualization_shape>
897 <visualization_shape>
898 <transformation>-0.275 0 1.1 0 0 0</transformation>
899 <geometry>
900 <box>
901 <size>0.2 0.2 2.2</size>
902 </box>
903 </geometry>
904 </visualization_shape>
905 <collision_shape>
906 <transformation>0 0 0.01 0 0 0</transformation>
907 <geometry>
908 <cylinder>
909 <radius>0.8</radius>
910 <height>0.02</height>
911 </cylinder>
912 </geometry>
913 </collision_shape>
914 <collision_shape>
915 <transformation>-0.275 0 1.1 0 0 0</transformation>
916 <geometry>
917 <box>
918 <size>0.2 0.2 2.2</size>
919 </box>
920 </geometry>
921 </collision_shape>
922 </body>
923 <body name="upper_link">
924 <transformation>0 0 2.1 -1.5708 0 0</transformation>
925 <inertia>
926 <mass>1</mass>
927 <offset>0 0 0.5</offset>
928 </inertia>
929 <visualization_shape>
930 <transformation>-0.05 0 0 0 1.5708 0</transformation>
931 <geometry>
932 <cylinder>
933 <radius>0.1</radius>
934 <height>0.3</height>
935 </cylinder>
936 </geometry>
937 </visualization_shape>
938 <visualization_shape>
939 <transformation>0 0 1.0 0 1.5708 0</transformation>
940 <geometry>
941 <cylinder>
942 <radius>0.1</radius>
943 <height>0.2</height>
944 </cylinder>
945 </geometry>
946 </visualization_shape>
947 <visualization_shape>
948 <transformation>0 0 0.5 0 0 0</transformation>
949 <geometry>
950 <cylinder>
951 <radius>0.1</radius>
952 <height>0.9</height>
953 </cylinder>
954 </geometry>
955 </visualization_shape>
956 <collision_shape>
957 <transformation>-0.05 0 0 0 1.5708 0</transformation>
958 <geometry>
959 <cylinder>
960 <radius>0.1</radius>
961 <height>0.3</height>
962 </cylinder>
963 </geometry>
964 </collision_shape>
965 <collision_shape>
966 <transformation>0 0 1.0 0 1.5708 0</transformation>
967 <geometry>
968 <cylinder>
969 <radius>0.1</radius>
970 <height>0.2</height>
971 </cylinder>
972 </geometry>
973 </collision_shape>
974 <collision_shape>
975 <transformation>0 0 0.5 0 0 0</transformation>
976 <geometry>
977 <cylinder>
978 <radius>0.1</radius>
979 <height>0.9</height>
980 </cylinder>
981 </geometry>
982 </collision_shape>
983 </body>
984 <body name="lower_link">
985 <transformation>0.25 1.0 2.1 -2 0 0</transformation>
986 <inertia>
987 <mass>1</mass>
988 <offset>0 0 0.5</offset>
989 </inertia>
990 <visualization_shape>
991 <transformation>0 0 0 0 1.5708 0</transformation>
992 <geometry>
993 <cylinder>
994 <radius>0.08</radius>
995 <height>0.3</height>
996 </cylinder>
997 </geometry>
998 </visualization_shape>
999 <visualization_shape>
1000 <transformation>0 0 0.5 0 0 0</transformation>
1001 <geometry>
1002 <cylinder>
1003 <radius>0.1</radius>
1004 <height>0.9</height>
1005 </cylinder>
1006 </geometry>
1007 </visualization_shape>
1008 <collision_shape>
1009 <transformation>0 0 0 0 1.5708 0</transformation>
1010 <geometry>
1011 <cylinder>
1012 <radius>0.08</radius>
1013 <height>0.3</height>
1014 </cylinder>
1015 </geometry>
1016 </collision_shape>
1017 <collision_shape>
1018 <transformation>0 0 0.5 0 0 0</transformation>
1019 <geometry>
1020 <cylinder>
1021 <radius>0.1</radius>
1022 <height>0.9</height>
1023 </cylinder>
1024 </geometry>
1025 </collision_shape>
1026 </body>
1027 <joint type="free" name="joint 1">
1028 <parent>world</parent>
1029 <child>base</child>
1030 <transformation>0 0 0 0 0 0</transformation>
1031 </joint>
1032 <joint type="revolute" name="joint 2">
1033 <parent>base</parent>
1034 <child>upper_link</child>
1035 <transformation>0 0 0 0 0 0</transformation>
1036 <axis>
1037 <xyz>1 0 0</xyz>
1038 </axis>
1039 </joint>
1040 <joint type="revolute" name="joint 3">
1041 <parent>upper_link</parent>
1042 <child>lower_link</child>
1043 <transformation>0 0 0 0 0 0</transformation>
1044 <axis>
1045 <xyz>1 0 0</xyz>
1046 </axis>
1047 </joint>
1048 </skeleton>
1049
1050 <skeleton name="double_pendulum_with_base">
1051 <transformation>-1.48 -1.48 0 0 0 2.3562</transformation>
1052 <body name="base">
1053 <transformation>0 0 0 0 0 0</transformation>
1054 <inertia>
1055 <mass>100</mass>
1056 </inertia>
1057 <visualization_shape>
1058 <transformation>0 0 0.01 0 0 0</transformation>
1059 <geometry>
1060 <cylinder>
1061 <radius>0.8</radius>
1062 <height>0.02</height>
1063 </cylinder>
1064 </geometry>
1065 </visualization_shape>
1066 <visualization_shape>
1067 <transformation>-0.275 0 1.1 0 0 0</transformation>
1068 <geometry>
1069 <box>
1070 <size>0.2 0.2 2.2</size>
1071 </box>
1072 </geometry>
1073 </visualization_shape>
1074 <collision_shape>
1075 <transformation>0 0 0.01 0 0 0</transformation>
1076 <geometry>
1077 <cylinder>
1078 <radius>0.8</radius>
1079 <height>0.02</height>
1080 </cylinder>
1081 </geometry>
1082 </collision_shape>
1083 <collision_shape>
1084 <transformation>-0.275 0 1.1 0 0 0</transformation>
1085 <geometry>
1086 <box>
1087 <size>0.2 0.2 2.2</size>
1088 </box>
1089 </geometry>
1090 </collision_shape>
1091 </body>
1092 <body name="upper_link">
1093 <transformation>0 0 2.1 -1.5708 0 0</transformation>
1094 <inertia>
1095 <mass>1</mass>
1096 <offset>0 0 0.5</offset>
1097 </inertia>
1098 <visualization_shape>
1099 <transformation>-0.05 0 0 0 1.5708 0</transformation>
1100 <geometry>
1101 <cylinder>
1102 <radius>0.1</radius>
1103 <height>0.3</height>
1104 </cylinder>
1105 </geometry>
1106 </visualization_shape>
1107 <visualization_shape>
1108 <transformation>0 0 1.0 0 1.5708 0</transformation>
1109 <geometry>
1110 <cylinder>
1111 <radius>0.1</radius>
1112 <height>0.2</height>
1113 </cylinder>
1114 </geometry>
1115 </visualization_shape>
1116 <visualization_shape>
1117 <transformation>0 0 0.5 0 0 0</transformation>
1118 <geometry>
1119 <cylinder>
1120 <radius>0.1</radius>
1121 <height>0.9</height>
1122 </cylinder>
1123 </geometry>
1124 </visualization_shape>
1125 <collision_shape>
1126 <transformation>-0.05 0 0 0 1.5708 0</transformation>
1127 <geometry>
1128 <cylinder>
1129 <radius>0.1</radius>
1130 <height>0.3</height>
1131 </cylinder>
1132 </geometry>
1133 </collision_shape>
1134 <collision_shape>
1135 <transformation>0 0 1.0 0 1.5708 0</transformation>
1136 <geometry>
1137 <cylinder>
1138 <radius>0.1</radius>
1139 <height>0.2</height>
1140 </cylinder>
1141 </geometry>
1142 </collision_shape>
1143 <collision_shape>
1144 <transformation>0 0 0.5 0 0 0</transformation>
1145 <geometry>
1146 <cylinder>
1147 <radius>0.1</radius>
1148 <height>0.9</height>
1149 </cylinder>
1150 </geometry>
1151 </collision_shape>
1152 </body>
1153 <body name="lower_link">
1154 <transformation>0.25 1.0 2.1 -2 0 0</transformation>
1155 <inertia>
1156 <mass>1</mass>
1157 <offset>0 0 0.5</offset>
1158 </inertia>
1159 <visualization_shape>
1160 <transformation>0 0 0 0 1.5708 0</transformation>
1161 <geometry>
1162 <cylinder>
1163 <radius>0.08</radius>
1164 <height>0.3</height>
1165 </cylinder>
1166 </geometry>
1167 </visualization_shape>
1168 <visualization_shape>
1169 <transformation>0 0 0.5 0 0 0</transformation>
1170 <geometry>
1171 <cylinder>
1172 <radius>0.1</radius>
1173 <height>0.9</height>
1174 </cylinder>
1175 </geometry>
1176 </visualization_shape>
1177 <collision_shape>
1178 <transformation>0 0 0 0 1.5708 0</transformation>
1179 <geometry>
1180 <cylinder>
1181 <radius>0.08</radius>
1182 <height>0.3</height>
1183 </cylinder>
1184 </geometry>
1185 </collision_shape>
1186 <collision_shape>
1187 <transformation>0 0 0.5 0 0 0</transformation>
1188 <geometry>
1189 <cylinder>
1190 <radius>0.1</radius>
1191 <height>0.9</height>
1192 </cylinder>
1193 </geometry>
1194 </collision_shape>
1195 </body>
1196 <joint type="free" name="joint 1">
1197 <parent>world</parent>
1198 <child>base</child>
1199 <transformation>0 0 0 0 0 0</transformation>
1200 </joint>
1201 <joint type="revolute" name="joint 2">
1202 <parent>base</parent>
1203 <child>upper_link</child>
1204 <transformation>0 0 0 0 0 0</transformation>
1205 <axis>
1206 <xyz>1 0 0</xyz>
1207 </axis>
1208 </joint>
1209 <joint type="revolute" name="joint 3">
1210 <parent>upper_link</parent>
1211 <child>lower_link</child>
1212 <transformation>0 0 0 0 0 0</transformation>
1213 <axis>
1214 <xyz>1 0 0</xyz>
1215 </axis>
1216 </joint>
1217 </skeleton>
1218
1219 <skeleton name="double_pendulum_with_base">
1220 <transformation>-1.48 1.48 0 0 0 0.7854</transformation>
1221 <body name="base">
1222 <transformation>0 0 0 0 0 0</transformation>
1223 <inertia>
1224 <mass>100</mass>
1225 </inertia>
1226 <visualization_shape>
1227 <transformation>0 0 0.01 0 0 0</transformation>
1228 <geometry>
1229 <cylinder>
1230 <radius>0.8</radius>
1231 <height>0.02</height>
1232 </cylinder>
1233 </geometry>
1234 </visualization_shape>
1235 <visualization_shape>
1236 <transformation>-0.275 0 1.1 0 0 0</transformation>
1237 <geometry>
1238 <box>
1239 <size>0.2 0.2 2.2</size>
1240 </box>
1241 </geometry>
1242 </visualization_shape>
1243 <collision_shape>
1244 <transformation>0 0 0.01 0 0 0</transformation>
1245 <geometry>
1246 <cylinder>
1247 <radius>0.8</radius>
1248 <height>0.02</height>
1249 </cylinder>
1250 </geometry>
1251 </collision_shape>
1252 <collision_shape>
1253 <transformation>-0.275 0 1.1 0 0 0</transformation>
1254 <geometry>
1255 <box>
1256 <size>0.2 0.2 2.2</size>
1257 </box>
1258 </geometry>
1259 </collision_shape>
1260 </body>
1261 <body name="upper_link">
1262 <transformation>0 0 2.1 -1.5708 0 0</transformation>
1263 <inertia>
1264 <mass>1</mass>
1265 <offset>0 0 0.5</offset>
1266 </inertia>
1267 <visualization_shape>
1268 <transformation>-0.05 0 0 0 1.5708 0</transformation>
1269 <geometry>
1270 <cylinder>
1271 <radius>0.1</radius>
1272 <height>0.3</height>
1273 </cylinder>
1274 </geometry>
1275 </visualization_shape>
1276 <visualization_shape>
1277 <transformation>0 0 1.0 0 1.5708 0</transformation>
1278 <geometry>
1279 <cylinder>
1280 <radius>0.1</radius>
1281 <height>0.2</height>
1282 </cylinder>
1283 </geometry>
1284 </visualization_shape>
1285 <visualization_shape>
1286 <transformation>0 0 0.5 0 0 0</transformation>
1287 <geometry>
1288 <cylinder>
1289 <radius>0.1</radius>
1290 <height>0.9</height>
1291 </cylinder>
1292 </geometry>
1293 </visualization_shape>
1294 <collision_shape>
1295 <transformation>-0.05 0 0 0 1.5708 0</transformation>
1296 <geometry>
1297 <cylinder>
1298 <radius>0.1</radius>
1299 <height>0.3</height>
1300 </cylinder>
1301 </geometry>
1302 </collision_shape>
1303 <collision_shape>
1304 <transformation>0 0 1.0 0 1.5708 0</transformation>
1305 <geometry>
1306 <cylinder>
1307 <radius>0.1</radius>
1308 <height>0.2</height>
1309 </cylinder>
1310 </geometry>
1311 </collision_shape>
1312 <collision_shape>
1313 <transformation>0 0 0.5 0 0 0</transformation>
1314 <geometry>
1315 <cylinder>
1316 <radius>0.1</radius>
1317 <height>0.9</height>
1318 </cylinder>
1319 </geometry>
1320 </collision_shape>
1321 </body>
1322 <body name="lower_link">
1323 <transformation>0.25 1.0 2.1 -2 0 0</transformation>
1324 <inertia>
1325 <mass>1</mass>
1326 <offset>0 0 0.5</offset>
1327 </inertia>
1328 <visualization_shape>
1329 <transformation>0 0 0 0 1.5708 0</transformation>
1330 <geometry>
1331 <cylinder>
1332 <radius>0.08</radius>
1333 <height>0.3</height>
1334 </cylinder>
1335 </geometry>
1336 </visualization_shape>
1337 <visualization_shape>
1338 <transformation>0 0 0.5 0 0 0</transformation>
1339 <geometry>
1340 <cylinder>
1341 <radius>0.1</radius>
1342 <height>0.9</height>
1343 </cylinder>
1344 </geometry>
1345 </visualization_shape>
1346 <collision_shape>
1347 <transformation>0 0 0 0 1.5708 0</transformation>
1348 <geometry>
1349 <cylinder>
1350 <radius>0.08</radius>
1351 <height>0.3</height>
1352 </cylinder>
1353 </geometry>
1354 </collision_shape>
1355 <collision_shape>
1356 <transformation>0 0 0.5 0 0 0</transformation>
1357 <geometry>
1358 <cylinder>
1359 <radius>0.1</radius>
1360 <height>0.9</height>
1361 </cylinder>
1362 </geometry>
1363 </collision_shape>
1364 </body>
1365 <joint type="free" name="joint 1">
1366 <parent>world</parent>
1367 <child>base</child>
1368 <transformation>0 0 0 0 0 0</transformation>
1369 </joint>
1370 <joint type="revolute" name="joint 2">
1371 <parent>base</parent>
1372 <child>upper_link</child>
1373 <transformation>0 0 0 0 0 0</transformation>
1374 <axis>
1375 <xyz>1 0 0</xyz>
1376 </axis>
1377 </joint>
1378 <joint type="revolute" name="joint 3">
1379 <parent>upper_link</parent>
1380 <child>lower_link</child>
1381 <transformation>0 0 0 0 0 0</transformation>
1382 <axis>
1383 <xyz>1 0 0</xyz>
1384 </axis>
1385 </joint>
1386 </skeleton>
1387
1388
1389 </world>
1390 </skel>