hrp2 roms individually

.gitignore

@@ -21,6 +21,7 @@
 *.la
 *.a
 *.lib
+*.~
 
 # Executables
 *.exe

CMakeLists.txt

@@ -63,6 +63,10 @@ install(FILES
 install(FILES
   data/urdf/hrp2_trunk.urdf
   data/urdf/hrp2_rom.urdf
+  data/urdf/hrp2_larm_rom.urdf
+  data/urdf/hrp2_rarm_rom.urdf
+  data/urdf/hrp2_lleg_rom.urdf
+  data/urdf/hrp2_rleg_rom.urdf
   data/urdf/box_rom.urdf
   data/urdf/box.urdf
   data/urdf/scene.urdf
@@ -77,6 +81,10 @@ install(FILES
 install(FILES
   data/srdf/hrp2_trunk.srdf
   data/srdf/hrp2_rom.srdf
+  data/srdf/hrp2_larm_rom.srdf
+  data/srdf/hrp2_rarm_rom.srdf
+  data/srdf/hrp2_lleg_rom.srdf
+  data/srdf/hrp2_rleg_rom.srdf
   data/srdf/box_rom.srdf
   data/srdf/box.srdf
   data/srdf/scene.srdf
@@ -93,6 +101,10 @@ install(FILES
 	data/meshes/car_simple.stl
 	data/meshes/hrp2_trunk.stl
 	data/meshes/hrp2_rom.stl
+	data/meshes/hrp2_larm_rom.stl
+	data/meshes/hrp2_rarm_rom.stl
+	data/meshes/hrp2_lleg_rom.stl
+	data/meshes/hrp2_rleg_rom.stl
 	data/meshes/box.stl
 	data/meshes/box_rom.stl
 	data/meshes/robot_box.stl

data/roms/larm.mtl

+# Blender MTL File: 'None'
+# Material Count: 1
+
+newmtl None
+Ns 0
+Ka 0.000000 0.000000 0.000000
+Kd 0.8 0.8 0.8
+Ks 0.8 0.8 0.8
+d 1
+illum 2

data/roms/larm_simplified.obj

+# Blender v2.73 (sub 0) OBJ File: ''
+# www.blender.org
+mtllib larm_simplified.mtl
+o foo.006
+v 0.471864 0.637045 0.596030
+v 0.625106 0.211423 0.439950
+v 0.034593 0.830119 0.419576
+v 0.412882 0.328039 0.969182
+v -0.093839 0.358289 1.107049
+v 0.243123 0.097907 -0.004979
+v -0.340701 -0.045072 0.264209
+v -0.239482 0.141507 0.036961
+v -0.401176 0.598014 0.301043
+v -0.107242 0.530835 0.046378
+v 0.098829 0.722281 0.862508
+v 0.482362 -0.044217 0.707594
+v -0.009042 0.001540 1.045110
+v 0.344723 0.530876 0.126359
+vn 0.845700 0.423500 -0.324700
+vn 0.168700 0.249700 -0.953500
+vn -0.893200 -0.058500 -0.445800
+vn -0.878500 -0.276500 0.389600
+vn -0.279900 0.798100 -0.533600
+vn -0.608100 0.225000 -0.761300
+vn -0.509000 0.816500 0.272600
+vn 0.479200 -0.443000 0.757700
+vn 0.337200 0.924800 0.176200
+vn 0.114500 0.753300 -0.647600
+vn -0.643200 0.631400 0.433100
+vn -0.040200 -0.996300 0.076500
+vn -0.939200 -0.107000 0.326300
+vn 0.755900 0.021100 -0.654300
+vn 0.922100 0.213700 0.322700
+vn 0.915200 -0.103000 0.389700
+vn 0.487000 0.814300 -0.315900
+vn 0.127600 -0.963600 -0.235000
+vn -0.124300 -0.739000 -0.662100
+vn 0.255100 -0.106200 0.961100
+vn 0.615200 -0.707500 -0.347700
+vn -0.081800 0.051900 -0.995300
+vn 0.260100 0.439800 0.859600
+vn 0.552100 0.597200 0.581800
+usemtl None
+s off
+f 1//1 2//1 14//1
+f 6//2 10//2 14//2
+f 7//3 9//3 8//3
+f 7//4 13//4 5//4
+f 10//5 9//5 3//5
+f 10//6 8//6 9//6
+f 3//7 9//7 11//7
+f 12//8 4//8 13//8
+f 3//9 11//9 1//9
+f 3//10 14//10 10//10
+f 9//11 5//11 11//11
+f 13//12 7//12 12//12
+f 9//13 7//13 5//13
+f 2//14 6//14 14//14
+f 4//15 2//15 1//15
+f 12//16 2//16 4//16
+f 1//17 14//17 3//17
+f 7//18 6//18 12//18
+f 7//19 8//19 6//19
+f 5//20 13//20 4//20
+f 2//21 12//21 6//21
+f 10//22 6//22 8//22
+f 4//23 11//23 5//23
+f 11//24 4//24 1//24

data/roms/lleg.mtl

+# Blender MTL File: 'None'
+# Material Count: 1
+
+newmtl None
+Ns 0
+Ka 0.000000 0.000000 0.000000
+Kd 0.8 0.8 0.8
+Ks 0.8 0.8 0.8
+d 1
+illum 2

data/roms/lleg_simplified.obj

+# Blender v2.73 (sub 0) OBJ File: ''
+# www.blender.org
+mtllib lleg_simplified.mtl
+o foo.005
+v -0.393343 -0.297579 -0.099499
+v 0.272908 0.487093 -0.390070
+v -0.082955 0.163103 -0.640879
+v -0.547815 0.026542 -0.272289
+v 0.013126 0.315856 -0.592541
+v 0.513041 -0.026155 0.363769
+v 0.439627 0.413768 0.351181
+v 0.371203 0.144674 -0.529205
+v 0.427596 -0.274667 -0.359248
+v 0.468109 0.453346 -0.202635
+v 0.571740 0.242929 -0.258278
+v 0.631366 -0.121772 -0.035482
+v 0.436835 -0.328400 0.280415
+v -0.450214 0.213167 -0.437976
+v -0.473875 0.065873 0.015389
+v 0.120264 -0.133778 -0.606612
+v 0.614077 0.225148 0.120276
+v -0.225412 -0.377071 -0.405909
+v -0.474869 -0.134629 -0.380425
+v -0.367768 0.441520 -0.402518
+v -0.283692 -0.083673 -0.574466
+vn -0.847300 -0.027700 -0.530300
+vn 0.355300 0.437600 -0.826000
+vn 0.532400 -0.255500 -0.807000
+vn 0.886100 -0.316700 0.338500
+vn -0.342000 -0.168700 0.924400
+vn -0.399800 -0.355600 0.844800
+vn -0.463800 0.141900 -0.874500
+vn 0.160300 -0.983400 -0.084900
+vn -0.131200 -0.513300 -0.848100
+vn -0.335100 -0.029000 0.941700
+vn -0.923500 0.355700 -0.143400
+vn 0.989600 0.097000 -0.106100
+vn -0.432500 0.288800 -0.854100
+vn -0.916600 -0.290100 0.275200
+vn 0.240500 0.052700 -0.969200
+vn -0.278200 0.444400 -0.851500
+vn 0.818100 -0.118100 -0.562800
+vn 0.618700 0.471000 -0.628800
+vn -0.072700 0.990800 0.114400
+vn -0.906300 -0.422300 0.018100
+vn -0.693300 -0.692300 -0.200400
+vn -0.464500 0.714000 0.523900
+vn 0.241800 0.151200 -0.958500
+vn -0.044300 0.790100 -0.611400
+vn -0.550200 -0.495500 -0.672200
+vn 0.949000 -0.088500 0.302500
+vn -0.121500 -0.974900 0.186400
+vn -0.884100 0.436200 0.167600
+vn 0.661000 0.437500 -0.609600
+vn 0.867100 -0.148700 -0.475500
+vn 0.669100 -0.739700 -0.071800
+vn 0.780900 0.618900 0.084400
+vn 0.886100 0.456900 -0.077600
+vn 0.845200 0.155700 0.511400
+vn 0.098600 0.992200 0.076000
+vn 0.163800 -0.755800 -0.634000
+vn -0.701800 -0.067600 -0.709200
+vn -0.100400 -0.181600 -0.978200
+usemtl None
+s off
+f 14//1 19//1 4//1
+f 2//2 8//2 5//2
+f 8//3 9//3 16//3
+f 6//4 13//4 12//4
+f 13//5 6//5 15//5
+f 13//6 15//6 1//6
+f 14//7 3//7 21//7
+f 9//8 13//8 18//8
+f 21//9 16//9 18//9
+f 15//10 6//10 7//10
+f 4//11 20//11 14//11
+f 12//12 11//12 17//12
+f 14//13 20//13 3//13
+f 4//14 1//14 15//14
+f 8//15 16//15 3//15
+f 20//16 5//16 3//16
+f 11//17 9//17 8//17
+f 8//18 10//18 11//18
+f 20//19 7//19 2//19
+f 1//20 4//20 19//20
+f 19//21 18//21 1//21
+f 20//22 15//22 7//22
+f 3//23 5//23 8//23
+f 5//24 20//24 2//24
+f 21//25 18//25 19//25
+f 12//26 17//26 6//26
+f 18//27 13//27 1//27
+f 15//28 20//28 4//28
+f 10//29 8//29 2//29
+f 9//30 11//30 12//30
+f 13//31 9//31 12//31
+f 17//32 10//32 7//32
+f 17//33 11//33 10//33
+f 6//34 17//34 7//34
+f 2//35 7//35 10//35
+f 18//36 16//36 9//36
+f 14//37 21//37 19//37
+f 21//38 3//38 16//38

data/roms/rarm.mtl

+# Blender MTL File: 'None'
+# Material Count: 1
+
+newmtl None
+Ns 0
+Ka 0.000000 0.000000 0.000000
+Kd 0.8 0.8 0.8
+Ks 0.8 0.8 0.8
+d 1
+illum 2

data/roms/rarm_simplified.obj

+# Blender v2.73 (sub 0) OBJ File: ''
+# www.blender.org
+mtllib rarm_simplified.mtl
+o foo.006
+v -0.195895 -0.544572 0.097368
+v -0.028540 -0.099358 1.069956
+v 0.322578 -0.694041 0.769198
+v 0.201411 -0.325861 -0.023260
+v 0.515026 -0.252203 0.198149
+v -0.452998 -0.361069 0.288199
+v 0.541741 -0.523217 0.496222
+v -0.231697 -0.712460 0.342829
+v 0.234123 0.084796 0.849277
+v 0.294664 0.038096 0.188468
+v -0.043664 0.079680 0.247252
+v 0.293758 -0.749461 0.436512
+v 0.256153 -0.641849 0.160745
+v 0.041791 -0.550246 1.023645
+v 0.051716 -0.825769 0.570896
+v 0.093071 -0.106306 -0.014401
+v -0.134264 -0.715171 0.754239
+v -0.177901 -0.276580 0.994004
+v -0.397784 -0.061958 0.232150
+v -0.257342 -0.204064 0.041372
+v 0.373262 -0.264824 1.006375
+v 0.523068 -0.402420 0.799486
+v 0.587669 -0.100986 0.624356
+vn -0.716200 -0.522900 -0.462100
+vn -0.025200 -0.907400 -0.419500
+vn 0.507800 0.283400 -0.813500
+vn 0.111500 0.992000 -0.059900
+vn 0.446500 -0.472600 0.759800
+vn 0.751500 -0.453200 -0.479400
+vn 0.004600 -0.854200 0.519900
+vn 0.676500 -0.650200 -0.346000
+vn -0.293000 0.650800 -0.700500
+vn -0.259600 0.717900 -0.645900
+vn -0.000500 0.814900 -0.579500
+vn 0.330400 0.493100 0.804800
+vn 0.636200 0.512400 0.576800
+vn 0.516500 0.366300 -0.774000
+vn -0.186700 -0.192100 -0.963400
+vn 0.757400 0.563900 -0.329200
+vn 0.084700 -0.924300 -0.372200
+vn -0.436000 -0.894600 0.097400
+vn -0.445600 0.873000 0.198200
+vn -0.782800 0.502300 0.367400
+vn -0.371000 0.905900 0.204000
+vn 0.034300 -0.853400 0.520100
+vn 0.454400 0.890500 -0.021300
+vn -0.617300 -0.423800 0.662800
+vn -0.306900 -0.144500 0.940700
+vn -0.843200 -0.500500 0.196400
+vn -0.878200 -0.293700 0.377500
+vn -0.915600 0.230700 0.329300
+vn 0.663700 -0.745000 0.066600
+vn 0.987300 -0.063100 -0.145900
+vn -0.682400 -0.236900 -0.691600
+vn -0.095300 -0.815100 -0.571400
+vn -0.148100 -0.033200 -0.988400
+vn 0.552000 -0.452300 0.700500
+vn 0.841300 0.125200 0.525900
+vn 0.013400 -0.501400 -0.865100
+vn 0.359800 -0.924900 0.122900
+vn 0.982800 -0.142500 0.117300
+vn 0.595200 -0.324900 -0.735000
+vn -0.793200 0.032500 -0.608100
+vn 0.779400 -0.564100 0.272700
+vn 0.122500 -0.082500 0.989000
+usemtl None
+s off
+f 6//1 1//1 8//1
+f 8//2 13//2 15//2
+f 4//3 16//3 5//3
+f 9//4 10//4 11//4
+f 14//5 3//5 21//5
+f 7//6 13//6 5//6
+f 17//7 15//7 14//7
+f 13//8 7//8 12//8
+f 19//9 16//9 20//9
+f 19//10 11//10 16//10
+f 16//11 11//11 10//11
+f 21//12 9//12 2//12
+f 21//13 23//13 9//13
+f 5//14 16//14 10//14
+f 1//15 20//15 4//15
+f 10//16 23//16 5//16
+f 12//17 15//17 13//17
+f 8//18 15//18 17//18
+f 2//19 9//19 11//19
+f 2//20 19//20 18//20
+f 2//21 11//21 19//21
+f 3//22 14//22 15//22
+f 9//23 23//23 10//23
+f 14//24 18//24 17//24
+f 18//25 14//25 2//25
+f 6//26 8//26 17//26
+f 6//27 17//27 18//27
+f 6//28 18//28 19//28
+f 12//29 7//29 3//29
+f 5//30 23//30 7//30
+f 6//31 20//31 1//31
+f 13//32 8//32 1//32
+f 16//33 4//33 20//33
+f 22//34 21//34 3//34
+f 23//35 21//35 22//35
+f 13//36 1//36 4//36
+f 3//37 15//37 12//37
+f 22//38 7//38 23//38
+f 4//39 5//39 13//39
+f 20//40 6//40 19//40
+f 22//41 3//41 7//41
+f 2//42 14//42 21//42

data/roms/rleg.mtl

+# Blender MTL File: 'None'
+# Material Count: 1
+
+newmtl None
+Ns 0
+Ka 0.000000 0.000000 0.000000
+Kd 0.8 0.8 0.8
+Ks 0.8 0.8 0.8
+d 1
+illum 2

data/roms/rleg_simplified.obj

+# Blender v2.73 (sub 0) OBJ File: ''
+# www.blender.org
+mtllib rleg_simplified.mtl
+o foo.003
+v 0.670963 0.102935 -0.027393
+v 0.407031 -0.601767 0.165238
+v 0.290410 -0.412893 -0.509929
+v 0.281277 -0.178325 -0.605228
+v 0.544370 -0.068131 -0.399127
+v -0.590101 0.039516 -0.225541
+v -0.525239 -0.177504 0.038891
+v -0.392015 0.273126 -0.432941
+v -0.235892 -0.049362 -0.641381
+v 0.125452 0.013226 -0.662308
+v -0.495605 -0.287284 -0.418190
+v 0.294223 -0.554514 0.329685
+v 0.464471 -0.539453 -0.167069
+v 0.626338 -0.245351 -0.183756
+v 0.472157 0.221612 0.388866
+v 0.435869 0.188902 -0.459429
+v 0.040781 -0.588715 -0.445857
+v -0.087935 -0.375270 -0.602347
+v -0.432291 0.163043 0.078188
+v 0.530784 -0.233317 0.369544
+v 0.639749 -0.179521 0.213445
+v -0.388269 -0.540364 -0.228724
+vn 0.660600 -0.260300 -0.704100
+vn -0.900300 0.201200 0.386000
+vn -0.134900 0.491000 -0.860700
+vn -0.959800 -0.280600 0.005200
+vn -0.927900 -0.371700 0.029100
+vn 0.099800 0.994100 -0.042600
+vn 0.152900 -0.522700 -0.838700
+vn -0.704600 0.111800 -0.700700
+vn -0.785800 0.129300 -0.604800
+vn 0.208100 -0.967200 -0.145400
+vn -0.717600 0.690300 0.092100
+vn 0.736200 -0.357700 -0.574500
+vn -0.034100 -0.134100 -0.990400
+vn 0.186800 -0.363500 -0.912700
+vn 0.413100 -0.766000 -0.492500
+vn -0.093800 -0.054300 0.994100
+vn 0.788700 -0.478700 0.385600
+vn -0.094300 -0.994900 0.035300
+vn -0.323600 -0.020800 0.946000
+vn 0.548900 0.205100 -0.810300
+vn -0.417000 -0.687400 -0.594600
+vn 0.804500 0.078700 0.588700
+vn 0.903600 0.215700 0.370100
+vn 0.050500 0.715500 -0.696800
+vn 0.867600 0.268000 -0.418800
+vn 0.729900 -0.431800 -0.529900
+vn 0.427600 0.902400 -0.053100
+vn -0.500400 -0.628200 0.595700
+vn 0.871400 -0.487000 0.059300
+vn 0.621100 -0.529200 0.578100
+vn 0.876200 -0.479400 0.049900
+vn -0.332600 0.004400 0.943000
+vn -0.399600 -0.651900 -0.644400
+vn -0.131200 0.971200 0.198800
+vn -0.159400 -0.972500 0.170100
+vn 0.992500 -0.121100 -0.013400
+vn 0.535700 0.028100 -0.844000
+vn -0.445900 -0.303300 -0.842100
+vn 0.102600 -0.206500 -0.973100
+vn 0.942000 0.029400 -0.334300
+usemtl None
+s off
+f 3//1 4//1 5//1
+f 6//2 7//2 19//2
+f 8//3 10//3 9//3
+f 7//4 6//4 11//4
+f 7//5 11//5 22//5
+f 8//6 15//6 16//6
+f 18//7 3//7 17//7
+f 8//8 9//8 11//8
+f 8//9 11//9 6//9
+f 13//10 2//10 17//10
+f 8//11 6//11 19//11
+f 3//12 5//12 14//12
+f 10//13 18//13 9//13
+f 18//14 4//14 3//14
+f 13//15 17//15 3//15
+f 20//16 15//16 12//16
+f 21//17 20//17 2//17
+f 2//18 22//18 17//18
+f 7//19 15//19 19//19
+f 4//20 10//20 5//20
+f 18//21 17//21 11//21
+f 15//22 20//22 21//22
+f 15//23 21//23 1//23
+f 16//24 10//24 8//24
+f 1//25 5//25 16//25
+f 3//26 14//26 13//26
+f 15//27 1//27 16//27
+f 22//28 12//28 7//28
+f 2//29 13//29 21//29
+f 12//30 2//30 20//30
+f 21//31 13//31 14//31
+f 12//32 15//32 7//32
+f 22//33 11//33 17//33
+f 19//34 15//34 8//34
+f 12//35 22//35 2//35
+f 1//36 21//36 14//36
+f 10//37 16//37 5//37
+f 11//38 9//38 18//38
+f 18//39 10//39 4//39
+f 1//40 14//40 5//40

data/srdf/hrp2_larm_rom.srdf

+<?xml version="1.0"?>
+<robot name="hrp2_larm_rom">
+  <handle name="handle">
+    <position> 0 0 0 1 0 0 0 </position>
+    <link name="base_link"/>
+  </handle>
+  <handle name="handle2">
+    <position> 0 0 0
+      0 0 0.7071067811865476 0.7071067811865476 </position>
+    <link name="base_link"/>
+  </handle>
+  <contact name="box_surface">
+    <link name="base_link"/>
+    <point>-0.025 -0.025 -0.025   -0.025 0.025 -0.025   -0.025 -0.025 0.025   -0.025 0.025 0.025
+           +0.025 -0.025 -0.025   +0.025 0.025 -0.025   +0.025 -0.025 0.025   +0.025 0.025 0.025 </point>
+    <triangle> 0 2 1 4 5 6</triangle>
+  </contact>
+</robot>

data/srdf/hrp2_lleg_rom.srdf

+<?xml version="1.0"?>
+<robot name="hrp2_lleg_rom">
+  <handle name="handle">
+    <position> 0 0 0 1 0 0 0 </position>
+    <link name="base_link"/>
+  </handle>
+  <handle name="handle2">
+    <position> 0 0 0
+      0 0 0.7071067811865476 0.7071067811865476 </position>
+    <link name="base_link"/>
+  </handle>
+  <contact name="box_surface">
+    <link name="base_link"/>
+    <point>-0.025 -0.025 -0.025   -0.025 0.025 -0.025   -0.025 -0.025 0.025   -0.025 0.025 0.025
+           +0.025 -0.025 -0.025   +0.025 0.025 -0.025   +0.025 -0.025 0.025   +0.025 0.025 0.025 </point>
+    <triangle> 0 2 1 4 5 6</triangle>
+  </contact>
+</robot>