From 46b46426c5cc324de1cae4cb35b6b1596dfd66a5 Mon Sep 17 00:00:00 2001
From: Steve Tonneau <stonneau@axle.laas.fr>
Date: Tue, 6 Oct 2015 17:59:42 +0200
Subject: [PATCH] rom generation for hyq

---
 CMakeLists.txt                    |  25 ++++++++++++++++++++++---
 data/meshes/hyq/hyq_lfleg_rom.stl | Bin 0 -> 1184 bytes
 data/meshes/hyq/hyq_lhleg_rom.stl | Bin 0 -> 1284 bytes
 data/meshes/hyq/hyq_rfleg_rom.stl | Bin 0 -> 1284 bytes
 data/meshes/hyq/hyq_rhleg_rom.stl | Bin 0 -> 1284 bytes
 data/meshes/hyq/hyq_rom.stl       | Bin 0 -> 4784 bytes
 data/meshes/hyq/hyq_trunk.stl     | Bin 0 -> 684 bytes
 data/srdf/hyq/hrp2_trunk.srdf     |  18 ++++++++++++++++++
 data/srdf/hyq/hyq_lfleg_rom.srdf  |   3 +++
 data/srdf/hyq/hyq_lhleg_rom.srdf  |   3 +++
 data/srdf/hyq/hyq_rfleg_rom.srdf  |   3 +++
 data/srdf/hyq/hyq_rhleg_rom.srdf  |   3 +++
 data/srdf/hyq/hyq_rom.srdf        |   3 +++
 data/srdf/hyq/hyq_trunk.srdf      |   3 +++
 data/urdf/hyq/hyq_lfleg_rom.urdf  |  19 +++++++++++++++++++
 data/urdf/hyq/hyq_lhleg_rom.urdf  |  19 +++++++++++++++++++
 data/urdf/hyq/hyq_rfleg_rom.urdf  |  19 +++++++++++++++++++
 data/urdf/hyq/hyq_rhleg_rom.urdf  |  19 +++++++++++++++++++
 data/urdf/hyq/hyq_rom.urdf        |  19 +++++++++++++++++++
 data/urdf/hyq/hyq_trunk.urdf      |  19 +++++++++++++++++++
 20 files changed, 172 insertions(+), 3 deletions(-)
 create mode 100644 data/meshes/hyq/hyq_lfleg_rom.stl
 create mode 100644 data/meshes/hyq/hyq_lhleg_rom.stl
 create mode 100644 data/meshes/hyq/hyq_rfleg_rom.stl
 create mode 100644 data/meshes/hyq/hyq_rhleg_rom.stl
 create mode 100644 data/meshes/hyq/hyq_rom.stl
 create mode 100644 data/meshes/hyq/hyq_trunk.stl
 create mode 100644 data/srdf/hyq/hrp2_trunk.srdf
 create mode 100644 data/srdf/hyq/hyq_lfleg_rom.srdf
 create mode 100644 data/srdf/hyq/hyq_lhleg_rom.srdf
 create mode 100644 data/srdf/hyq/hyq_rfleg_rom.srdf
 create mode 100644 data/srdf/hyq/hyq_rhleg_rom.srdf
 create mode 100644 data/srdf/hyq/hyq_rom.srdf
 create mode 100644 data/srdf/hyq/hyq_trunk.srdf
 create mode 100644 data/urdf/hyq/hyq_lfleg_rom.urdf
 create mode 100644 data/urdf/hyq/hyq_lhleg_rom.urdf
 create mode 100644 data/urdf/hyq/hyq_rfleg_rom.urdf
 create mode 100644 data/urdf/hyq/hyq_rhleg_rom.urdf
 create mode 100644 data/urdf/hyq/hyq_rom.urdf
 create mode 100644 data/urdf/hyq/hyq_trunk.urdf

