You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 

841 lines
19 KiB

<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="stretch_main">
<xacro:property name="M_PI" value="3.1415926535897931" />
<xacro:property name="joint_damping" value="21.75"/>
<xacro:property name="joint_friction" value="10.48"/>
<xacro:property name="joint_spring_stiffness" value="0"/>
<xacro:property name="joint_spring_reference" value="0"/>
<link
name="base_link">
<inertial>
<origin
xyz="-0.11587 0.0019426 0.093621"
rpy="0 0 0" />
<mass
value="1.1912" />
<inertia
ixx="0.0034667"
ixy="-5.0568E-06"
ixz="0.00042861"
iyy="0.0052744"
iyz="-5.766E-05"
izz="0.0047945" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/base_link.STL" />
</geometry>
<material
name="">
<color
rgba="0.79216 0.81961 0.93333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/base_link.STL" />
</geometry>
</collision>
</link>
<link
name="link_right_wheel">
<inertial>
<origin
xyz="1.1719E-11 2.0783E-11 0.037544"
rpy="0 0 0" />
<mass
value="0.0042721" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_right_wheel.STL" />
</geometry>
<material
name="">
<color
rgba="0.79216 0.81961 0.93333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_right_wheel.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_right_wheel"
type="continuous">
<origin
xyz="0 -0.17035 0.0508"
rpy="-1.5708 1.2717E-16 4.8006E-17" />
<parent
link="base_link" />
<child
link="link_right_wheel" />
<axis
xyz="0 0 1" />
<dynamics damping="${joint_damping}" friction="${joint_friction}" spring_reference="${joint_spring_reference}" spring_stiffness="${joint_spring_stiffness}"/>
</joint>
<link
name="link_left_wheel">
<inertial>
<origin
xyz="-2.0783E-11 -1.1719E-11 -0.037544"
rpy="0 0 0" />
<mass
value="0.0042721" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_left_wheel.STL" />
</geometry>
<material
name="">
<color
rgba="0.79216 0.81961 0.93333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_left_wheel.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_left_wheel"
type="continuous">
<origin
xyz="0 0.17035 0.0508"
rpy="-1.5708 2.6317E-16 -8.2057E-19" />
<parent
link="base_link" />
<child
link="link_left_wheel" />
<axis
xyz="0 0 1" />
<dynamics damping="${joint_damping}" friction="${joint_friction}" spring_reference="${joint_spring_reference}" spring_stiffness="${joint_spring_stiffness}"/>
</joint>
<link name="caster_link">
<collision>
<geometry>
<sphere radius="0.032"/>
</geometry>
<origin rpy="0 0 0" xyz="0 0 0"/>
<surface>
<friction>
<ode>
<mu>0</mu>
<mu2>0</mu2>
<slip1>1.0</slip1>
<slip2>1.0</slip2>
</ode>
</friction>
</surface>
</collision>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/omni_wheel_m.STL" />
</geometry>
<material
name="">
<color
rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
</material>
</visual>
<inertial>
<mass value="0.01" />
<origin xyz="0 0 0" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
</link>
<joint name="caster_joint" type="fixed">
<parent link="base_link"/>
<child link="caster_link"/>
<origin xyz="-0.245 0.0 0.032" rpy="${-M_PI/2} 0 0"/>
<axis xyz="0 0 1" />
</joint>
<link
name="link_mast">
<inertial>
<origin
xyz="2.0817E-17 0.7075 -2.7756E-17"
rpy="0 0 0" />
<mass
value="1.8285" />
<inertia
ixx="0.0709854511954588"
ixy="-0.00433428742758457"
ixz="-0.000186110788697573"
iyy="0.000437922053342648"
iyz="-0.00288788257713431"
izz="0.071104808501661" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_mast.STL" />
</geometry>
<material
name="">
<color
rgba="0.79216 0.81961 0.93333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_mast.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_mast"
type="fixed">
<origin
xyz="-0.067 0.135 0.0284"
rpy="1.5708 0 4.8006E-17" />
<parent
link="base_link" />
<child
link="link_mast" />
<axis
xyz="0 0 0" />
</joint>
<link
name="link_lift">
<inertial>
<origin
xyz="-0.031727 0.038403 0.013361"
rpy="0 0 0" />
<mass
value="0.27218" />
<inertia
ixx="0.00052571"
ixy="0.00014899"
ixz="-1.9258E-05"
iyy="0.00030679"
iyz="-6.2451E-06"
izz="0.00037324" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_lift.STL" />
</geometry>
<material
name="">
<color
rgba="0.79216 0.81961 0.93333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_lift.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_lift"
type="prismatic">
<origin
xyz="-0.037385 0.1666 0"
rpy="-1.5708 1.5708 0" />
<parent
link="link_mast" />
<child
link="link_lift" />
<axis
xyz="0 0 1" />
<!-- for now: hand copied range_m: from lift: from ~/repos/stretch_fleet/stretch-re1-1001/stretch_re1_factory_params.yaml -->
<!--<limit effort="100" lower="0.0" upper="1.095" velocity="1.0"/>-->
<!-- copied value did not reach the top of mesh model with GUI sliders and RViz -->
<limit effort="100" lower="0.0" upper="1.1" velocity="1.0"/>
</joint>
<link
name="link_arm_l4">
<inertial>
<origin
xyz="-1.0146E-06 -1.9719E-05 -0.094738"
rpy="0 0 0" />
<mass
value="0.068095" />
<inertia
ixx="0.0001256"
ixy="-5.6914E-12"
ixz="6.0647E-09"
iyy="0.0001256"
iyz="1.1787E-07"
izz="1.1091E-10" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l4.STL" />
</geometry>
<material
name="">
<color
rgba="0.79216 0.81961 0.93333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l4.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_arm_l4"
type="fixed">
<origin
xyz="-0.2547 0 0"
rpy="1.5708 2.4721E-15 -1.5708" />
<parent
link="link_lift" />
<child
link="link_arm_l4" />
<axis
xyz="0 0 0" />
</joint>
<link
name="link_arm_l3">
<inertial>
<origin
xyz="-5.13853606326845E-07 -1.99844969271112E-05 -0.0971104963726614"
rpy="0 0 0" />
<mass
value="0.0628927381893134" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l3.STL" />
</geometry>
<material
name="">
<color
rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l3.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_arm_l3"
type="prismatic">
<origin
xyz="0 0 0.013"
rpy="7.68831233799385E-30 2.36716479416092E-30 2.29652732251143E-17" />
<parent
link="link_arm_l4" />
<child
link="link_arm_l3" />
<axis
xyz="0 0 1" />
<!-- 0.13 = 0.52/4-->
<limit effort="100" lower="0.0" upper="0.13" velocity="1.0"/>
</joint>
<link
name="link_arm_l2">
<inertial>
<origin
xyz="-5.17421949435687E-07 -2.02045301450349E-05 -0.0968815475684904"
rpy="0 0 0" />
<mass
value="0.0571386353275368" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l2.STL" />
</geometry>
<material
name="">
<color
rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l2.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_arm_l2"
type="prismatic">
<origin
xyz="0 0 0.013"
rpy="0 1.57655765344625E-30 -1.66533453693773E-16" />
<parent
link="link_arm_l3" />
<child
link="link_arm_l2" />
<axis
xyz="0 0 1" />
<!-- 0.13 = 0.52/4-->
<limit effort="100" lower="0.0" upper="0.13" velocity="1.0"/>
</joint>
<link
name="link_arm_l1">
<inertial>
<origin
xyz="-5.257E-07 -2.0482E-05 -0.096543"
rpy="0 0 0" />
<mass
value="0.051382" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l1.STL" />
</geometry>
<material
name="">
<color
rgba="0.79216 0.81961 0.93333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l1.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_arm_l1"
type="prismatic">
<origin
xyz="0 0 0.0129999999999981"
rpy="-7.63746778746202E-30 -7.88860905221012E-31 1.11022302462516E-16" />
<parent
link="link_arm_l2" />
<child
link="link_arm_l1" />
<axis
xyz="0 0 1" />
<!-- 0.13 = 0.52/4-->
<limit effort="100" lower="0.0" upper="0.13" velocity="1.0"/>
</joint>
<link
name="link_arm_l0">
<inertial>
<origin
xyz="0.0270582141286185 -0.00189876414654466 -0.0377809018481181"
rpy="0 0 0" />
<mass
value="0.085003260946398" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l0.STL" />
</geometry>
<material
name="">
<color
rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_arm_l0.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_arm_l0"
type="prismatic">
<origin
xyz="0 0 -0.0137499999991968"
rpy="7.63746778746202E-30 -3.80121128864402E-15 2.62707547767438E-15" />
<parent
link="link_arm_l1" />
<child
link="link_arm_l0" />
<axis
xyz="0 0 1" />
<!-- 0.13 = 0.52/4-->
<limit effort="100" lower="0.0" upper="0.13" velocity="1.0"/>
</joint>
<link
name="link_wrist_yaw">
<inertial>
<origin
xyz="2.20122392535771E-11 2.9317167880849E-05 -0.018966592644729"
rpy="0 0 0" />
<mass
value="0.0404746907425003" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_wrist_yaw.STL" />
</geometry>
<material
name="">
<color
rgba="0.898039215686275 0.917647058823529 0.929411764705882 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_wrist_yaw.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_wrist_yaw"
type="revolute">
<origin
xyz="0.0830000000000654 -0.0307500000000129 0"
rpy="1.5708 4.2595E-14 2.6415E-15"/>
<parent
link="link_arm_l0" />
<child
link="link_wrist_yaw" />
<axis
xyz="0 0 -1" />
<!--
stowed to front ~225 deg: 3.15159 x 1.25 = 3.9395
using 4.0
stowed to back ~100 deg: 100 / 180 x 3.14159 = 1.7453
using -1.75
-->
<limit effort="100" lower="-1.75" upper="4.0" velocity="1.0"/>
</joint>
<link
name="link_head">
<inertial>
<origin
xyz="0.0406850995527703 0.0396956343318414 0.0226500246461012"
rpy="0 0 0" />
<mass
value="0.133027236718691" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_head.STL" />
</geometry>
<material
name="">
<color
rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_head.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_head"
type="fixed">
<origin
xyz="0 1.33 0"
rpy="1.5707963267949 -1.5707963267949 3.1416" />
<parent
link="link_mast" />
<child
link="link_head" />
<axis
xyz="0 0 0" />
</joint>
<link
name="link_head_pan">
<inertial>
<origin
xyz="-0.000326562615178591 0.00850012613776489 0.000130487222982367"
rpy="0 0 0" />
<mass
value="0.0273764496535409" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_head_pan.STL" />
</geometry>
<material
name="">
<color
rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_head_pan.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_head_pan"
type="revolute">
<origin
xyz="0.135 0.0731000000000001 -0.00319621125547975"
rpy="0 0 1.5707963267949" />
<parent
link="link_head" />
<child
link="link_head_pan" />
<axis
xyz="0 0 1" />
<!-- unconstrained range for now -->
<limit effort="100" lower="-3.9" upper="1.5" velocity="1.0"/>
</joint>
<link
name="link_head_tilt">
<inertial>
<origin
xyz="0.00704566394917504 -0.0212256210929691 0.0302058990060359"
rpy="0 0 0" />
<mass
value="0.090217113313934" />
<inertia
ixx="0.001"
ixy="0"
ixz="0"
iyy="0.001"
iyz="0"
izz="0.001" />
</inertial>
<visual>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_head_tilt.STL" />
</geometry>
<material
name="">
<color
rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
</material>
</visual>
<collision>
<origin
xyz="0 0 0"
rpy="0 0 0" />
<geometry>
<mesh
filename="package://stretch_description/meshes/link_head_tilt.STL" />
</geometry>
</collision>
</link>
<joint
name="joint_head_tilt"
type="revolute">
<origin
xyz="-0.00130000001785262 0.0277624999926072 -0.0533107920897029"
rpy="1.5707963267949 3.36459255518345E-15 -8.42914893687103E-17" />
<parent
link="link_head_pan" />
<child
link="link_head_tilt" />
<axis
xyz="0 0 1" />
<!-- unconstrained range for now -->
<limit effort="100" lower="-1.53" upper="0.79" velocity="1.0"/>
</joint>
</robot>