| 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>-30 10 -50</gravity> |
| 7 |
<collision_detector>fcl_mesh</collision_detector> |
| 8 |
</physics> |
| 9 |
|
| 10 |
<skeleton name="grount skeleton"> |
| 11 |
<body name="ground"> |
| 12 |
<transformation>0 0 0 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.05</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.05</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 |
<!-- to demonstrate force torque, we'll construct a model with |
| 37 |
two bodies stacked vertically, with a x-revolute joint connecting |
| 38 |
. The joint has 90 degree limit. We'll test force |
| 39 |
torque readings and characterize them. --> |
| 40 |
<skeleton name="model_1"> |
| 41 |
<body name="link_1"> |
| 42 |
<gravity>1</gravity> |
| 43 |
<transformation>0 0 0 0 0 0</transformation> |
| 44 |
<inertia> |
| 45 |
<mass>10.0</mass> |
| 46 |
<offset>0 0 0.5</offset> |
| 47 |
<moment_of_inertia> |
| 48 |
<ixx>0.1</ixx> |
| 49 |
<iyy>0.1</iyy> |
| 50 |
<izz>0.1</izz> |
| 51 |
<ixy>0.0</ixy> |
| 52 |
<ixz>0.0</ixz> |
| 53 |
<iyz>0.0</iyz> |
| 54 |
</moment_of_inertia> |
| 55 |
</inertia> |
| 56 |
<visualization_shape> |
| 57 |
<transformation>0 0 0.5 0 0 0</transformation> |
| 58 |
<geometry> |
| 59 |
<ellipsoid> |
| 60 |
<size>0.1 0.1 0.1</size> |
| 61 |
</ellipsoid> |
| 62 |
</geometry> |
| 63 |
</visualization_shape> |
| 64 |
<collision_shape> |
| 65 |
<transformation>0 0 0.5 0 0 0</transformation> |
| 66 |
<geometry> |
| 67 |
<ellipsoid> |
| 68 |
<size>0.1 0.1 0.1</size> |
| 69 |
</ellipsoid> |
| 70 |
</geometry> |
| 71 |
</collision_shape> |
| 72 |
</body> |
| 73 |
|
| 74 |
<body name="link_2"> |
| 75 |
<gravity>1</gravity> |
| 76 |
<transformation>0 0 1.5 0 0 0</transformation> |
| 77 |
<inertia> |
| 78 |
<mass>10.0</mass> |
| 79 |
<offset>0 0 0.5</offset> |
| 80 |
<moment_of_inertia> |
| 81 |
<ixx>0.1</ixx> |
| 82 |
<iyy>0.1</iyy> |
| 83 |
<izz>0.1</izz> |
| 84 |
<ixy>0.0</ixy> |
| 85 |
<ixz>0.0</ixz> |
| 86 |
<iyz>0.0</iyz> |
| 87 |
</moment_of_inertia> |
| 88 |
</inertia> |
| 89 |
<visualization_shape> |
| 90 |
<transformation>0 0 0.5 0 0 0</transformation> |
| 91 |
<geometry> |
| 92 |
<box> |
| 93 |
<size>0.1 0.2 0.4</size> |
| 94 |
</box> |
| 95 |
</geometry> |
| 96 |
</visualization_shape> |
| 97 |
<collision_shape> |
| 98 |
<transformation>0 0 0.5 0 0 0</transformation> |
| 99 |
<geometry> |
| 100 |
<box> |
| 101 |
<size>0.1 0.2 0.4</size> |
| 102 |
</box> |
| 103 |
</geometry> |
| 104 |
</collision_shape> |
| 105 |
</body> |
| 106 |
|
| 107 |
<joint type="revolute" name="joint1"> |
| 108 |
<transformation>0 0 0.5 0 0 0</transformation> |
| 109 |
<parent>world</parent> |
| 110 |
<child>link_1</child> |
| 111 |
<axis> |
| 112 |
<xyz>1 0 0</xyz> |
| 113 |
<dynamics> |
| 114 |
<damping>0.0</damping> |
| 115 |
</dynamics> |
| 116 |
<limit> |
| 117 |
<lower>-1.57079</lower> |
| 118 |
<upper>1.57079</upper> |
| 119 |
</limit> |
| 120 |
</axis> |
| 121 |
</joint> |
| 122 |
|
| 123 |
<joint type="revolute" name="joint2"> |
| 124 |
<transformation>0 0 0 0 0 0</transformation> |
| 125 |
<parent>link_1</parent> |
| 126 |
<child>link_2</child> |
| 127 |
<axis> |
| 128 |
<xyz>0 0 1</xyz> |
| 129 |
<dynamics> |
| 130 |
<damping>0.0</damping> |
| 131 |
</dynamics> |
| 132 |
</axis> |
| 133 |
</joint> |
| 134 |
|
| 135 |
</skeleton> |
| 136 |
|
| 137 |
</world> |
| 138 |
</skel> |