replace id 12 with xm540-w270

diff --git a/urdf/open_manipulator.urdf.xacro b/urdf/open_manipulator.urdf.xacro
index 956569c98b7036dfbcb96e7e9da974f960a1d97c..53af13aa402e3e677c057317e4b53137a9524bb3 100644 (file)
--- a/urdf/open_manipulator.urdf.xacro
+++ b/urdf/open_manipulator.urdf.xacro
@@ -69,7 +69,7 @@
   <joint name="joint1" type="revolute">
          <parent link="link1"/>
          <child link="link2"/>
-         <origin xyz="0.012 0.0 0.017" rpy="0 0 0"/>
+         <origin xyz="0.012 0.0 0.036" rpy="0 0 0"/> <!-- Height servo+horn -->
          <axis xyz="0 0 1"/>
          <limit velocity="4.8" effort="1" lower="${-pi}" upper="${pi}" />
   </joint>
@@ -80,17 +80,15 @@
   <!--  Link 2 -->
   <link name="link2">
          <visual>
-                 <origin xyz="0 0 0.019" rpy="0 0 0"/>
                  <geometry>
-                         <mesh filename="package://open_manipulator_description/meshes/chain_link2.stl" scale="0.001 0.001 0.001"/>
+                         <mesh filename="package://open_manipulator_description/meshes/chain_link2.stl" scale="${0.001*33.5/28.5} ${0.001*44/34} ${0.001*58.5/46.5}"/> <!-- scale by XM540 -->
                  </geometry>
                  <material name="grey"/>
          </visual>
 
          <collision>
-                 <origin xyz="0 0 0.019" rpy="0 0 0"/>
                  <geometry>
-                         <mesh filename="package://open_manipulator_description/meshes/chain_link2.stl" scale="0.001 0.001 0.001"/>
+                         <mesh filename="package://open_manipulator_description/meshes/chain_link2.stl" scale="${0.001*33.5/28.5} ${0.001*44/34} ${0.001*58.5/46.5}"/> <!-- scale by XM540 -->
                  </geometry>
          </collision>
 
@@ -115,7 +113,7 @@
   <joint name="joint2" type="revolute">
          <parent link="link2"/>
          <child link="link3"/>
-         <origin xyz="0.0 0.0 0.0595" rpy="0 0 0"/>
+         <origin xyz="0.0 0.0 0.0515" rpy="0 0 0"/> <!-- fr13-s102k to middle of servo horn -->
          <axis xyz="0 1 0"/>
          <limit velocity="4.8" effort="1" lower="${-pi*0.64}" upper="${pi*0.64}" />
   </joint>
@@ -128,7 +126,7 @@
          <visual>
                  <origin xyz="0 0 0" rpy="0 0 0"/>
                  <geometry>
-                         <mesh filename="package://open_manipulator_description/meshes/chain_link3.stl" scale="0.001 0.001 0.001"/>
+                         <mesh filename="package://open_manipulator_description/meshes/chain_link3.stl" scale="0.001 0.001 ${0.001*(1+0.004/0.128)}"/> <!-- scale by 4mm more, see joint3 -->
                  </geometry>
                  <material name="grey"/>
          </visual>
@@ -136,7 +134,7 @@
          <collision>
                  <origin xyz="0 0 0" rpy="0 0 0"/>
                  <geometry>
-                         <mesh filename="package://open_manipulator_description/meshes/chain_link3.stl" scale="0.001 0.001 0.001"/>
+                         <mesh filename="package://open_manipulator_description/meshes/chain_link3.stl" scale="0.001 0.001 ${0.001*(1+0.004/0.128)}"/> <!-- scale by 4mm more, see joint3 -->
                  </geometry>
          </collision>
 
@@ -161,7 +159,7 @@
   <joint name="joint3" type="revolute">
          <parent link="link3"/>
          <child link="link4"/>
-         <origin xyz="0.024 0 0.128" rpy="0 0 0"/>
+         <origin xyz="0.024 0 ${0.128+0.004}" rpy="0 0 0"/> <!-- 4mm more for FR13-H101K-->
          <axis xyz="0 1 0"/>
          <limit velocity="4.8" effort="1" lower="${-pi*0.64}" upper="${pi*0.48}" />
   </joint>