| 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="grount skeleton"> |
| 11 |
<body name="ground"> |
| 12 |
<transformation>0 0 -0.3 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="boxes"> |
| 41 |
<transformation>0 0 0 0 0 1.57</transformation> |
| 42 |
<body name="link1"> |
| 43 |
<gravity>1</gravity> |
| 44 |
<transformation>0 0 0 0 0 0</transformation> |
| 45 |
<inertia> |
| 46 |
<mass>100.0</mass> |
| 47 |
<offset>0.5 0 0.5</offset> |
| 48 |
<moment_of_inertia> |
| 49 |
<ixx>0.1</ixx> |
| 50 |
<iyy>0.1</iyy> |
| 51 |
<izz>0.1</izz> |
| 52 |
<ixy>0.1</ixy> |
| 53 |
<ixz>0.1</ixz> |
| 54 |
<iyz>0.1</iyz> |
| 55 |
</moment_of_inertia> |
| 56 |
</inertia> |
| 57 |
<visualization_shape> |
| 58 |
<transformation>0.5 0 0.5 0 0 0</transformation> |
| 59 |
<geometry> |
| 60 |
<box> |
| 61 |
<size>1 1 1</size> |
| 62 |
</box> |
| 63 |
</geometry> |
| 64 |
</visualization_shape> |
| 65 |
<collision_shape> |
| 66 |
<transformation>0.5 0 0.5 0 0 0</transformation> |
| 67 |
<geometry> |
| 68 |
<box> |
| 69 |
<size>1 1 1</size> |
| 70 |
</box> |
| 71 |
</geometry> |
| 72 |
</collision_shape> |
| 73 |
</body> |
| 74 |
|
| 75 |
<body name="link2"> |
| 76 |
<gravity>1</gravity> |
| 77 |
<transformation>1.0 0 1.0 0 0 0</transformation> |
| 78 |
<inertia> |
| 79 |
<mass>5.0</mass> |
| 80 |
<offset>0.5 0 0.5</offset> |
| 81 |
<moment_of_inertia> |
| 82 |
<ixx>0.1</ixx> |
| 83 |
<iyy>0.1</iyy> |
| 84 |
<izz>0.1</izz> |
| 85 |
<ixy>0.1</ixy> |
| 86 |
<ixz>0.1</ixz> |
| 87 |
<iyz>0.1</iyz> |
| 88 |
</moment_of_inertia> |
| 89 |
</inertia> |
| 90 |
<visualization_shape> |
| 91 |
<transformation>0.5 0 0.5 0 0 0</transformation> |
| 92 |
<geometry> |
| 93 |
<box> |
| 94 |
<size>1 1 1</size> |
| 95 |
</box> |
| 96 |
</geometry> |
| 97 |
</visualization_shape> |
| 98 |
<collision_shape> |
| 99 |
<transformation>0.5 0 0.5 0 0 0</transformation> |
| 100 |
<geometry> |
| 101 |
<box> |
| 102 |
<size>1 1 1</size> |
| 103 |
</box> |
| 104 |
</geometry> |
| 105 |
</collision_shape> |
| 106 |
</body> |
| 107 |
|
| 108 |
<body name="link3"> |
| 109 |
<gravity>1</gravity> |
| 110 |
<transformation>2.0 0 2.0 0 0 0</transformation> |
| 111 |
<inertia> |
| 112 |
<mass>1.0</mass> |
| 113 |
<offset>0.5 0.5 0.5</offset> |
| 114 |
<moment_of_inertia> |
| 115 |
<ixx>0.1</ixx> |
| 116 |
<iyy>0.1</iyy> |
| 117 |
<izz>0.1</izz> |
| 118 |
<ixy>0.1</ixy> |
| 119 |
<ixz>0.1</ixz> |
| 120 |
<iyz>0.1</iyz> |
| 121 |
</moment_of_inertia> |
| 122 |
</inertia> |
| 123 |
<visualization_shape> |
| 124 |
<transformation>0.5 0 0.5 0 0 0</transformation> |
| 125 |
<geometry> |
| 126 |
<box> |
| 127 |
<size>1 1 1</size> |
| 128 |
</box> |
| 129 |
</geometry> |
| 130 |
</visualization_shape> |
| 131 |
<collision_shape> |
| 132 |
<transformation>0.5 0 0.5 0 0 0</transformation> |
| 133 |
<geometry> |
| 134 |
<box> |
| 135 |
<size>1 1 1</size> |
| 136 |
</box> |
| 137 |
</geometry> |
| 138 |
</collision_shape> |
| 139 |
</body> |
| 140 |
|
| 141 |
<joint type="free" name="joint0"> |
| 142 |
<parent>world</parent> |
| 143 |
<child>link1</child> |
| 144 |
</joint> |
| 145 |
|
| 146 |
<joint type="revolute" name="joint1"> |
| 147 |
<parent>link1</parent> |
| 148 |
<child>link2</child> |
| 149 |
<axis> |
| 150 |
<xyz>0 1 0</xyz> |
| 151 |
<dynamics> |
| 152 |
<damping>100.0</damping> |
| 153 |
</dynamics> |
| 154 |
</axis> |
| 155 |
</joint> |
| 156 |
|
| 157 |
<joint type="revolute" name="joint2"> |
| 158 |
<parent>link2</parent> |
| 159 |
<child>link3</child> |
| 160 |
<axis> |
| 161 |
<xyz>0 1 0</xyz> |
| 162 |
<dynamics> |
| 163 |
<damping>30.0</damping> |
| 164 |
</dynamics> |
| 165 |
</axis> |
| 166 |
</joint> |
| 167 |
|
| 168 |
</skeleton> |
| 169 |
|
| 170 |
</world> |
| 171 |
</skel> |