name="base_link">\r
<inertial>\r
<origin\r
- xyz="0.00038989 -0.11993 0.032281"\r
+ xyz="-0.00037528 0.0019284 0.070349"\r
rpy="0 0 0" />\r
<mass\r
- value="1.0706" />\r
+ value="0.16469" />\r
<inertia\r
- ixx="0.0047736"\r
- ixy="4.2389E-06"\r
- ixz="-3.3527E-05"\r
- iyy="0.0049052"\r
- iyz="-7.9528E-06"\r
- izz="0.0054906" />\r
+ ixx="0.0002481"\r
+ ixy="-3.8181E-06"\r
+ ixz="1.5344E-06"\r
+ iyy="0.00015717"\r
+ iyz="-1.4443E-06"\r
+ izz="0.00010769" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
<joint name="origin_joint" type="fixed" >\r
<parent link="origin_link"/>\r
<child link="base_link"/>\r
- </joint>\r
+</joint>\r
<link\r
name="Min_L1">\r
<inertial>\r
<origin\r
- xyz="-0.011921 -0.00021661 0.02162"\r
+ xyz="-0.01191 0.00021661 -0.02162"\r
rpy="0 0 0" />\r
<mass\r
- value="0.011049" />\r
+ value="0.0096962" />\r
<inertia\r
- ixx="2.7163E-06"\r
- ixy="-5.3643E-11"\r
- ixz="1.6298E-11"\r
- iyy="2.7469E-06"\r
- iyz="-6.4519E-08"\r
- izz="5.2852E-07" />\r
+ ixx="2.3836E-06"\r
+ ixy="4.7052E-11"\r
+ ixz="-1.4317E-11"\r
+ iyy="2.4105E-06"\r
+ iyz="-5.6617E-08"\r
+ izz="4.6379E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Min_J1"\r
type="revolute">\r
<origin\r
- xyz="0.028803 -0.12258 0.17082"\r
- rpy="0.1079 -0.087213 3.1066" />\r
+ xyz="0.0025843 0.028763 0.1208"\r
+ rpy="-3.0895 -0.087213 -1.6058" />\r
<parent\r
link="base_link" />\r
<child\r
name="Min_L2">\r
<inertial>\r
<origin\r
- xyz="-0.011023 -0.00039673 0.010872"\r
+ xyz="0.011045 -0.00039673 -0.010872"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0060006" />\r
+ value="0.0052657" />\r
<inertia\r
- ixx="6.9826E-07"\r
- ixy="-2.9991E-10"\r
- ixz="-2.5271E-11"\r
- iyy="7.1823E-07"\r
- iyz="-2.898E-08"\r
- izz="2.6724E-07" />\r
+ ixx="6.1275E-07"\r
+ ixy="2.6274E-10"\r
+ ixz="-2.2276E-11"\r
+ iyy="6.3027E-07"\r
+ iyz="2.5431E-08"\r
+ izz="2.3451E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Min_J2"\r
type="revolute">\r
<origin\r
- xyz="-0.00089571 0 0.047"\r
- rpy="0.0015828 1.1709E-17 7.2164E-16" />\r
+ xyz="-0.00086261 0 -0.047"\r
+ rpy="-0.0021314 -1.4017E-15 3.1416" />\r
<parent\r
link="Min_L1" />\r
<child\r
link="Min_L2" />\r
<axis\r
- xyz="-1 0 0" />\r
+ xyz="1 0 0" />\r
<limit\r
lower="0"\r
upper="1.57"\r
name="Min_L3">\r
<inertial>\r
<origin\r
- xyz="-0.010381 -0.00045398 0.0099715"\r
+ xyz="-0.010333 -0.00045398 0.0099715"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0056943" />\r
+ value="0.0049969" />\r
<inertia\r
- ixx="5.6108E-07"\r
- ixy="7.2766E-11"\r
- ixz="8.6273E-12"\r
- iyy="5.2785E-07"\r
- iyz="-2.8701E-08"\r
- izz="1.9576E-07" />\r
+ ixx="4.9237E-07"\r
+ ixy="6.387E-11"\r
+ ixz="7.6183E-12"\r
+ iyy="4.632E-07"\r
+ iyz="-2.5186E-08"\r
+ izz="1.7179E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Min_J3"\r
type="revolute">\r
<origin\r
- xyz="-0.00064509 0 0.0267"\r
- rpy="-0.074153 -6.0828E-15 -5.4332E-15" />\r
+ xyz="0.00071495 0 -0.0267"\r
+ rpy="-3.0794 0 3.1416" />\r
<parent\r
link="Min_L2" />\r
<child\r
name="Ane_L1">\r
<inertial>\r
<origin\r
- xyz="-0.011514 -0.00021662 0.02162"\r
+ xyz="-0.01127 0.00021662 -0.02162"\r
rpy="0 0 0" />\r
<mass\r
- value="0.011049" />\r
+ value="0.0096962" />\r
<inertia\r
- ixx="2.7163E-06"\r
- ixy="-5.3773E-11"\r
- ixz="1.5884E-11"\r
- iyy="2.7469E-06"\r
- iyz="-6.4518E-08"\r
- izz="5.2852E-07" />\r
+ ixx="2.3836E-06"\r
+ ixy="4.7182E-11"\r
+ ixz="-1.3932E-11"\r
+ iyy="2.4105E-06"\r
+ iyz="-5.6617E-08"\r
+ izz="4.6379E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Ane_J1"\r
type="revolute">\r
<origin\r
- xyz="0.0062608 -0.117 0.17929"\r
- rpy="0.065544 -0.034907 -3.1416" />\r
+ xyz="-0.003 0.0064525 0.12926"\r
+ rpy="-3.0449 -0.034907 -1.5708" />\r
<parent\r
link="base_link" />\r
<child\r
name="Ane_L2">\r
<inertial>\r
<origin\r
- xyz="-0.010487 -0.00039673 0.010872"\r
+ xyz="0.010487 -0.00039673 -0.010872"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0060006" />\r
+ value="0.0052657" />\r
<inertia\r
- ixx="6.9826E-07"\r
- ixy="-2.9895E-10"\r
- ixz="-2.4916E-11"\r
- iyy="7.1823E-07"\r
- iyz="-2.898E-08"\r
- izz="2.6724E-07" />\r
+ ixx="6.1275E-07"\r
+ ixy="2.624E-10"\r
+ ixz="-2.1855E-11"\r
+ iyy="6.3027E-07"\r
+ iyz="2.5431E-08"\r
+ izz="2.3451E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Ane_J2"\r
type="revolute">\r
<origin\r
- xyz="-0.001025 0 0.047"\r
- rpy="-0.020855 -2.7655E-15 1.0248E-16" />\r
+ xyz="-0.00078134 0 -0.047"\r
+ rpy="0.04204 6.9389E-18 3.1416" />\r
<parent\r
link="Ane_L1" />\r
<child\r
link="Ane_L2" />\r
<axis\r
- xyz="-1 0 0" />\r
+ xyz="1 0 0" />\r
<limit\r
lower="0"\r
upper="1.57"\r
xyz="-0.0098289 -0.00045398 0.0099715"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0056943" />\r
+ value="0.0049969" />\r
<inertia\r
- ixx="5.6108E-07"\r
- ixy="7.2643E-11"\r
- ixz="8.6575E-12"\r
- iyy="5.2785E-07"\r
- iyz="-2.8701E-08"\r
- izz="1.9576E-07" />\r
+ ixx="4.9237E-07"\r
+ ixy="6.3755E-11"\r
+ ixz="7.5284E-12"\r
+ iyy="4.632E-07"\r
+ iyz="-2.5186E-08"\r
+ izz="1.7179E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Ane_J3"\r
type="revolute">\r
<origin\r
- xyz="-0.00066054 0 0.0267"\r
- rpy="-0.017497 -2.5506E-18 1.5754E-16" />\r
+ xyz="0.00066054 0 -0.0267"\r
+ rpy="-3.089 -1.3878E-17 -3.1416" />\r
<parent\r
link="Ane_L2" />\r
<child\r
name="Med_L1">\r
<inertial>\r
<origin\r
- xyz="0.010707 -0.00021663 0.02162"\r
+ xyz="0.0068039 0.00021663 -0.02162"\r
rpy="0 0 0" />\r
<mass\r
- value="0.011049" />\r
+ value="0.0096962" />\r
<inertia\r
- ixx="2.7163E-06"\r
- ixy="-5.3954E-11"\r
- ixz="1.5285E-11"\r
- iyy="2.7469E-06"\r
- iyz="-6.4518E-08"\r
- izz="5.2852E-07" />\r
+ ixx="2.3836E-06"\r
+ ixy="4.7346E-11"\r
+ ixz="-1.3411E-11"\r
+ iyy="2.4105E-06"\r
+ iyz="-5.6616E-08"\r
+ izz="4.6379E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Med_J1"\r
type="revolute">\r
<origin\r
- xyz="0.0037383 -0.11635 0.17852"\r
- rpy="0.12975 -4.3637E-17 -3.0805" />\r
+ xyz="-0.0034154 -0.00020889 0.1285"\r
+ rpy="-3.0417 -8.6736E-19 -1.5097" />\r
<parent\r
link="base_link" />\r
<child\r
name="Med_L2">\r
<inertial>\r
<origin\r
- xyz="0.010709 -0.00039695 0.010872"\r
+ xyz="-0.0068049 -0.00039803 -0.010872"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0060005" />\r
+ value="0.0052659" />\r
<inertia\r
- ixx="6.9825E-07"\r
- ixy="-2.895E-10"\r
- ixz="-2.7011E-11"\r
- iyy="7.1823E-07"\r
- iyz="-2.8977E-08"\r
- izz="2.6723E-07" />\r
+ ixx="6.1276E-07"\r
+ ixy="1.1335E-10"\r
+ ixz="4.1403E-11"\r
+ iyy="6.303E-07"\r
+ iyz="2.537E-08"\r
+ izz="2.345E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Med_J2"\r
type="revolute">\r
<origin\r
- xyz="0 0 0.047"\r
- rpy="-0.047363 2.4286E-17 1.8041E-16" />\r
+ xyz="0 0 -0.047"\r
+ rpy="0.092983 9.1051E-18 3.1416" />\r
<parent\r
link="Med_L1" />\r
<child\r
link="Med_L2" />\r
<axis\r
- xyz="-1 0 0" />\r
+ xyz="1 0 0" />\r
<limit\r
lower="0"\r
upper="1.57"\r
name="Med_L3">\r
<inertial>\r
<origin\r
- xyz="0.0097789 -0.00045405 0.0099716"\r
+ xyz="0.0068036 -0.00045399 0.0099715"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0056943" />\r
+ value="0.0049969" />\r
<inertia\r
- ixx="5.6108E-07"\r
- ixy="7.3014E-11"\r
- ixz="8.5882E-12"\r
- iyy="5.2784E-07"\r
- iyz="-2.8704E-08"\r
- izz="1.9576E-07" />\r
+ ixx="4.9237E-07"\r
+ ixy="6.3732E-11"\r
+ ixz="7.6266E-12"\r
+ iyy="4.632E-07"\r
+ iyz="-2.5186E-08"\r
+ izz="1.7179E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Med_J3"\r
type="revolute">\r
<origin\r
- xyz="0.00092729 0 0.0267"\r
- rpy="-0.20497 -3.5562E-16 -5.5234E-15" />\r
+ xyz="0 0 -0.0267"\r
+ rpy="3.135 1.0368E-18 -3.1416" />\r
<parent\r
link="Med_L2" />\r
<child\r
name="Ind_L1">\r
<inertial>\r
<origin\r
- xyz="0.011641 -0.00021663 0.02162"\r
+ xyz="0.01165 0.00021663 -0.02162"\r
rpy="0 0 0" />\r
<mass\r
- value="0.011049" />\r
+ value="0.0096962" />\r
<inertia\r
- ixx="2.7163E-06"\r
- ixy="-5.4061E-11"\r
- ixz="1.5184E-11"\r
- iyy="2.7469E-06"\r
- iyz="-6.4517E-08"\r
- izz="5.2852E-07" />\r
+ ixx="2.3836E-06"\r
+ ixy="4.7439E-11"\r
+ ixz="-1.3332E-11"\r
+ iyy="2.4105E-06"\r
+ iyz="-5.6616E-08"\r
+ izz="4.6379E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Ind_J1"\r
type="revolute">\r
<origin\r
- xyz="-0.019216 -0.11882 0.1785"\r
- rpy="0.145 0.017364 -3.0402" />\r
+ xyz="-0.0011787 -0.019259 0.12848"\r
+ rpy="-3.0766 0.017364 -1.4694" />\r
<parent\r
link="base_link" />\r
<child\r
name="Ind_L2">\r
<inertial>\r
<origin\r
- xyz="0.011642 -0.00039808 0.010872"\r
+ xyz="-0.011652 -0.000397 -0.010872"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0060007" />\r
+ value="0.0052656" />\r
<inertia\r
- ixx="6.9827E-07"\r
- ixy="-1.2605E-10"\r
- ixz="4.5989E-11"\r
- iyy="7.1826E-07"\r
- iyz="-2.8912E-08"\r
- izz="2.6723E-07" />\r
+ ixx="6.1273E-07"\r
+ ixy="2.5193E-10"\r
+ ixz="-2.4047E-11"\r
+ iyy="6.3027E-07"\r
+ iyz="2.5427E-08"\r
+ izz="2.345E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Ind_J2"\r
type="revolute">\r
<origin\r
- xyz="0 0 0.047"\r
- rpy="-0.14159 -6.5573E-16 -4.5242E-15" />\r
+ xyz="0 0 -0.047"\r
+ rpy="0.012461 -2.6021E-15 3.1416" />\r
<parent\r
link="Ind_L1" />\r
<child\r
link="Ind_L2" />\r
<axis\r
- xyz="-1 0 0" />\r
+ xyz="1 0 0" />\r
<limit\r
lower="0"\r
upper="1.57"\r
name="Ind_L3">\r
<inertial>\r
<origin\r
- xyz="0.0098661 -0.00045402 0.0099715"\r
+ xyz="0.01021 -0.000454 0.0099715"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0056943" />\r
+ value="0.0049969" />\r
<inertia\r
- ixx="5.6108E-07"\r
- ixy="7.2946E-11"\r
- ixz="8.9685E-12"\r
- iyy="5.2784E-07"\r
- iyz="-2.87E-08"\r
- izz="1.9576E-07" />\r
+ ixx="4.9237E-07"\r
+ ixy="6.3775E-11"\r
+ ixz="7.6703E-12"\r
+ iyy="4.632E-07"\r
+ iyz="-2.5186E-08"\r
+ izz="1.7179E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Ind_J3"\r
type="revolute">\r
<origin\r
- xyz="0.0017745 0 0.0267"\r
- rpy="-0.12298 2.7701E-15 -3.7331E-15" />\r
+ xyz="-0.0014401 0 -0.0267"\r
+ rpy="3.0788 -2.6021E-15 -3.1416" />\r
<parent\r
link="Ind_L2" />\r
<child\r
name="Pol_L1">\r
<inertial>\r
<origin\r
- xyz="0.00038989 -0.11993 0.032281"\r
+ xyz="-0.00037528 0.0019284 0.070349"\r
rpy="0 0 0" />\r
<mass\r
- value="1.0706" />\r
+ value="0.16469" />\r
<inertia\r
- ixx="0.0047736"\r
- ixy="4.2389E-06"\r
- ixz="-3.3527E-05"\r
- iyy="0.0049052"\r
- iyz="-7.9528E-06"\r
- izz="0.0054906" />\r
+ ixx="0.0002481"\r
+ ixy="-3.8181E-06"\r
+ ixz="1.5344E-06"\r
+ iyy="0.00015717"\r
+ iyz="-1.4443E-06"\r
+ izz="0.00010769" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Pol_J1"\r
type="revolute">\r
<origin\r
- xyz="-0.032499 -0.11966 0.10712"\r
- rpy="0.038968 0.52228 -3.0636" />\r
+ xyz="-0.00033603 -0.03241 0.056854"\r
+ rpy="3.022 -0.511 1.8117" />\r
<parent\r
link="base_link" />\r
<child\r
link="Pol_L1" />\r
<axis\r
- xyz="0 0 1" />\r
+ xyz="0 0 -1" />\r
<limit\r
lower="0"\r
upper="1.57"\r
name="Pol_L2">\r
<inertial>\r
<origin\r
- xyz="0.041652 -0.00027691 0.021793"\r
+ xyz="0.040049 0.00021662 -0.02162"\r
rpy="0 0 0" />\r
<mass\r
- value="0.012344" />\r
+ value="0.0096962" />\r
<inertia\r
- ixx="2.8811E-06"\r
- ixy="-5.3655E-11"\r
- ixz="1.6474E-11"\r
- iyy="2.8912E-06"\r
- iyz="-7.4168E-08"\r
- izz="5.5752E-07" />\r
+ ixx="2.3836E-06"\r
+ ixy="4.7417E-11"\r
+ ixz="-1.3735E-11"\r
+ iyy="2.4105E-06"\r
+ iyz="-5.6616E-08"\r
+ izz="4.6379E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Pol_J2"\r
type="revolute">\r
<origin\r
- xyz="-0.011107 0 0.025672"\r
- rpy="-0.080887 0.17453 -3.9457E-16" />\r
+ xyz="0.0095283 0 -0.025675"\r
+ rpy="0.023564 -0.17453 3.1416" />\r
<parent\r
link="Pol_L1" />\r
<child\r
name="Pol_L3">\r
<inertial>\r
<origin\r
- xyz="0.027068 -0.00045401 0.0099715"\r
+ xyz="0.025569 -0.00045399 0.0099715"\r
rpy="0 0 0" />\r
<mass\r
- value="0.0056943" />\r
+ value="0.004997" />\r
<inertia\r
- ixx="5.6108E-07"\r
- ixy="7.2676E-11"\r
- ixz="9.0586E-12"\r
- iyy="5.2784E-07"\r
- iyz="-2.87E-08"\r
- izz="1.9576E-07" />\r
+ ixx="4.9237E-07"\r
+ ixy="6.3228E-11"\r
+ ixz="7.7223E-12"\r
+ iyy="4.632E-07"\r
+ iyz="-2.5185E-08"\r
+ izz="1.7179E-07" />\r
</inertial>\r
<visual>\r
<origin\r
<material\r
name="">\r
<color\r
- rgba="0.79216 0.81961 0.93333 1" />\r
+ rgba="1 1 1 1" />\r
</material>\r
</visual>\r
<collision>\r
name="Pol_J3"\r
type="revolute">\r
<origin\r
- xyz="0.014584 0 0.047"\r
- rpy="-0.034828 -2.7409E-16 -6.245E-16" />\r
+ xyz="0.01448 0 -0.047"\r
+ rpy="-3.1102 5.5511E-17 -1.1102E-16" />\r
<parent\r
link="Pol_L2" />\r
<child\r
effort="30"\r
velocity="2" />\r
</joint>\r
-\r
<transmission name="Pol1_transmission">\r
<type>transmission_interface/SimpleTransmission</type>\r
<joint name="Pol_J1">\r