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 1119fd11..4ce522c4 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
zcmZ>*D9A4=Nlj5mE6UGRaLP%|OGz!#HPSOTRnRCdO;Rw>WFQHMF)%PZIJ<9;V%=3c
z<JlSZ$x3GSx0)U83d(hCYvStdW2TDOp9x^y#~-C*|H(MTe#77XeGCkjdL3=Izq@8<
z$cd^0S=Fs4<#q~F^X)INf^<Atrnx8OddmLdf~R)Kb};0b?pyFSdGCTV@Alb${%qI5
zVzV#op~-#*hP>n?yH<f+cFyb5_wR~YXD2X2!~TP$>i&c&j`kN02-!0{6yCohgVlak
zs)t>BvgdvV2Gi>ec57A}+OJusgQ5f3Rmi#-7+BVn?cIDXY5#@X*LKLZC#f{pA23+7
zr|Z{}eJHMFNT0aGmiMEtJ<n>f{m4E<wgcI<3=HC3JoZ<1=I`5;;k#epaG`y|j08Id
zR>u9v_M!U2km=aIm^wXsB^G%UJCMz_*sZva?XQKsMNs=b28OQ(llCix@z^ckc)X9{
zd-EPH$2oQj%ysu8hc2p)<hMcgo0B%!F~>jKha4uzagOX-1_u6BmG)0|PqDSW5xNgq
z6>?ai>QFV!-DkvMywB%%35su#U5M)QEzCUj?XjP1gSA3X;u+aoR2{GCEbU#k@Y~mH
zJ%f@)kzI)FKL&=RsmAut>ZA5?2<xGwc4U7b>t<ju={UU4lwsAr+h<}>{ehHrk^RKL
zu$Pl--_G#Gc5l=R?2*GAIV~Zl9tMW3A`ka1*c-FY+&msd2XYJ|>t<jOSC`oL`)Hw^
z$+c3H)Q%E9$Z3H=lSSU1!QsHZsS*Y#DG}M{$f=TnVc(+n`(_Dp+8g~c-jD1L<dlf&
Fa{%#(-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
zcmZ>*D9A4=Nlj5mE6UGRaLP%|OGz!#HPSOTRnRCdO;Rw>WFQGhFfcG26Hd1in<s9c
z#p1SqOQF#Ij!S0t88s678>CL!e(B}3e<8-XpTX$U-heMV>@<#A?`L2z=6$tC>EKGc
zJsE{4I*?Uu*!Fo}ftroot{)!z85k-`nCz>R<o2!D5V61EqRc*qIE{VrGc-`lEqH2V
zx8Q-uUJ1z``xqE_k1E;t$RzKVv3z5PtRwiJ>;6aVE_M<x<!yH?l-h5(N@ZV7h{}Ej
zhP?C*`)2ag?PEWYzMo-{%l;2{Wb7K^we};s1Xah6$2$8b8~w6tNax+}{jzHRrOAr+
zXH50>A&0^p-Rk`-`j^;EIQVEE1B0K=@qNj8HFnN6$tXTYwgcI21_tL#)pm!jnAlgm
z*4*z>^>Ck`Zn3>a=k$HZp^I!E1A~j6mVJuscAKpl_WM!71St-Xbu%!`n=P?d+;ZPO
zhMHUy-y(+_s?QnPrrGIlu(5AGA-#Xkt6tm1TEX@f%zh}YLUt_!L&LsWd!PR-b}SZG
z_aM6p*(Jy(F)$eUsqViec5I(mn+8gJAiKn2U(J37mUe5l3p@8QF!aw4-!E+}x$pcW
z7JKCQKvsnu{|pT0yj=DNqzLWXZKALrC8m(#A6Yj8gW@5<{q>ip*;!V(pu`|@tf831
zAm0>i=Nm1(Zz*#*N_s^OU6lA|s8{CRJ5Tnio$Krjdt~<_hbXfD7#Nx=8}}}8yJaWN
zn2w?YIYg0lGcc&1>$fdg5wm}87Xyk8WLF`_69WUY@GZNezY6w+E{(TGHW%52s5;6&
z*6-&z(qN;vD0L5VC?dNZHLU!9aqMT4cDC1?zY8T7A?rZ(#|w^vy@7Qp`|rJZVu$P!
LWc!d)3<CoI;ISse

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
zcmZ>*D9A4=Nlj5mE6UGRaLP%|OGz!#HPSOTRnRCdO;Rw>WFQGhFfcIO2otvV{q4N}
zkNM<%9@)R`xcCeAFUX&??}e#^{em?f`x}z~?<<XHwEz1<W`Bh5_q_}Z*?aEqi+1a<
z+weKsUO~!aA45%q?Ss|N_U$l}-zTxtZokER*L~ODsM}{ecHF0R$H|s~VgHKq{rzQU
z_WC>I?L*el@bl!}mGf5byYNYBKeBEHhIe<8?fh;(x07It-OrGcWw%1g)b1a*-hP9x
ze)ek|FW5>v7u=un`I?=<CV_o(w0-t7FmT*iv`@1#X}@Rtx_t~)KWrz6n(UWQ;opz!
zCsaEat{3cnt|GfXOx$ZfvTu=fi`;)?_h84zeHoK&_cJhfd}ZI?d@|8)WkDc{s~V8}
zf$Tp9hLFb8y^$Y1_itJ!vme=9Wc!d^$iUzs&SEcXw|CD0(`Xdmt|=(7KfrNnpTqI@
z`%ry8eUYO5SJwi&{bsiI$T8LSq`{tHfuF^e&-2mZ<4%Xl-aRu<@4K}!%N{wVkX?do
z5(9(Cg|BuU>)!5NFg<QRvP+P|2h~-E%wO#evK`(R(19Ad$U2ZsVqoZbQDwi{Gj{LU
zPUn5dZbx<rs*YsQzt&5gF6;}xooSEkc4R-H#`%Pl!~5olJhCl$mxYpkkYf-zy)iJ@
ze4n|GS$*0*=b()J$f}V2fgH083^h#t_F4+xZRIkAQNjv2?IQb+fuU9}eb4;k$@Vsr
zU)mwtj+~Z|{lvg<O`&J+zf~FbzgAwdLpB##6{;QG$y)Yo4kG*Qxj&-hZR8L|4rvAk
zXD&Wl?kQ>ZDZB34A)AYAAF^v17_NQN*)MbY)4r}Y0hF*p4j<I`h+&<u?^CDMK3Ahc
M6dlNE2_>W%01T~8kpKVy

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
zcmZ>*D9A4=Nlj5mE6UGRaLP%|OGz!#HPSOTRnRCdO;Rw>WFQGhFfcG|e|>S!t^X<Z
z%5_idEIOq2AGjxMw?Rc~|7^3!{R`5=_G#4pv{}&o&~`!HSz7}x&ixDwG7I|lHtY!8
z@32#F|A9!2{Q)6v`x&;r-gjWJ=e`Hkj{7G#a_{H$<=a2`R@VNu&mH?17@Fhn+gT=k
zwPp8B*^g|NgYrMy=(C&l{Wu`DU*gp2eGDD9_xAjC-_O9H%V}wM>yUu`dL};<9muMX
zUCY2A-7Re&tH-_ntfk2Q6`h}L3x2rm|G?#n;wohO7#KcothevIebwgA4Gmjl8DtkC
zo5aAN{FG;Zz^5DgOtdZbC)_FC-%-7BUxV|{eF-xx_n)$xv2Vd*1C$V9VCXO`*ze@a
zV&~<z#BS^Aiv7zH74}!`Q`v_cy6Pt?_6zi!wfPWwa~}gk@hOx2e{ERyFMsxZAF>W)
z`;bGOf#Cq>{k`*A)%Sb$+wVt?17uYmN3QK_X#2iz$9wzz3=CG$9(y-RpWml+GSeP8
zrjT8QY&QeLa`#hqpWd#q+qyZ*9$6J~_#lTH1H*)njdmAK@7X7DIc7hy?Z_dG>{<qf
z3&E*&@A?b&Pm5^Thiopg3sH6G@J8;Nah_+dIeXQ9<TyZ1CCGL&Fl?|F+<!Frj;+uC
zfc?nfj+~Z|Lz;mh>$T2)d$)8u=FP?^agL$`DgGH43@_I0=e;7jH~r$)y~v@6Y#*u}
ztluT}Z%}vM|7$@VN}MCdAaW=$Fzi};W8b$45BIHK>xGiykV660=XrM)*iGV>*f*EE
z03|+<!wNZW7#KLtirO4Hn{5BE`z1=rfb0+Cw7|gNBtChc%nS~@nHP&t@-wolki(6E
Y;f>JJJ)1R8?JHEtMoEdt@sDZ;04rl{_5c6?

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
zcmZ>*D9A4=Nlj5mE6UGRaLP%|OGz!#HPSOTRnRCdO;Rw>WFQH|F)%RP2otvV{q4N}
zkNM<%9@)R`xcCeAFUX&??}e#^{em?f`x}z~?<<XHwEz1<W`Bh5_q_}Z*?aEqi+1a<
z+weKsUO~!aA45%q?Ss|N_U$l}-zTxtZokER*L~ODsM}{ecHF0R$H|s~VgHKq{rzQU
z_WC>I?L*el@bl!}mGf5byYNYBKeBEHhIe<8?fh;(x07It-OrGcWw%1g)b1a*-hP9x
ze)ek|FW5>v7u=un`I?=<CV_o(w0-t7FmT*iv`@1#X}@Rtx_t~)KWrz6n(UWQ;opz!
zCsaEat{3cnt|GfXOx$ZfvTu=fi`;)?_h84zeHoK&_cJhfd}ZI?d@|8)WkDc{s~V8}
zf$Tp9hLFb8y^$Y1_itJ!vme=9Wc!d^$iUzs&SEcXw|CD0(`Xdmt|=(7KfrNnpTqI@
z`%ry8eUYO5SJwi&{bsiI$T8LSq`{tHfuF^e&-2mZ<4%Xl-aRu<@4K}!%N{wVkX?do
z5(9(Cg|BuU>)!5NFg<QRvP+P|2h~-E%wO#evK`(R(19Ad$U2ZsVqoZbQDwi{Gj{LU
zPUn5dZbx<rs*YsQzt&5gF6;}xooSEkc4R-H#`%Pl!~5olJhCl$mxYpkkYf-zy)iJ@
ze4n|GS$*0*=b()J$f}V2fgH083^h#t_F4+xZRIkAQNjv2?IQb+fuU9}eb4;k$@Vsr
zU)mwtj+~Z|{lvg<O`&J+zf~FbzgAwdLpB##6{;QG$y)Yo4kG*Qxj&-hZR8L|4rvAk
zXD&Wl?kQ>ZDZB34A)AYAAF^v17_NQN*)MbY)4r}Y0hF*p4j<I`h+&<u?^CDMK3Ahc
z6dlNE2_>W%jtQsRiOmzY&th@gzok%Uf5#;=`-~ci{S8tlZNKz#+P@Iv+|OY2X>Y)n
z9d;T=t@kr981uf`qjYek-JXm>6dlN_Hf;O6uRzVlZr2Zw{R|8hB~12JN^<*FY>3$3
za8YI-L!8FG_!$}~<`z6PvRm*#WUqwek9`abyhoL6d}NaM%UHg#L)H=e&vpMJb{9K|
zm-4nd7E0~6T&1$FCPZaF14CZ=hJ7=6>h`gpNZ-$}$YuYBJ2G|+@ml+lU4p9P$77xS
zlZ}4aHKg<I_kLNm|I%bd`!l9``;bH7j&Ak-75z)>CLDaUkAcBY=lH(lyc#=an`9K9
zBin&&Hv@z7rE0rFS4`|HUTf}msd~82Pq)}!qjUN`<j_U7kAcBOPs=_<cDv114g38l
zVS*F~$hsLA=FOJaD{i@OA45$pif@s_4b|riZPV=ZH`v%WpOD_a=T)!mVy$3%3uZqQ
zS0THWfuUhvt-a5G7CRP;t9y`Lh3pb!lNcC`{8abf5<9j}tW5(YK9F7Fu&-u6153L#
z+l8I`7#RBJhwqm*mfUxK5{o@@d?2erj(-M*b6zg{15$+c?KV-^j}lWz@sF&VfkE+*
z;Qso{)9fs(Tu@>VIo422Vvui&w)2ga-nW#w93{OXhb~I|Gt?_{@0}-m)y{QxhCQ--
zkwX;Oe+&#wm5qCsxZSc7XG}-YfgGa9x)~VM&-L4utcck^w~GNq2ePY><B5TRS@@RS
z(O(7oLYKzdBb$rtLR1~)AM5w?9BHu8Ta>y7ITVrIjv7|}zc}`@NjuwX&fkTSi;#7o
z`r`#h!QQ~Sl>PVKJh4M|39^02DTaaJ!P$L#6zi_q8PCqJPgXLszt!w$S5U5FTN77r
zA2U_N{!9StKK>{j`%lIx_8b28?_*%N)az)w{oOS?Lrzp3$f|BVDYsLYns0xB6{O?I
zGR-|H*HiWv7d*8?wu2$hbl-xv$$J-^dAHC0^Jlvb7Mp!x4^2R&PjZr7tH3Th=k@9P
zcSWtU6PTf4|3Ol9f5H?;`wItz>=_;k@86NZYCkL0!>&Eqb3X%v>GcM?HLDHn*R0b)
z(ShtLWZeu5ENja4Za$Z^|3dC-J7n9FR2u9L7%bY;^=rvK6xTAOPh4Wl`_b2)XSLXV
zWFI2if$Ula2JtQ)`zt&1_wCB?-7j#s&^}>Cf*k`Z<9=lOQ2k-ZbZlQtou0iCi#&=Q
z$mUw?R@}$-*TUW+sC^#;!`FjJ`<23Y>=tl5-pBC0c@LN49J>YPy8Dqs7ga~{+aUYR
zNgM2#<DczA4in@!M|Ld(1OKW@`zO1n*jnER-G{6SIjm51sG8>PGvYAb=kvP+#ka^V
zMD_U=W*+<Y*iW{>S|KR$jBGBdj#qV-_AXoa?Q6E4K}n;?E=2Yp14GhOWBX_IQTsTA
z^-xkfvOkb@GccHR9NuTjuxj7!Gcl<CKuWvFeqvzQ%gMEGXZT{fH|hoU$l;EhmXK2q
z1H)F4hx-=njoD{z9*?2}IR=q+Gcbs&OYHl7w9wAvS}96uM+qO~w7{UrB5%*&aA4n5
z2?Lari0pIZRLQ`wZ_)dGvjjQqjeZ&LNA?GDN<{Vf_SYBp-1?tluUz-U&Z0wV|ABkL
zb{kZ*_Rltp+`k|_Y@bHmPn!kZ4{aCJowYUK;@r=`AhV!vZ^Mqj{SG??_aBJV*dGw$
zwx40^>wO0nd+vKs?YMt}Blmt@U%vg5Z)NRo``odQfuTA6zMW;#S6g=9l>NwNIVk_L
zjXt|+-;V=g`z21T-p9~!dvDKQ_x%hEx}27Fw+;!|uV?Z@(SfWA*|iJ|(%sVbv3lJ5
z&svJ?U(xy5w%~``{tsNPD6T@bkAdOi#(MkS+gEM=+|aN^mO*wQvPldK%1?Rr2YkA*
z&qUi|f5M&O{T<aC_cb{G+?O!Ja{np28T%G2Hb4mx28Is9g8fduEOuUgOYF9;uGqgU
zQDJ|@K9zmQp{stPV!uGoS(^``H}^3x6rVEL|JR0P|MF+w_aW;*whuYf85j<5-rqZ~
zReir_zx{sXI6zkAapc;*hPLnfcD%RW&%j_6?Xh>G^!a^CCo}DlV+z?-$aXU@EO$R;
z_v!5#yRDm}?2%O=hYxbNF)&OB*=Tp+^qzeZmt*!L+m0O4$gX8zxDcFb_pZNS|Fnpf
zeaPk_yAV}}4sYbX8RvQSnzL8!M~(yJRDx_b1H%S;!Tm>*@7VhM57>_!?#O8gIiwjF
zvR>=#w|7goW8Q3x66Yv7km8?#!SG_;e%>phd($s&-HRNG$o8Sy!TMcd{|0sE{l6B}
zp~N|I3?hdD1H-PhH}-v-@NnPywO%MG4mlK1eV%t`f!!p2iG6dq3sB+%IjoT5hJk_O
ztf<YQv&r@kyI-P|49NaKP74eSPU4gI$;{xen|ZMaB|js(3OU>u7~Tji-LqNq)V@NM
NY?PFU9RH|x00328p=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_2U83T3><a7
z`wuhEwmY@u(q1TgA2QqJX@?z1EryPLAQ`9*J7hLUH%JEq!~g&F_8=CTDtnN9P#s`4
zRvmB|m~N0N7#pM;WO4)8d=QJH&KIl$Bm-r`TnG{e`w65DLkCy}ssk1ZARS;ofpmcV
z0S+&y?Z`S%*dV(xbb!o)xdar_C~T0QAUYsq!+tb7Ksr!dg;fX04rEm@SAlec*$~qq
iWP?4_w=kE0b%WdvwHwLjNIF1ffn}hokadIE3=9A<TkDVj

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 00000000..8538107d
--- /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 00000000..fa4c1859
--- /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 00000000..f4dde37c
--- /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 00000000..268ca1c4
--- /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 00000000..af6533b8
--- /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 00000000..a12ec4ca
--- /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 00000000..6a54df5c
--- /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 00000000..6dd3d6dc
--- /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 00000000..5e335b3d
--- /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 00000000..dd444d2c
--- /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 00000000..877a9bb5
--- /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 00000000..501db77b
--- /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 00000000..07a83bd6
--- /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