diff --git a/iCub/robots/iCubWaterloo01/model.urdf b/iCub/robots/iCubWaterloo01/model.urdf new file mode 100644 index 0000000..0faebf4 --- /dev/null +++ b/iCub/robots/iCubWaterloo01/model.urdf @@ -0,0 +1,3582 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + true + + true + + + true + + true + + + true + + true + + + true + + true + + + true + + true + + + true + + true + + + + 0 + 100000 + + 4 + 18000000 + 100 + 100 + 0.0001 + 1 + 1 + 0 0 0 + + + + 0 + 100000 + + 4 + 18000000 + 100 + 100 + 0.0001 + 1 + 1 + 0 0 0 + + + + model://iCub/conf/MTB/gazebo_icub_left_leg_mtb.ini + + + model://iCub/conf/MTB/gazebo_icub_right_leg_mtb.ini + + + model://iCub/conf/MTB/gazebo_icub_left_arm_mtb.ini + + + model://iCub/conf/MTB/gazebo_icub_right_arm_mtb.ini + + + model://iCub/conf/MTB/gazebo_icub_torso_mtb.ini + + + model://iCub/conf/gazebo_icub_torso.ini + + + model://iCub/conf/gazebo_icub_head_without_eyes.ini + + + model://iCub/conf/gazebo_icub_left_arm_no_hand_for_no_hand_model.ini + -0.52 0.52 0 0.785 0 0 0.0 + + + model://iCub/conf/gazebo_icub_right_arm_no_hand_for_no_hand_model.ini + -0.52 0.52 0 0.785 0 0 0.0 + + + model://iCub/conf/gazebo_icub_right_leg.ini + + + model://iCub/conf/gazebo_icub_left_leg.ini + + + model://iCub/conf/gazebo_icub_robotname.ini + + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + 1 + + + + model://iCub/conf/icub.xml + + + + + + + + + + + 1 + 400 + 0.08515499999999998 -0.011000000000000022 -0.11230899999999999 -2.0943952105869323 -3.885780586188048e-16 -1.5707963267948963 + + model://iCub/conf/gazebo_icub_xsens_inertial.ini + + + + + + 1 + 100 + + sensor + child_to_parent + + 0.0 -1.3877787807814457e-17 0.0 2.220446049250313e-16 -2.220446049250314e-16 2.220446049250313e-16 + + model://iCub/conf/FT/gazebo_icub_left_leg_ft.ini + + + + + + + sensor + child_to_parent + + + + + + 1 + 100 + + sensor + child_to_parent + + 0.0 0.0 0.0 2.220446049250313e-16 -2.220446049250314e-16 2.220446049250313e-16 + + model://iCub/conf/FT/gazebo_icub_right_leg_ft.ini + + + + + + + sensor + child_to_parent + + + + + + 1 + 100 + + sensor + child_to_parent + + 0.0 0.0 0.0 2.220446049250313e-16 -2.220446049250314e-16 2.220446049250313e-16 + + model://iCub/conf/FT/gazebo_icub_left_foot_ft.ini + + + + + + + sensor + child_to_parent + + + + + + 1 + 100 + + sensor + child_to_parent + + 0.0 0.0 0.0 2.220446049250313e-16 -2.220446049250314e-16 2.220446049250313e-16 + + model://iCub/conf/FT/gazebo_icub_right_foot_ft.ini + + + + + + + sensor + child_to_parent + + + + + + 1 + 100 + + sensor + child_to_parent + + 0.05093014324520106 1.3877787807814457e-17 0.029175829465900395 -4.3625653762663687e-16 -1.3089970069677406 -3.1415926535897922 + + model://iCub/conf/FT/gazebo_icub_left_arm_ft.ini + + + + + + + sensor + child_to_parent + + + + + + 1 + 100 + + sensor + child_to_parent + + -0.05089730176650909 1.3877787807814457e-17 0.029167029620599215 -6.358700866473837e-16 -1.3089970069677404 6.58301142551668e-16 + + model://iCub/conf/FT/gazebo_icub_right_arm_ft.ini + + + + + + + sensor + child_to_parent + + + + + + 1 + 100 + 0.009500000190735 0.133444 0.009299999999999996 -1.5707963267948963 1.5707963267948963 0.0 + + model://iCub/conf/gazebo_icub_inertial.ini + + + + + + + + + + 1 + 100 + 0.0493308 -0.012577100000000023 -0.11569100000000002 -3.141592653589793 1.2915440450258353 3.141592653589793 + + + + + + + + + + 1 + 100 + 0.0493308 -0.012577100000000023 -0.11569100000000002 -3.141592653589793 1.2915440450258353 3.141592653589793 + + + + + + + + + 1 + 100 + 0.064785500190735 0.064043 -0.06470909999999999 3.1415169122972952 -0.2617993091222473 0.0002926418802545251 + + + + + + + + + + 1 + 100 + 0.069201600190735 0.06454800000000001 -0.0635258 3.1415169122972952 -0.2617993091222473 0.0002926418802545251 + + + + + + + + + 1 + 100 + 0.020453300190735 0.08806299999999999 -0.0641645 3.141590501042822 0.2617993198185102 3.1415843367812997 + + + + + + + + + + 1 + 100 + 0.016037100190735 0.08755899999999998 -0.0653479 3.141590501042822 0.2617993198185102 3.1415843367812997 + + + + + + + + + 1 + 100 + -0.023058799809265 0.064019 -0.07589850000000001 3.141109162025268 0.2611005164711609 -0.00030907146255546275 + + + + + + + + + + 1 + 100 + -0.018641699809265 0.064521 -0.0770785 3.141109162025268 0.2611005164711609 -0.00030907146255546275 + + + + + + + + + 1 + 100 + -0.06216209980926501 0.08806299999999999 -0.0529887 -3.1415905047625503 -0.26179931981852844 3.141584339870295 + + + + + + + + + + 1 + 100 + -0.06657839980926501 0.08755899999999998 -0.0518054 -3.1415905047625503 -0.26179931981852844 3.141584339870295 + + + + + + + + + 1 + 100 + -0.060753999809265005 -0.0017836000000000032 0.0442341 0.8751677714915177 0.11636373439232388 -1.4859735024675946 + + + + + + + + + + 1 + 100 + -0.045704699809265004 -0.0018460000000000004 0.0567427 0.5009600846888734 0.10731368898312439 -1.477832529104222 + + + + + + + + + + 1 + 100 + 0.043903600190735 -0.0017841000000000037 0.0577221 -0.5009599289728343 0.10731540424780746 -1.663760174692588 + + + + + + + + + + 1 + 100 + 0.059428600190735 -0.0018543000000000032 0.0457981 -0.8751681534754429 0.11636202547856245 -1.6556180750511105 + + + + + + + + + + 1 + 100 + -0.041219399999999996 0.029588000000000003 0.029527899999999982 1.5707954636460495 1.5707838122500957 -2.682571611648293 + + + + + + + + + + 1 + 100 + -0.0430568 0.028679999999999983 0.07606039999999997 -1.5707961469548437 -1.5705035074059788 0.45902172521853346 + + + + + + + + + + 1 + 100 + -0.043055399999999994 0.028680999999999984 0.004992199999999981 -1.1117744216835481 -1.5707963267948963 0.0 + + + + + + + + + + 1 + 100 + 0.010593236999999991 0.028350000000000042 -0.010737999999999998 1.5707963270155092 -0.00021452036204109946 2.4780367445076594 + + + + + + + + + + 1 + 100 + -0.07687278473420911 0.005497000000000016 -0.011047912606820772 0.261799499979578 0.0003704130423281237 1.571258168627349 + + + + + + + + + + 1 + 100 + -0.051418615079553955 0.015786000000000022 0.04075215372773191 -0.6611439460918275 0.14782524846115597 0.0920701147029676 + + + + + + + + + + 1 + 100 + -0.02163799567592114 0.027924000000000004 -0.013249025401848176 -1.7668262673154445 0.2611912256456084 0.054048344372003315 + + + + + + + + + + 1 + 100 + -0.04305539999999998 -0.028681000000000012 0.029527899999999982 -1.5707965066353287 -1.5705035074059785 2.682570928371256 + + + + + + + + + + 1 + 100 + -0.04121809999999999 -0.029589000000000004 0.07606039999999997 -1.5707965066353287 -1.5705035074059785 2.682570928371256 + + + + + + + + + + 1 + 100 + -0.04121939999999998 -0.02958800000000003 0.0049920999999999854 -1.570797189926001 -1.5707838122500954 2.6825716116085734 + + + + + + + + + + 1 + 100 + 0.010592709000000004 -0.028350999999999987 -0.008691400000000002 -1.5707963265742841 0.0002145203620417656 -2.478036744507659 + + + + + + + + + + 1 + 100 + 0.07687278473420911 -0.005482999999999988 -0.011047912606820772 0.261799499979528 0.0003704130423280127 -1.570334484962444 + + + + + + + + + + 1 + 100 + 0.05142417406065745 -0.0180279 0.040750725843601086 -0.6611439460918274 0.1478252484611559 -3.049522538886825 + + + + + + + + + + 1 + 100 + 0.022099187499622495 0.025657000000000013 -0.015117424321177507 1.766821342184715 0.261099829847155 3.0875254820176163 + + + + + + + + + + 1 + 100 + -0.012575099999999999 0.04040709999999999 -0.040226999999999985 1.5707963267948972 1.5707963267948961 0.0 + + + + + + + + + + 1 + 100 + -0.012577100000000015 -0.040406899999999996 -0.08340699999999998 1.5707963267948972 1.5707963267948961 0.0 + + + + + + + + + + 1 + 100 + -0.013078999999999993 0.04040709999999999 -0.035654999999999964 1.5707963267948972 1.5707963267948961 0.0 + + + + + + + + + 1 + 100 + -0.013081000000000016 -0.040406899999999996 -0.087979 1.5707963267948972 1.5707963267948961 0.0 + + + + + + + + + 1 + 100 + 0.043588627999999977 -0.030194899999999983 0.048939999999999984 2.526708438028075 -1.5704448425270146 -0.2228738249803637 + + + + + + + + + + 1 + 100 + 0.053946699999999986 -0.006406499999999982 0.03905600000000001 -3.129402120569715 -1.570381814956552 -0.2739898525693509 + + + + + + + + + + 1 + 100 + 0.053831299999999985 -0.013021400000000002 0.0039859999999999896 -2.8773108545103274 -1.5703518030956078 -0.2642818239915216 + + + + + + + + + + 1 + 100 + 0.0322719 0.04226749999999999 -0.005044999999999994 -1.873909988092778 -1.570257713256341 -0.08085890295708932 + + + + + + + + + + 1 + 100 + 0.053831299999999985 0.016478599999999996 0.0039859999999999896 -2.8773108545103274 -1.5703518030956078 -0.2642818239915216 + + + + + + + + + + 1 + 100 + -0.043751799999999993 -0.015759400000000007 -0.026565000000000033 1.9541027553387757e-17 1.5703672368014803 -3.141592653589793 + + + + + + + + + + 1 + 100 + -0.04375179999999998 0.016238599999999992 -0.026566000000000006 0.26425252390070647 1.5703518066171935 -2.8773401047797322 + + + + + + + + + + 1 + 100 + 0.04351374599999999 0.01383959999999998 -0.09276499999999999 -3.1415926535897922 -1.3526297834539558 -8.476849710455595e-16 + + + + + + + + + + 1 + 100 + 0.04450330799999999 0.014343499999999974 -0.08830099999999996 -3.1415926535897922 -1.3526297834539558 -8.476849710455595e-16 + + + + + + + + + 1 + 100 + 0.05362923999999998 -0.015195799999999995 -0.0043179999999999885 -1.5707969943117426 -1.5706802100981876 -1.8151418254260296 + + + + + + + + + + 1 + 100 + 0.05375166999999999 0.01572289999999999 -0.0043179999999999885 -1.5707962918857017 -1.5706802104434696 -1.2217307214946516 + + + + + + + + + + 1 + 100 + 0.027894499999999982 -0.0422139 -0.04346800000000001 1.8325955062747417 -1.5707963267948963 0.0 + + + + + + + + + + 1 + 100 + 0.0164801 0.04224899999999997 -0.09295800000000004 -1.5707936954714847 -1.5706802103471817 -0.26180181049562956 + + + + + + + + + + 1 + 100 + 0.10347939999999997 -0.000812199999999999 -0.001214999999999966 1.4648752297108978e-16 2.2204452113283224e-16 -1.5707960430308967 + + + + + + + + + + 1 + 100 + 0.07847939999999999 -0.011812200000000009 -0.001214999999999966 2.220446049250314e-16 2.220446049250313e-16 -1.5707963267948966 + + + + + + + + + + 1 + 100 + -0.012577000000000012 -0.04040720000000002 -0.08340699999999998 1.5707963267948972 1.5707963267948961 0.0 + + + + + + + + + + 1 + 100 + -0.012575000000000003 0.04040679999999998 -0.040226999999999985 -1.5707963267948968 -1.5707963267948963 0.0 + + + + + + + + + + 1 + 100 + -0.013081000000000016 -0.04040720000000002 -0.087979 1.5707963267948972 1.5707963267948961 0.0 + + + + + + + + + 1 + 100 + -0.013079 0.04040679999999998 -0.035654999999999964 -1.5707963267948968 -1.5707963267948963 0.0 + + + + + + + + + 1 + 100 + 0.042001689999999994 0.03156479999999999 0.04913199999999998 -1.5707955185655114 -1.5706802103355728 -0.7330390947129777 + + + + + + + + + + 1 + 100 + 0.05352114999999998 0.007765700000000014 0.03925200000000001 -1.5707963863768455 -1.5706802103927162 -1.3089969473954748 + + + + + + + + + + 1 + 100 + 0.053784999999999986 0.015070600000000003 0.0041819999999999635 3.141592653589793 -1.5707963267948961 0.0 + + + + + + + + + + 1 + 100 + 0.05378499999999998 -0.014429400000000002 0.0041819999999999635 3.141592653589793 -1.5707963267948961 0.0 + + + + + + + + + + 1 + 100 + 0.03412954999999998 -0.0414999 -0.004858000000000029 1.9547688910448342 -1.5707963267948961 0.0 + + + + + + + + + + 1 + 100 + -0.043785 0.017810999999999994 -0.02641099999999999 -1.5707963267919405 1.5707743139371833 1.570796326789853 + + + + + + + + + + 1 + 100 + -0.04378500000000001 -0.014191800000000011 -0.02641099999999999 1.5707963267982468 1.5706473388946958 -1.5707963267919158 + + + + + + + + + + 1 + 100 + 0.04351379199999999 0.011314499999999963 -0.09276499999999999 -3.1415926535897922 -1.3526297834539558 -8.476849710455595e-16 + + + + + + + + + + 1 + 100 + 0.04450335399999999 0.011818499999999968 -0.08830099999999996 -3.1415926535897922 -1.3526297834539558 -8.476849710455595e-16 + + + + + + + + + 1 + 100 + 0.053133529999999984 0.017184099999999994 -0.0043179999999999885 -2.8972464875193467 -1.5707963267948963 0.0 + + + + + + + + + + 1 + 100 + 0.054451899999999984 -0.013799100000000009 -0.0043179999999999885 -1.5707963664504991 -1.5706802104435666 -1.919861927351539 + + + + + + + + + + 1 + 100 + 0.025915199999999996 0.04274479999999997 -0.04346800000000001 -1.5707936954714847 -1.5706802103471817 -0.26180181049562956 + + + + + + + + + + 1 + 100 + 0.018459299999999977 -0.041718700000000025 -0.09295800000000004 1.5707953192782331 -1.5707699978643246 0.26180018702487956 + + + + + + + + + + 1 + 100 + 0.10552739999999997 0.0008122000000000129 -0.001214999999999966 0.0 -0.0 1.5707963267948966 + + + + + + + + + + 1 + 100 + 0.08052739999999997 0.011812200000000002 -0.001214999999999966 0.0 -0.0 1.5707963267948966 + + + + + + + + + + 1 + 100 + 0.006563800000000002 -0.008586100000000013 -0.059281999999999946 -2.220446049250314e-16 2.220446049250313e-16 1.5707963267948966 + + + + + + + + + 1 + 100 + 0.006563800000000002 -0.008586100000000013 -0.059281999999999946 -2.220446049250314e-16 2.220446049250313e-16 1.5707963267948966 + + + + + + + + + 1 + 100 + 0.0040000999999999926 -0.00860000000000001 -0.045282000000000044 -2.220446049250314e-16 2.220446049250313e-16 1.5707963267948966 + + + + + + + + + 1 + 100 + 0.0040000999999999926 -0.00860000000000001 -0.045282000000000044 -2.220446049250314e-16 2.220446049250313e-16 1.5707963267948966 + + + + + + + + + 1 + 100 + 0.006669999999999995 -0.008524799999999999 -0.059281999999999946 -2.220446049250314e-16 2.220446049250313e-16 1.5707963267948966 + + + + + + + + + 1 + 100 + 0.006669999999999995 -0.008524799999999999 -0.059281999999999946 -2.220446049250314e-16 2.220446049250313e-16 1.5707963267948966 + + + + + + + + + 1 + 100 + 0.0040001999999999885 -0.008600000000000003 -0.045282000000000044 -2.220446049250314e-16 2.220446049250313e-16 1.5707963267948966 + + + + + + + + + 1 + 100 + 0.0040001999999999885 -0.008600000000000003 -0.045282000000000044 -2.220446049250314e-16 2.220446049250313e-16 1.5707963267948966 + + + + + + + + 0.0 0.0 0.63 0.0 0.0 3.14 + +