diff --git a/CMakeLists.txt b/CMakeLists.txt
index 1119fd1..4ce522c 100755
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -68,6 +68,12 @@ install(FILES
   data/urdf/hrp2_rarm_rom.urdf
   data/urdf/hrp2_lleg_rom.urdf
   data/urdf/hrp2_rleg_rom.urdf
+  data/urdf/hyq/hyq_trunk.urdf
+  data/urdf/hyq/hyq_rhleg_rom.urdf
+  data/urdf/hyq/hyq_rfleg_rom.urdf
+  data/urdf/hyq/hyq_lhleg_rom.urdf
+  data/urdf/hyq/hyq_lfleg_rom.urdf
+  data/urdf/hyq/hyq_rom.urdf
   data/urdf/box_rom.urdf
   data/urdf/box.urdf
   data/urdf/scene.urdf
@@ -88,6 +94,12 @@ install(FILES
   data/srdf/hrp2_rarm_rom.srdf
   data/srdf/hrp2_lleg_rom.srdf
   data/srdf/hrp2_rleg_rom.srdf
+  data/srdf/hyq/hyq_trunk.srdf
+  data/srdf/hyq/hyq_rhleg_rom.srdf
+  data/srdf/hyq/hyq_rfleg_rom.srdf
+  data/srdf/hyq/hyq_lhleg_rom.srdf
+  data/srdf/hyq/hyq_lfleg_rom.srdf
+  data/srdf/hyq/hyq_rom.srdf
   data/srdf/box_rom.srdf
   data/srdf/box.srdf
   data/srdf/scene.srdf
@@ -121,14 +133,21 @@ install(FILES
 	data/meshes/truck.stl
 	data/meshes/truck_vision.stl
 	data/meshes/stair_bauzil.stl
-        data/meshes/stair_bauzil_reduced.stl
+    data/meshes/stair_bauzil_reduced.stl
 	data/meshes/climb.stl
 	data/meshes/stepladder.stl
 	data/meshes/chair.stl
-	#~ data/meshes/pedal.stl
-	#~ data/meshes/board.stl
   DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}/meshes
   )
+install(FILES
+	data/meshes/hyq/hyq_trunk.stl
+	data/meshes/hyq/hyq_rom.stl
+	data/meshes/hyq/hyq_rhleg_rom.stl
+	data/meshes/hyq/hyq_rfleg_rom.stl
+	data/meshes/hyq/hyq_lhleg_rom.stl
+	data/meshes/hyq/hyq_lfleg_rom.stl
+  DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}/meshes/hyq
+  )
   
 SETUP_PROJECT_FINALIZE()
 
