add kuka_lwr urdf file for testing, the r2d2 gets boring

data/kuka_lwr/kuka_lwr_arm.urdf.xacro

@@ -0,0 +1,418 @@
+<?xml version="1.0"?>
+<robot xmlns:sensor="http://playerstage.sourceforge.net/gazebo/xmlschema/#sensor"
+       xmlns:controller="http://playerstage.sourceforge.net/gazebo/xmlschema/#controller"
+       xmlns:interface="http://playerstage.sourceforge.net/gazebo/xmlschema/#interface">
+
+ <property name="M_PI" value="3.1415926535897931" />
+<property name="name" value="kuka" />
+  <!--
+     Little helper macro to define the inertia matrix needed
+     for links.
+     -->
+  <macro name="cuboid_inertia_def" params="width height length mass">
+    <inertia ixx="${mass * (height * height + length * length) / 12)}"
+             iyy="${mass * (width * width + length * length) / 12)}"
+             izz="${mass * (width * width + height * height) / 12)}"
+             ixy="0" iyz="0" ixz="0"/>
+  </macro>
+
+  <!-- length is along the y-axis! -->
+  <macro name="cylinder_inertia_def" params="radius length mass">
+    <inertia ixx="${mass * (3 * radius * radius + length * length) / 12)}"
+             iyy="${mass * radius* radius / 2)}"
+             izz="${mass * (3 * radius * radius + length * length) / 12)}"
+             ixy="0" iyz="0" ixz="0"/>
+  </macro>
+
+  <property name="arm_elem_link_mass" value="2.0"/>
+  <property name="arm_elem_ball_link_mass" value="2.0"/>
+  <property name="arm_elem_end_link_mass" value="2.0"/>
+  <property name="safety_controller_k_pos" value="100" />
+  <property name="safety_controller_k_vel" value="2" />
+  <property name="joint_damping" value="0.1" />
+
+  <property name="arm_velocity_scale_factor" value="1"/>
+ <property name="right" value="0" />
+  <!-- right is either 1 (for right arm) or -1 (for left arm) -->
+
+    <joint name="${name}_arm_base_joint" type="fixed">
+      <origin xyz="0 0 0" rpy="0 0 0" />
+      <child link="calib_${name}_arm_base_link"/>
+    </joint>
+
+    <link name="calib_${name}_arm_base_link">
+      <inertial>
+        <mass value="2"/>
+        <origin xyz="0 0 0.055" rpy="0 0 0"/>
+        <cylinder_inertia_def radius="0.06" length="0.11"
+                              mass="2"/>
+      </inertial>
+
+      <visual>
+        <origin xyz="0 0 0" rpy="0 0 0"/>
+        <geometry>
+          <mesh filename="meshes_arm/arm_base.dae"/>
+        </geometry>
+        <material name="Orange"/>
+      </visual>
+      <collision>
+        <origin xyz="0 0 0" rpy="0 0 0"/>
+        <geometry>
+          <mesh filename="meshes_arm/convex/arm_base_convex.stl"/>
+        </geometry>
+      </collision>
+    </link>
+
+    <gazebo reference="calib_${name}_arm_base_link">
+      <material value="kuka-lwr.material"/>
+    </gazebo>
+
+    <joint name="${name}_arm_0_joint" type="revolute">
+      <origin xyz="0 0 0.11" rpy="0 0 0"/>
+      <axis xyz="0 0 1"/>
+      <limit lower="${-170 * M_PI / 180}" upper="${170 * M_PI / 180}"
+             effort="204" velocity="${arm_velocity_scale_factor * 110 * M_PI / 180}" />
+      <safety_controller soft_lower_limit="${-168 * M_PI / 180}"
+                         soft_upper_limit="${168 * M_PI / 180}"
+                         k_position="${safety_controller_k_pos}"
+                         k_velocity="${safety_controller_k_vel}"/>
+      <dynamics damping="${joint_damping}"/>
+      <parent link="calib_${name}_arm_base_link"/>
+      <child link="${name}_arm_1_link"/>
+    </joint>
+
+    <link name="${name}_arm_1_link">
+      <inertial>
+        <mass value="${arm_elem_link_mass}"/>
+        <origin rpy="0 0 0" xyz="0 0 0.130"/>
+        <cuboid_inertia_def length="0.12" width="0.06" height="0.260"
+                            mass="${arm_elem_link_mass}"/>
+      </inertial>
+
+      <visual>
+        <origin xyz="0 0 0" rpy="0 0 ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/arm_segment_a.dae"/>
+        </geometry>
+        <material name="Orange"/>
+      </visual>
+
+      <collision>
+        <origin xyz="0 0 0" rpy="0 0 ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/convex/arm_segment_a_convex.stl"/>
+        </geometry>
+      </collision>
+    </link>
+
+    <gazebo reference="${name}_arm_1_link">
+      <material value="kuka-lwr.material"/>
+    </gazebo>
+
+    <transmission name="${name}_arm_0_trans" type="pr2_mechanism_model/SimpleTransmission">
+      <actuator name="${name}_arm_0_motor"/>
+      <joint name="${name}_arm_0_joint"/>
+      <mechanicalReduction>1.0</mechanicalReduction>
+    </transmission>
+
+    <joint name="${name}_arm_1_joint" type="revolute">
+      <origin xyz="0 0 0.20" rpy="0 0 0"/>
+      <axis xyz="0 -1 0"/>
+      <!--limit lower="${-120 * M_PI / 180}" upper="${120 * M_PI / 180}"
+             effort="306" velocity="${arm_velocity_scale_factor * 110 * M_PI / 180}" /-->
+                 <!-- nalt: Reduced limits to avoid contact with table - kinda hacky, should not be done here -->
+      <limit lower="${-90 * M_PI / 180}" upper="${90 * M_PI / 180}"
+             effort="306" velocity="${arm_velocity_scale_factor * 110 * M_PI / 180}" />       
+      <safety_controller soft_lower_limit="${-118 * M_PI / 180}"
+                         soft_upper_limit="${118 * M_PI / 180}"
+                         k_position="${safety_controller_k_pos}"
+                         k_velocity="${safety_controller_k_vel}"/>
+      <dynamics damping="${joint_damping}"/>
+      <parent link="${name}_arm_1_link"/>
+      <child link="${name}_arm_2_link"/>
+    </joint>
+
+    <link name="${name}_arm_2_link">
+      <inertial>
+        <mass value="${arm_elem_link_mass}"/>
+        <origin rpy="0 0 0" xyz="0 0.06 ${0.130 - 0.06}"/>
+        <cuboid_inertia_def length="0.12" width="0.06" height="0.260"
+                            mass="${arm_elem_link_mass}"/>
+      </inertial>
+
+      <visual>
+        <origin xyz="0 0 0.2" rpy="${M_PI} 0 ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/arm_segment_b.dae"/>
+        </geometry>
+        <material name="Orange"/>
+      </visual>
+
+      <collision>
+        <origin xyz="0 0 0.2" rpy="${M_PI} 0 ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/convex/arm_segment_b_convex.stl"/>
+        </geometry>
+      </collision>
+    </link>
+
+    <gazebo reference="${name}_arm_2_link">
+      <material value="kuka-lwr.material"/>
+    </gazebo>
+
+    <transmission name="${name}_arm_1_trans" type="pr2_mechanism_model/SimpleTransmission">
+      <actuator name="${name}_arm_1_motor"/>
+      <joint name="${name}_arm_1_joint"/>
+      <mechanicalReduction>1.0</mechanicalReduction>
+    </transmission>
+
+    <joint name="${name}_arm_2_joint" type="revolute">
+      <origin xyz="0 0 0.20" rpy="0 0 0"/>
+      <axis xyz="0 0 1"/>
+      <limit lower="${-170 * M_PI / 180}" upper="${170 * M_PI / 180}"
+             effort="204" velocity="${arm_velocity_scale_factor * 130 * M_PI / 180}" />
+      <safety_controller soft_lower_limit="${-168 * M_PI / 180}"
+                         soft_upper_limit="${168 * M_PI / 180}"
+                         k_position="${safety_controller_k_pos}"
+                         k_velocity="${safety_controller_k_vel}"/>
+      <dynamics damping="${joint_damping}"/>
+      <parent link="${name}_arm_2_link"/>
+      <child link="${name}_arm_3_link"/>
+    </joint>
+
+    <link name="${name}_arm_3_link">
+      <inertial>
+        <mass value="${arm_elem_link_mass}"/>
+        <origin rpy="0 0 0" xyz="0 0.06 0.130"/>
+        <cuboid_inertia_def length="0.12" width="0.06" height="0.260"
+                            mass="${arm_elem_link_mass}"/>
+      </inertial>
+
+      <visual>
+        <origin xyz="0 0 0" rpy="0 0 0"/>
+        <geometry>
+          <mesh filename="meshes_arm/arm_segment_a.dae"/>
+        </geometry>
+        <material name="Orange"/>
+      </visual>
+
+      <collision>
+        <origin xyz="0 0 0" rpy="0 0 0"/>
+        <geometry>
+          <mesh filename="meshes_arm/convex/arm_segment_a_convex.stl"/>
+        </geometry>
+      </collision>
+    </link>
+
+    <gazebo reference="${name}_arm_3_link">
+      <material value="kuka-lwr.material"/>
+    </gazebo>
+
+    <transmission name="${name}_arm_2_trans" type="pr2_mechanism_model/SimpleTransmission">
+      <actuator name="${name}_arm_2_motor"/>
+      <joint name="${name}_arm_2_joint"/>
+      <mechanicalReduction>1.0</mechanicalReduction>
+    </transmission>
+
+    <joint name="${name}_arm_3_joint" type="revolute">
+      <origin xyz="0 0 0.20" rpy="0 0 0"/>
+      <axis xyz="0 1 0"/>
+      <limit lower="${-120 * M_PI / 180}" upper="${120 * M_PI / 180}"
+             effort="306" velocity="${arm_velocity_scale_factor * 130 * M_PI / 180}" />
+      <safety_controller soft_lower_limit="${-118 * M_PI / 180}"
+                         soft_upper_limit="${118 * M_PI / 180}"
+                         k_position="${safety_controller_k_pos}"
+                         k_velocity="${safety_controller_k_vel}"/>
+      <dynamics damping="${joint_damping}"/>
+      <parent link="${name}_arm_3_link"/>
+      <child link="${name}_arm_4_link"/>
+    </joint>
+
+    <link name="${name}_arm_4_link">
+      <inertial>
+        <mass value="${arm_elem_link_mass}"/>
+        <origin rpy="0 0 0" xyz="0 -0.06 ${0.130 - 0.06}"/>
+        <cuboid_inertia_def length="0.12" width="0.06" height="0.2600"
+                            mass="${arm_elem_link_mass}"/>
+      </inertial>
+
+      <visual>
+        <origin xyz="0 0 0.2" rpy="0 ${M_PI} ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/arm_segment_b.dae"/>
+        </geometry>
+        <material name="Orange"/>
+      </visual>
+
+      <collision>
+        <origin xyz="0 0 0.2" rpy="0 ${M_PI} ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/convex/arm_segment_b_convex.stl"/>
+        </geometry>
+      </collision>
+    </link>
+
+    <gazebo reference="${name}_arm_4_link">
+      <material value="kuka-lwr.material"/>
+    </gazebo>
+
+    <transmission name="${name}_arm_3_trans" type="pr2_mechanism_model/SimpleTransmission">
+      <actuator name="${name}_arm_3_motor"/>
+      <joint name="${name}_arm_3_joint"/>
+      <mechanicalReduction>1.0</mechanicalReduction>
+    </transmission>
+
+    <joint name="${name}_arm_4_joint" type="revolute">
+      <origin xyz="0 0 0.20" rpy="0 0 0"/>
+      <axis xyz="0 0 1"/>
+      <limit lower="${-170 * M_PI / 180}" upper="${170 * M_PI / 180}"
+             effort="204" velocity="${arm_velocity_scale_factor * 130 * M_PI / 180}" />
+      <safety_controller soft_lower_limit="${-168 * M_PI / 180}"
+                         soft_upper_limit="${168 * M_PI / 180}"
+                         k_position="${safety_controller_k_pos}"
+                         k_velocity="${safety_controller_k_vel}"/>
+      <dynamics damping="${joint_damping}"/>
+      <parent link="${name}_arm_4_link"/>
+      <child link="${name}_arm_5_link"/>
+    </joint>
+
+    <link name="${name}_arm_5_link">
+      <inertial>
+        <mass value="${arm_elem_link_mass}"/>
+        <origin rpy="0 0 0" xyz="0 0 0.124"/>
+        <cuboid_inertia_def length="0.12" width="0.06" height="0.248"
+                            mass="${arm_elem_link_mass}"/>
+      </inertial>
+
+      <visual>
+        <origin xyz="0 0 0" rpy="0 0 ${M_PI}"/>
+        <geometry name="${name}_arm_5_geom">
+          <mesh filename="meshes_arm/arm_segment_last.dae"/>
+        </geometry>
+        <material name="Orange"/>
+      </visual>
+
+      <collision>
+        <origin xyz="0 0 0" rpy="0 0 ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/convex/arm_segment_last_convex.stl"/>
+        </geometry>
+      </collision>
+    </link>
+
+    <gazebo reference="${name}_arm_5_link">
+      <material value="kuka-lwr.material"/>
+    </gazebo>
+
+    <transmission name="${name}_arm_4_trans" type="pr2_mechanism_model/SimpleTransmission">
+      <actuator name="${name}_arm_4_motor"/>
+      <joint name="${name}_arm_4_joint"/>
+      <mechanicalReduction>1.0</mechanicalReduction>
+    </transmission>
+
+    <joint name="${name}_arm_5_joint" type="revolute">
+      <origin xyz="0 0 0.19" rpy="0 0 0"/>
+      <axis xyz="0 -1 0"/>
+      <limit lower="${-120 * M_PI / 180}" upper="${120 * M_PI / 180}"
+             effort="306" velocity="${arm_velocity_scale_factor * 180 * M_PI / 180}" />
+      <safety_controller soft_lower_limit="${-118 * M_PI / 180}"
+                         soft_upper_limit="${118 * M_PI / 180}"
+                         k_position="${safety_controller_k_pos}"
+                         k_velocity="${safety_controller_k_vel}"/>
+      <dynamics damping="${joint_damping}"/>
+      <parent link="${name}_arm_5_link"/>
+      <child link="${name}_arm_6_link"/>
+    </joint>
+
+    <link name="${name}_arm_6_link">
+      <inertial>
+        <mass value="${arm_elem_ball_link_mass}"/>
+        <origin rpy="0 0 0" xyz="0 0 0.0625"/>
+        <cuboid_inertia_def length="0.125" width="0.125" height="0.125"
+                            mass="${arm_elem_ball_link_mass}"/>
+      </inertial>
+
+      <visual>
+        <origin xyz="0 0 0" rpy="0 0 ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/arm_wrist.dae"/>
+        </geometry>
+        <material name="Grey"/>
+      </visual>
+
+      <collision>
+        <origin xyz="0 0 0" rpy="0 0 ${M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/convex/arm_wrist_convex.stl"/>
+        </geometry>
+      </collision>
+    </link>
+
+    <gazebo reference="${name}_arm_6_link">
+      <material value="kuka-lwr.material"/>
+    </gazebo>
+
+    <transmission name="${name}_arm_5_trans" type="pr2_mechanism_model/SimpleTransmission">
+      <actuator name="${name}_arm_5_motor"/>
+      <joint name="${name}_arm_5_joint"/>
+      <mechanicalReduction>1.0</mechanicalReduction>
+    </transmission>
+
+    <joint name="${name}_arm_6_joint" type="revolute">
+      <origin xyz="0 0 0.078" rpy="0 0 0"/>
+      <axis xyz="0 0 1"/>
+      <limit lower="${-170 * M_PI / 180}" upper="${170 * M_PI / 180}"
+             effort="204" velocity="${arm_velocity_scale_factor * 180 * M_PI / 180}" />
+      <safety_controller soft_lower_limit="${-168 * M_PI / 180}"
+                         soft_upper_limit="${168 * M_PI / 180}"
+                         k_position="${safety_controller_k_pos}"
+                         k_velocity="${safety_controller_k_vel}"/>
+      <dynamics damping="${joint_damping}"/>
+      <parent link="${name}_arm_6_link"/>
+      <child link="${name}_arm_7_link"/>
+    </joint>
+
+    <link name="${name}_arm_7_link">
+      <inertial>
+        <mass value="${arm_elem_end_link_mass}"/>
+        <origin xyz="0 0 0"/>
+        <cuboid_inertia_def length="1" width="1" height="1"
+                            mass="${arm_elem_end_link_mass}"/>
+      </inertial>
+      <visual>
+        <origin xyz="0 0 0" rpy="0 0 ${right * -1/4 * M_PI  +  M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/arm_flanche_angle.dae"/>
+        </geometry>
+        <material name="Grey"/>
+      </visual>
+      <collision>
+        <origin xyz="0 0 0" rpy="0 0 ${right * -1/4 * M_PI  +  M_PI}"/>
+        <geometry>
+          <mesh filename="meshes_arm/convex/arm_flanche_angle__convex.stl"/>
+        </geometry>
+      </collision>
+    </link>
+    
+    <link name="lwr_arm_hand_link" />
+
+    <gazebo reference="${name}_arm_7_link">
+      <material value="kuka-lwr.material"/>
+    </gazebo>
+
+    <transmission name="${name}_arm_6_trans" type="pr2_mechanism_model/SimpleTransmission">
+      <actuator name="${name}_arm_6_motor"/>
+      <joint name="${name}_arm_6_joint"/>
+      <mechanicalReduction>1.0</mechanicalReduction>
+    </transmission>
+    
+    <joint name="${name}_arm_hand_fixed_joint" type="fixed">
+      <origin xyz="${-right * 0.075} -0.075 -0.094"
+              rpy="${0.5*right*M_PI} 0 ${(1.5 + 0.25*right)*M_PI}"/>
+      <parent link="${name}_arm_7_link"/>
+      <child link="${name}_arm_hand_link"/>
+    </joint>
+
+
+
+</robot>