| 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 -9.81 0</gravity> |
| 7 |
<collision_detector>fcl_mesh</collision_detector> |
| 8 |
</physics> |
| 9 |
<skeleton name="skeleton 1"> |
| 10 |
<body name="link 1"> |
| 11 |
<gravity>1</gravity> |
| 12 |
<transformation>0 0 0 0 0 0</transformation> |
| 13 |
<inertia> |
| 14 |
<mass>5</mass> |
| 15 |
<offset>0 0.5 0</offset> |
| 16 |
</inertia> |
| 17 |
<visualization_shape> |
| 18 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 19 |
<geometry> |
| 20 |
<box> |
| 21 |
<size>0.1 1.0 0.1</size> |
| 22 |
</box> |
| 23 |
</geometry> |
| 24 |
</visualization_shape> |
| 25 |
<collision_shape> |
| 26 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 27 |
<geometry> |
| 28 |
<box> |
| 29 |
<size>0.1 1.0 0.1</size> |
| 30 |
</box> |
| 31 |
</geometry> |
| 32 |
</collision_shape> |
| 33 |
</body> |
| 34 |
<body name="link 2"> |
| 35 |
<gravity>1</gravity> |
| 36 |
<transformation>0 1.0 0 0 0 0</transformation> |
| 37 |
<inertia> |
| 38 |
<mass>5</mass> |
| 39 |
<offset>0 0.5 0</offset> |
| 40 |
</inertia> |
| 41 |
<visualization_shape> |
| 42 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 43 |
<geometry> |
| 44 |
<box> |
| 45 |
<size>0.1 1.0 0.1</size> |
| 46 |
</box> |
| 47 |
</geometry> |
| 48 |
</visualization_shape> |
| 49 |
<collision_shape> |
| 50 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 51 |
<geometry> |
| 52 |
<box> |
| 53 |
<size>0.1 1.0 0.1</size> |
| 54 |
</box> |
| 55 |
</geometry> |
| 56 |
</collision_shape> |
| 57 |
</body> |
| 58 |
<body name="link 3"> |
| 59 |
<gravity>1</gravity> |
| 60 |
<transformation>0 1.0 0 0 0 0</transformation> |
| 61 |
<inertia> |
| 62 |
<mass>5</mass> |
| 63 |
<offset>0 0.5 0</offset> |
| 64 |
</inertia> |
| 65 |
<visualization_shape> |
| 66 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 67 |
<geometry> |
| 68 |
<box> |
| 69 |
<size>0.1 1.0 0.1</size> |
| 70 |
</box> |
| 71 |
</geometry> |
| 72 |
</visualization_shape> |
| 73 |
<collision_shape> |
| 74 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 75 |
<geometry> |
| 76 |
<box> |
| 77 |
<size>0.1 1.0 0.1</size> |
| 78 |
</box> |
| 79 |
</geometry> |
| 80 |
</collision_shape> |
| 81 |
</body> |
| 82 |
<body name="link 4"> |
| 83 |
<gravity>1</gravity> |
| 84 |
<transformation>0 1.0 0 0 0 0</transformation> |
| 85 |
<inertia> |
| 86 |
<mass>5</mass> |
| 87 |
<offset>0 0.5 0</offset> |
| 88 |
</inertia> |
| 89 |
<visualization_shape> |
| 90 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 91 |
<geometry> |
| 92 |
<box> |
| 93 |
<size>0.1 1.0 0.1</size> |
| 94 |
</box> |
| 95 |
</geometry> |
| 96 |
</visualization_shape> |
| 97 |
<collision_shape> |
| 98 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 99 |
<geometry> |
| 100 |
<box> |
| 101 |
<size>0.1 1.0 0.1</size> |
| 102 |
</box> |
| 103 |
</geometry> |
| 104 |
</collision_shape> |
| 105 |
</body> |
| 106 |
<body name="link 5"> |
| 107 |
<gravity>1</gravity> |
| 108 |
<transformation>0 1.0 0 0 0 0</transformation> |
| 109 |
<inertia> |
| 110 |
<mass>5</mass> |
| 111 |
<offset>0 0.5 0</offset> |
| 112 |
</inertia> |
| 113 |
<visualization_shape> |
| 114 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 115 |
<geometry> |
| 116 |
<box> |
| 117 |
<size>0.1 1.0 0.1</size> |
| 118 |
</box> |
| 119 |
</geometry> |
| 120 |
</visualization_shape> |
| 121 |
<collision_shape> |
| 122 |
<transformation>0 0.5 0 0 0 0</transformation> |
| 123 |
<geometry> |
| 124 |
<box> |
| 125 |
<size>0.1 1.0 0.1</size> |
| 126 |
</box> |
| 127 |
</geometry> |
| 128 |
</collision_shape> |
| 129 |
</body> |
| 130 |
<joint type="revolute" name="joint0"> |
| 131 |
<parent>world</parent> |
| 132 |
<child>link 1</child> |
| 133 |
<transformation>-0 0 0 0 0 0</transformation> |
| 134 |
<axis> |
| 135 |
<xyz>1 0 0</xyz> |
| 136 |
</axis> |
| 137 |
</joint> |
| 138 |
<joint type="revolute" name="joint1"> |
| 139 |
<parent>link 1</parent> |
| 140 |
<child>link 2</child> |
| 141 |
<transformation>-0 0 0 0 0 0</transformation> |
| 142 |
<axis> |
| 143 |
<xyz>1 0 0</xyz> |
| 144 |
<limit> |
| 145 |
<lower>-1.57</lower> |
| 146 |
<upper>+1.57</upper> |
| 147 |
</limit> |
| 148 |
</axis> |
| 149 |
<dof name="customJoint1" /> |
| 150 |
</joint> |
| 151 |
<joint type="prismatic" name="joint2"> |
| 152 |
<parent>link 2</parent> |
| 153 |
<child>link 3</child> |
| 154 |
<transformation>0 0 0 0 0 0</transformation> |
| 155 |
<axis> |
| 156 |
<xyz>1 0 0</xyz> |
| 157 |
</axis> |
| 158 |
<dof local_index="0"> |
| 159 |
<position lower="-1" upper="1" /> |
| 160 |
<velocity lower="-2" upper="2" /> |
| 161 |
<acceleration lower="-3" upper="3" /> |
| 162 |
<force lower="-4" upper="4" /> |
| 163 |
</dof> |
| 164 |
</joint> |
| 165 |
<joint type="universal" name="joint3"> |
| 166 |
<parent>link 3</parent> |
| 167 |
<child>link 4</child> |
| 168 |
<transformation>0 0 0 0 0 0</transformation> |
| 169 |
<axis> |
| 170 |
<xyz>1 0 0</xyz> |
| 171 |
<limit> |
| 172 |
<lower>-1</lower> |
| 173 |
<upper>+1</upper> |
| 174 |
</limit> |
| 175 |
</axis> |
| 176 |
<axis2> |
| 177 |
<xyz>0 1 0</xyz> |
| 178 |
<limit> |
| 179 |
<lower>-2</lower> |
| 180 |
<upper>+2</upper> |
| 181 |
</limit> |
| 182 |
</axis2> |
| 183 |
<dof local_index="0"> |
| 184 |
<position initial="5" /> |
| 185 |
</dof> |
| 186 |
<dof local_index="1"> |
| 187 |
<position initial="-5" /> |
| 188 |
</dof> |
| 189 |
</joint> |
| 190 |
<joint type="euler" name="joint4"> |
| 191 |
<parent>link 4</parent> |
| 192 |
<child>link 5</child> |
| 193 |
<transformation>0 0 0 0 0 0</transformation> |
| 194 |
<axis_order>xyz</axis_order> |
| 195 |
<dof local_index="0" name="joint4_1"> |
| 196 |
<position lower="-1" upper="+1" /> |
| 197 |
<velocity lower="-10" upper="+10" /> |
| 198 |
</dof> |
| 199 |
<dof local_index="2" name="joint4_3"> |
| 200 |
<position lower="-2" upper="+2" /> |
| 201 |
<velocity lower="-20" upper="+20" /> |
| 202 |
</dof> |
| 203 |
</joint> |
| 204 |
</skeleton> |
| 205 |
</world> |
| 206 |
</skel> |