diff --git a/data/meshes/hyq/hyq_lfleg_rom.stl b/data/meshes/hyq/hyq_lfleg_rom.stl
new file mode 100644
index 0000000000000000000000000000000000000000..21491da2a743a3bbf127977a5ab94952aea60b72
GIT binary patch
literal 1184
zcmb7?T}abm6vj`vg_DIV#q7#C5;dmG%{8O;p4JBxB!rd0SULXN(u;KSD+@#g2}Otq
z9Ef!>OuEovf=YgD=Wj?|t&k`UyGdGJR9Yz!C_?M*yqCS#=XuZbJm+`rPAJ&a67U;u
zHU;aAr*8!s{DGztYpKI-ENX65jFw{fua}dW{`8t+`5o_t?NJ^2OviAg+a*G6W@r12
zPV|JcF>y&tnQk*~+Wa`a`+xx6-gh~lZ!C#2ovh$fE6Fxt3<q&h`%jU4S{(B)`_<;q
z7r}QxgPkJlzIY_DLAbRgdNn7hdbL~yXz(fGo?%v;c~+~=y2pfJpa_2+E>OMwE?k^H
zh_ITaPS<I1FmPV<_%5Ur_T?@S9WBG?m|0SAS6mICiQbM+yiwG}`fq}7SB`Yyyk#iX
zw>?afTc~|F?A-sW67{1wDo@CFaJK-5`t<m2CP=e&m8xN(5xoOm0opw(-zVoN+xv<<
z9i?c}<VidDzZG-&v~RZpE2?@@?f!nDsHSSYh@^ie_|qNBa6J|gM~TYYl@-4ADx6Tp
zMOw`o@lN>7xm$qDk-M0j>vx{`aFzHJ?@Cq_*z3ufZljAkEmB(UP)<IXrpKP^o6gHe
zuSj?1|H_K59mnzPWG1#xB_u|<L!J*n3EOb3(@p7Fr4sEt2Ui1>_b!kfM(AV0Bj;f3
z@=O46T?Wludm_FUhLHEpS>p5nOl7Z9B<>-HqefEj3vzXetHNB`dD$q+ms%y-rG7XI
lP^`&AI5kh<T#G~^PtK_XprIc$ctD5NZJWw-a1!O@e*y7`-wgl&

literal 0
HcmV?d00001

diff --git a/data/meshes/hyq/hyq_lhleg_rom.stl b/data/meshes/hyq/hyq_lhleg_rom.stl
new file mode 100644
index 0000000000000000000000000000000000000000..2d67f18a5330d466c0fab417205e3a61b00f95d5
GIT binary patch
literal 1284
zcmb7@T}abm6vj_E{2;wZV@@}7n$;9tF|{0S?;ANK%9deKU^Hl3lgK%zq0Obsz&=2X
z1S=#hQ?Raf(TCag9+WhLu(G@niLwGUFZ%F8yr_10-pl^i=Q+>sJkR?tZSvH58=Ma9
zX>V<fcJEoI+u`))8T7jgwYvIqr?fk>;lDmrWO^dW#gx6t{EVUuAJrw|mFZo)+ONVu
z>MQd~M;u>J#vvGfg)3HunQpuo0rC@;LYbovSg5*AQqZa3li$L#&BR7l_eB&<4ePlt
zbF&x<9>>5tjewInVY{W1_Ikb<*xgT?!m5;20gy1BX)4#)QDa<YR8je-6z5|sOtqM9
z9=?}~#)nzLe<Um7;dTYZ?f4cEGwDL;x8RRC4GY+EkdnxX)i1f&WmsbYR{|bb^x<?@
z27g_s7c_;ryk;Eg9AMW+=Oa|s+?T@c_OlX`UAmllP;Y>e>1H<ep@27i&qj;yv#{pX
zbKTXOf~HIT04(|(?nrxTdaUCpWkNcjYJlDzRXEuw1o&&DYiVxs<<Q>Eb_7lQ(xe(g
zOC9F>IhDL9$|_M&T7ZDKz{~$Cn4)MVM5!nV-2`B;ZpB&Ugiy9edM15Pl0CwYptxKd
z{q|WT-Oj#asLoFjZ*C|!?SoFy{sE@;Td=~BD4rK+QEH0#Q8hru*hXx9-_49Zi_{<`
zlr}+nTNOK4r51xxjnaFi=}P@W>y{1S-n1E3+EdLbFHMx*2heu@VtAlzmL;!qNeY@M
zRRe6F>NGbDoxnTSKvGaD+7m!j(kvTa^N6E^Hct0aLRr!HvlZiC1WfvVXNaaq+2yPb
lt;J%rx`b!<jYxkHRmgWN#CpPqTO9at`75I&)Q`RxfPdhzCd2>$

literal 0
HcmV?d00001

diff --git a/data/meshes/hyq/hyq_rfleg_rom.stl b/data/meshes/hyq/hyq_rfleg_rom.stl
new file mode 100644
index 0000000000000000000000000000000000000000..014342bb9d25053cf19197065adfd7ae3b94645f
GIT binary patch
literal 1284
zcmb7DUr3Wt6hCB{D5T-UAzEJ`m{wxqRLbvObu2VeE5Zyj$ZfW?bei@@43xlT2}wpG
zNDd)zDH76y)xL8LAH*yeJ!s@Yu}Fh5oD40~+T*#sb)V1g{QjM5x^AzjtG8N|in^N1
zO710VwZ&R@AT>F|pzOWUP_CpT!hbz|VETP=BrjMuir*QXm{+yVLc?o?v*tc78uZ*b
zm?xUef3TsXg>S6Iijsm=4WP<Bi={^#?CDA=S7Oo-no88UfiF0cz8m$=naJ!l;q<oz
zZu^vjN#0x)K=fY|_pZLtin6PbBAS0rXs$;C=<&q}iUwHnnpxq@0@DYV39wYM{ul$>
z3`-U%{z5*O<5BesJB4Lsilq!kV9&l|0wBcOhlw}JMgHv}gvK?sBPvbk<HH5@By+&D
z{pCV@oG6YyDyUnE*3HhdxsheGb*cf5JpXoaYvMd}*-uESs1NE7;8crMJF}cGhKFJW
z-AnnX!T?9~RvyPR_o$&%ayw|R=c6I7F?;+6%Fes`_He(+&P2M(X;ZDAn>jcOGoP*W
z{?muo5wE$sC-H-;lGCQB61oXM=kYVg(09$*bxu$vG#^>j!5}|-6+DK=9df!9K{o-k
zFE;Xl{4(urn-QsYszgSZqc#pd&h_BwnTwoir=H}_J1k?^qnlUjmnx<Ep$*b|1ISwK
z#-N0UXgp~Xbc*_*%>p!SDdI`Ws=CV-DP=`(m-+*^nS8<BJ8tG#onIMcr?*5s0Zb|F
z+U64*|K)ne=w3P{bKEs2@!)Ko;9<+s-=>MuqydbfJJhfT72NXTBcppMA5|Mr<=Zb}
gCw+LQHA2dY<|FrUc3TJf+76*9wN^sVTauE7zYMKTkpKVy

literal 0
HcmV?d00001

diff --git a/data/meshes/hyq/hyq_rhleg_rom.stl b/data/meshes/hyq/hyq_rhleg_rom.stl
new file mode 100644
index 0000000000000000000000000000000000000000..e0f2e6a49fcef34db3bd134956c13c1eb6fec9e1
GIT binary patch
literal 1284
zcmb7^ZAepL6vq!`_+DCBBmFQ^aF&XerHkF?`hu^d7+GW%nQlo|x@N&hSVAQWEhQlq
zQCzSxFwrF=3-5D=6x3qq=mk^BgbKo5Oer<8+Q;*J?0$XDIsgCj`=96LTFv#AQzoPK
zh^797Hv71#&S<hEZAnhwrqwl^uF|F?z<+%jfAxcD-{9C^qa15{&ob;A(EWA|>x<ij
z*SD9WQnQ!qY>Nh^WlB<PUMVFc7y)9G%WBiWF3fxwiSBY8mX_rqxTd+gvyi`Q%)<7p
zPz*0#i5+9L*gR+F0Ot-(GJVw#DX`dxbXI2UAF0B7pD(!Ap~lnA!9K3GF6H|*l7jVY
zY$!tRT~;D=&?@Q{Ai5=5KA0SeUj16UdvQ)OFXZ7&NUq?D>H&Oro|P|+zcTzD)k*Y(
zI;4{TVn2jo>Fg*^+nj-w6Afr@bn>R0MPBL9qlY=T(wQO<0kEf<F}pZ`6_wm#u5K&d
zIjlu1kK>eX{8KANw0aFQd*1k2HF(l+$q;~DALlvkpn8-#fIE0ny?G%X3)^I*8PKYN
z$FF%)^E@B;Cj05`s3=gK(ZhV>v!gOiin^lO0A2YWHv8osbM^0+X%*!|xdF77IoZhb
zL9Tgm0I519P2B>F>^8BlZDzc>?>wh-sY9_NF}$2RhQrkKz%xiQpj$$<0s7=fd{R9j
z?fhGclsnxeN*bVcIuYf(8n(QDtB|?SLGlMk_1Q4|Wt3XubE%Xf)e|*V%xkbOJ_mm(
zHX(DGAf*8CsArV_Y@g!2Jw?LCQ3~SC>n0R-WtE2C2sI0NP*yY>fFN&_VaQu8Pqlm!
u{tWaUbQb`!*LUz3M-aQ_vk32*x}w|wKCiw#*q`9xC*zI@n@IB)HU0rBV{P^T

literal 0
HcmV?d00001

diff --git a/data/meshes/hyq/hyq_rom.stl b/data/meshes/hyq/hyq_rom.stl
new file mode 100644
index 0000000000000000000000000000000000000000..5c8986a63c494f952d102b9f882a86ae88c5e5cb
GIT binary patch
literal 4784
zcmb7Id0fru8h=Kibwtsjj3l>Z(oG9B&hLFoW#TH?m$FRfG&NkD$RJG};||$wU0E^=
z=Z2Z6Axl?se(w{;Uc}gLx<mGzYPuzZIrHE1-v4g@_I{u5da6$`iwtw;Wu)jmKA$&t
zw#U%Frp(c&%o`9CFgVo1Xa0g@k3e7ezrLnfUf-DD%;Vlf;ctTrMC`0L%&tp1n&z$(
zk3u!vR2qv$-FvZM(o+7m%^fGjwW<KK%(q11uv}KwoX9<Tg$T%+q}(ofASwp+5t<_m
z!?wqW>(9J-+TBRuS3gt%z~Y6N_hq#@Dq@bH2;=Ls>h5hNqPD3QQZ&GedL4_u`H*Qk
zO-0bpWW~Kg**p6H3~Y(#rIEFY=3!UVH(z6c2b{##k4GYaO?{E@U7U==SL_v#*{0-o
z4?&Gr7o?tK4!CYO`p~O4PH-K8)GbB3+`7YVS2T*W0>#1++tL}Ao&AjMHjI{3Q6JPF
zz__I;>g2}ZcwnzP(z}$8DztF8TJzpaHCKfuN^VOH8NABooQOF6QpnCX74_vUF$RW%
z6i%C3e$U9k6d!h|dHetLQJ?Fjnm3;pb-QPB+7wknF9EpJwy@m2&sEc=X-JjOd}LJv
zty<WzPA5b{uADAK&`SVo9%b^9;ZxO`l~ICfr%GgmuKU{|yN1?^i8sICR6F$~cb>05
zA-1~QQ8Hf4l=ed#q<aI<wr&<y-Wx^Km^7rXs1MpKKvsuQ+|Q#``6$g<%8G86`UChX
zAl1D6w2o^F9y7{Lw?sVwT=Q6?zT1<=+jn1P^e%lRbF9|+@lFvg$n6`Y&o)hzCJhi}
z_n~6H{&TLc{12mdDIZm9QPt#+?&q7ts^v~nRx}^EkED+IqG{zPA|@zZLeMQqNy91U
zRMumgE1zjS3=gGu!`#b*cv_YQjlIq)zpl0Ak9yc51U0D%zg94xlS3?@+F-{gX3t~0
znK><8LeN)b|7sS7KWSNITdW1KD5C?<^!!K^mrX+BC3gYSe8luZAL*{)eh@R=c2PAw
z+XR5)Nl)!acOANiKVuXz_FW9#=^V{8kNYSU|Lld~d%Q%}I4=vwoYXS0*&$nWK9h=2
z6pgRy-I;N^A5tYUqV29f76i33W2z(m<#8rnF6hgvLjwd&p?<&;EY91>@{irIsEYSL
zEp&6TSd>;LIj0<y+tT^vCG7Z>5WeWCFGgoJi1-2XxzEZ?f~HIP0HOo@xW4ycZMhFe
zDHGBGMFVWxqETJLh2{6gY{@OnO?D2;H?lvMY5B4<ZfJh8R@vb<mWNrzORA_^0HgSd
zk9=><ti!IFsVb_3UIGY;?~ipoPKh4NEj^PysFDbgg<!p6NT=E(mUQ#BPeixip5o#<
zYfk&1uW0`O7e+*5g1(zL8sdRcQ-qJA0s0>Aia9@TWZ{|7QiD{XbP4)=oyg)6-NY`d
zh0<PWx>Em;)6ZVr*83`p*^<VoUYaQN2k`acrRvUMb<FjHR0%;7rDy=}3wcULaT0#F
z3M2$oMSB9Ua;{@1+YMs;uIZfKr3z)l!p0nQ_{pdZC`vKY6sdMOt5NMX*vT!5`);q4
zK1CEE`*>tyP)BF$@t0@!7*#^~=wbkF*9ddp?5ix;lCI8k5U*Pn$qWnqm8@wwJZXaq
zuTJPFx=iusO~HCz_BPM5tIKO6mBTNtv4OTSg1)M|w~%>kn9FNB{(-pny{}n+U61n(
z_Zj7YIibSzT&J3<UkKjZ%yO-@VnRd6A3uF`$?O}aN*1**6)UIgWln`Y{8i8XIAeVz
zudV9Fp}`p|(mL{QQ)1Z)-Ea#c^tzFimJH;jd;KK@RYlPN)}>#n2QMUJ?d+$FvL|~P
zc~xMMc~$#PA*qGbf9zBo8{@b`Ne`qBDF;;x;JV6zUpX>YRHntD(}{FGqi_a;jvpZ9
zlYI>Aa7rX)2XIg8J`xAL8+Np>==3&>hmBcbNw?)#GI~yMU?!Wp0$P`u?IO1_)8GL}
z)0Gjr=VSQ6<T7S8{ehsF(9Wq^fG&F$^Lt0vD?@IK7xWd)N=Eb#oh^cFg2l);8IoJ7
zP<DRE%7L$#+N6y28z=Ql@5+cL+2K6;P#2z6UM+2uDy04Zk~akN2RT!OjdOsscItzo
z0YY+5h)~!gZdNDBKFD^dCjiyfP8^xIgFW*$aGE>a5?v2Kxl4mEsYzn+;OP>AHb~Ky
zU3qK7o0I7*<k|vh?NUB;3*c+rheJe_*q{lNmPnn`RRV~jm*U&5wmhgk7^x4sMA`Y_
zr<cri@AbT2_B|Gs+Y76Hab{&+ez;}OWHhBt5I)(jwWie#iYdEB3AD5P9R%*CzpKWI
z(HL>0D^^YR!Gv+c5Xzs5svX0{?In?zA8C({aUWtq-Ar8GoNHP8vgx;2cyf!<IZluC
zRz$ydN@C3c(N@(1HRnnM<la=*y#3U|F~ByQ)g5=@`#Qu+2>Obu1#nyK#-|3@V@<dV
z7O!kp3~j^km0gUait+(8?$6<CZ(h~@cEd-Z-=PZWC4heS9WbHkh6wpM3}@8O$J{0R
zg)!>2m{Ayx=UAaI?Ff_-0mvO_z@c&0Y()G{R$j6QzyHhw7YQ#x)Ac^H2%Xl{XkU&0
zw<W9j=R)wU)*63!&?+c`^3l`*s%&qm+rII};dvZs2lQ3!PuGNTd8?>+$t~%Ak{GM*
zce^M&&wjyaQ&bh@2KeFAbFArkDJwrXh0|9wADSCL{<!_D_PkkWeojKlPLrl;0cyvl
zuorm-+&JlPg5ISHWrV-uWKnq0K^@#V6KMx@C6pVWjCaM8x_V{g`vj!9(=E}Y0cJk+
zM?Nf-Sse_PI+qZne}I9PveEHMcQy4=xk^){d@@JJRt=VUM`61uTk4!PNK*i){PBkP
zZ+?T=_u~j@aWn<l`J8$aTh~P+zOy$-ebB6EH<tf?)O6P#uhH>_)sLm04AckR0>Dt$
l0^we0!!}=<Cw-o&Dw-R>vu?Z02Yt_pbgx;`5^4W3$M02Lp=SU9

literal 0
HcmV?d00001

diff --git a/data/meshes/hyq/hyq_trunk.stl b/data/meshes/hyq/hyq_trunk.stl
new file mode 100644
index 0000000000000000000000000000000000000000..7a4496b679fedfafc5df37d670896a80d68d4108
GIT binary patch
literal 684
zcmZ>*D9A4=Nlj5mE6UGRaLP%|OGz!#HPSOTRnRCdO;Rw>WFQIffK@l_hiT%d^WA@#
zdA8lDEtmE}+53>$E>An`Kx#2`>;uWbbR)Atx*?|j|6gwpVxg(B2iXVJ0cK;>0hfX4
zMsgKcH^}4$u=!9s(9MOp5F`%v6ILBC-y+)wHwmPJfdS|baCo7G58Pa!IG7C!D-<1Y
z8JKRQu!6e^Vh<>kVXBaQ3uS{{g$OH%9<UC$49q1+x-sprhp9r210+|$Ll^EUkdFOG
Mu?AwJgf7JA05MzZkN^Mx

literal 0
HcmV?d00001

diff --git a/data/srdf/hyq/hrp2_trunk.srdf b/data/srdf/hyq/hrp2_trunk.srdf
new file mode 100644
index 0000000..8538107
--- /dev/null
+++ b/data/srdf/hyq/hrp2_trunk.srdf
@@ -0,0 +1,18 @@
+<?xml version="1.0"?>
+<robot name="hrp2_trunk">
+  <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>
diff --git a/data/srdf/hyq/hyq_lfleg_rom.srdf b/data/srdf/hyq/hyq_lfleg_rom.srdf
new file mode 100644
index 0000000..fa4c185
--- /dev/null
+++ b/data/srdf/hyq/hyq_lfleg_rom.srdf
@@ -0,0 +1,3 @@
+<?xml version="1.0"?>
+<robot name="hyq_lfleg_rom">
+</robot>
diff --git a/data/srdf/hyq/hyq_lhleg_rom.srdf b/data/srdf/hyq/hyq_lhleg_rom.srdf
new file mode 100644
index 0000000..f4dde37
--- /dev/null
+++ b/data/srdf/hyq/hyq_lhleg_rom.srdf
@@ -0,0 +1,3 @@
+<?xml version="1.0"?>
+<robot name="hyq_lhleg_rom">
+</robot>
diff --git a/data/srdf/hyq/hyq_rfleg_rom.srdf b/data/srdf/hyq/hyq_rfleg_rom.srdf
new file mode 100644
index 0000000..268ca1c
--- /dev/null
+++ b/data/srdf/hyq/hyq_rfleg_rom.srdf
@@ -0,0 +1,3 @@
+<?xml version="1.0"?>
+<robot name="hyq_rfleg_rom">
+</robot>
diff --git a/data/srdf/hyq/hyq_rhleg_rom.srdf b/data/srdf/hyq/hyq_rhleg_rom.srdf
new file mode 100644
index 0000000..af6533b
--- /dev/null
+++ b/data/srdf/hyq/hyq_rhleg_rom.srdf
@@ -0,0 +1,3 @@
+<?xml version="1.0"?>
+<robot name="hyq_rhleg_rom">
+</robot>
diff --git a/data/srdf/hyq/hyq_rom.srdf b/data/srdf/hyq/hyq_rom.srdf
new file mode 100644
index 0000000..a12ec4c
--- /dev/null
+++ b/data/srdf/hyq/hyq_rom.srdf
@@ -0,0 +1,3 @@
+<?xml version="1.0"?>
+<robot name="hyq_rom">
+</robot>
diff --git a/data/srdf/hyq/hyq_trunk.srdf b/data/srdf/hyq/hyq_trunk.srdf
new file mode 100644
index 0000000..6a54df5
--- /dev/null
+++ b/data/srdf/hyq/hyq_trunk.srdf
@@ -0,0 +1,3 @@
+<?xml version="1.0"?>
+<robot name="hyq_trunk">
+</robot>
diff --git a/data/urdf/hyq/hyq_lfleg_rom.urdf b/data/urdf/hyq/hyq_lfleg_rom.urdf
new file mode 100644
index 0000000..6dd3d6d
--- /dev/null
+++ b/data/urdf/hyq/hyq_lfleg_rom.urdf
@@ -0,0 +1,19 @@
+<robot name="hyq_lfleg_rom">
+  <link name="base_link">
+    <visual>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_lfleg_rom.stl"/>
+      </geometry>
+      <material name="white">
+        <color rgba="1 1 1 1"/>
+      </material>
+    </visual>
+    <collision>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_lfleg_rom.stl"/>
+      </geometry>
+    </collision>
+  </link>
+</robot>
diff --git a/data/urdf/hyq/hyq_lhleg_rom.urdf b/data/urdf/hyq/hyq_lhleg_rom.urdf
new file mode 100644
index 0000000..5e335b3
--- /dev/null
+++ b/data/urdf/hyq/hyq_lhleg_rom.urdf
@@ -0,0 +1,19 @@
+ <robot name="hyq_lhleg_rom">
+  <link name="base_link">
+    <visual>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_lhleg_rom.stl"/>
+      </geometry>
+      <material name="white">
+        <color rgba="1 1 1 1"/>
+      </material>
+    </visual>
+    <collision>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_lhleg_rom.stl"/>
+      </geometry>
+    </collision>
+  </link>
+</robot>
diff --git a/data/urdf/hyq/hyq_rfleg_rom.urdf b/data/urdf/hyq/hyq_rfleg_rom.urdf
new file mode 100644
index 0000000..dd444d2
--- /dev/null
+++ b/data/urdf/hyq/hyq_rfleg_rom.urdf
@@ -0,0 +1,19 @@
+ <robot name="hyq_rfleg_rom">
+  <link name="base_link">
+    <visual>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_rfleg_rom.stl"/>
+      </geometry>
+      <material name="white">
+        <color rgba="1 1 1 1"/>
+      </material>
+    </visual>
+    <collision>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_rfleg_rom.stl"/>
+      </geometry>
+    </collision>
+  </link>
+</robot>
diff --git a/data/urdf/hyq/hyq_rhleg_rom.urdf b/data/urdf/hyq/hyq_rhleg_rom.urdf
new file mode 100644
index 0000000..877a9bb
--- /dev/null
+++ b/data/urdf/hyq/hyq_rhleg_rom.urdf
@@ -0,0 +1,19 @@
+ <robot name="hyq_rhleg_rom">
+  <link name="base_link">
+    <visual>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_rhleg_rom.stl"/>
+      </geometry>
+      <material name="white">
+        <color rgba="1 1 1 1"/>
+      </material>
+    </visual>
+    <collision>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_rhleg_rom.stl"/>
+      </geometry>
+    </collision>
+  </link>
+</robot>
diff --git a/data/urdf/hyq/hyq_rom.urdf b/data/urdf/hyq/hyq_rom.urdf
new file mode 100644
index 0000000..501db77
--- /dev/null
+++ b/data/urdf/hyq/hyq_rom.urdf
@@ -0,0 +1,19 @@
+<robot name="hyq_rom">
+  <link name="base_link">
+    <visual>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_rom.stl"/>
+      </geometry>
+      <material name="white">
+        <color rgba="1 1 1 1"/>
+      </material>
+    </visual>
+    <collision>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_rom.stl"/>
+      </geometry>
+    </collision>
+  </link>
+</robot>
diff --git a/data/urdf/hyq/hyq_trunk.urdf b/data/urdf/hyq/hyq_trunk.urdf
new file mode 100644
index 0000000..07a83bd
--- /dev/null
+++ b/data/urdf/hyq/hyq_trunk.urdf
@@ -0,0 +1,19 @@
+<robot name="hyq_trunk">
+  <link name="base_link">
+    <visual>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_trunk.stl"/>
+      </geometry>
+      <material name="white">
+        <color rgba="1 1 1 1"/>
+      </material>
+    </visual>
+    <collision>
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <geometry>
+        <mesh filename="package://hpp-rbprm-corba/meshes/hyq/hyq_trunk.stl"/>
+      </geometry>
+    </collision>
+  </link>
+</robot>
-- 
GitLab