Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- <?xml version="1.0"?>
- <robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="evt1">
- <xacro:include filename="$(find evt1)/urdf/macro.xacro"/>
- <xacro:include filename="$(find evt1)/urdf/gazebo.xacro"/>
- <!-- base -->
- <xacro:property name="size_base" value="0.610" />
- <xacro:property name="height_base" value="1.600" />
- <xacro:property name="height_pillier" value="0.380" />
- <xacro:property name="size_pillier" value="0.110" />
- <xacro:property name="half_size_base" value="${size_base/2.0}" />
- <xacro:property name="mass_pillier" value="0.1" />
- <!-- WHEELS -->
- <xacro:property name="wheel_length" value="0.045"/>
- <xacro:property name="wheel_mass" value="0.6"/>
- <xacro:property name="wheel_radius" value="0.100"/>
- <xacro:property name="caster_wheel_length" value="0.030"/>
- <xacro:property name="caster_wheel_mass" value="0.05"/>
- <xacro:property name="caster_wheel_radius" value="0.040"/>
- <xacro:property name="caster_mass" value="0.750"/>
- <xacro:property name="imu_offset_x" value="0.2085" />
- <xacro:property name="imu_offset_y" value="-0.2902" />
- <xacro:property name="imu_offset_z" value="0.1681" />
- <xacro:property name="dummy_inertia" value="1e-09"/>
- <material name="Black">
- <color rgba="0.0 0.0 0.0 1.0"/>
- </material>
- <link name="base_footprint"/>
- <joint name="base_joint" type="fixed">
- <origin xyz="0 0 0" rpy="0 0 0" />
- <parent link="base_footprint"/>
- <child link="base_link" />
- </joint>
- <link name="base_link">
- </link>
- <xacro:property name="height_level_1" value="0.125" />
- <xacro:property name="pos_level_1" value="${0.150+height_level_1/2}" />
- <xacro:property name="mass_level_1" value="25" />
- <joint name="level_1_fixe" type="fixed">
- <origin xyz="0 0 ${pos_level_1}" rpy="0 0 0" />
- <parent link="base_footprint"/>
- <child link="level_1" />
- </joint>
- <link name="level_1">
- <collision>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_1}"/>
- </geometry>
- </collision>
- <visual>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_1}"/>
- </geometry>
- <material name="grey">
- <color rgba="0.7 0.7 0.7 1"/>
- </material>
- </visual>
- <inertial>
- <mass value="${mass_level_1}"/>
- <inertia ixx="2.3581" ixy="0.0" ixz="0.0" iyy="2.3581" iyz="0.0" izz="4.6512"/>
- </inertial>
- </link>
- <xacro:property name="height_level_2" value="0.243" />
- <xacro:property name="pos_level_2" value="${0.150+height_level_1+height_level_2/2}" />
- <xacro:property name="mass_level_2" value="65" />
- <joint name="level_2_fixe" type="fixed">
- <origin xyz="0 0 ${pos_level_2}" rpy="0 0 0" />
- <parent link="base_footprint"/>
- <child link="level_2" />
- </joint>
- <link name="level_2">
- <collision>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_2}"/>
- </geometry>
- </collision>
- <visual>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_2}"/>
- </geometry>
- <material name="grey">
- <color rgba="0.7 0.7 0.7 1"/>
- </material>
- </visual>
- <inertial>
- <mass value="${mass_level_2}"/>
- <inertia ixx="6.3664" ixy="0.0" ixz="0.0" iyy="6.3664" iyz="0.0" izz="12.09325"/>
- </inertial>
- </link>
- <xacro:property name="height_level_3" value="0.503" />
- <xacro:property name="pos_level_3" value="${0.150+height_level_1+height_level_2+height_level_3/2}" />
- <xacro:property name="mass_level_3" value="45" />
- <joint name="level_3_fixe" type="fixed">
- <origin xyz="0 0 ${pos_level_3}" rpy="0 0 0" />
- <parent link="base_footprint"/>
- <child link="level_3" />
- </joint>
- <link name="level_3">
- <collision>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_3}"/>
- </geometry>
- </collision>
- <visual>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_3}"/>
- </geometry>
- <material name="grey">
- <color rgba="0.7 0.7 0.7 1"/>
- </material>
- </visual>
- <inertial>
- <mass value="${mass_level_3}"/>
- <inertia ixx="5.13490" ixy="0.0" ixz="0.0" iyy="5.134908" iyz="0.0" izz="8.37225"/>
- </inertial>
- </link>
- <xacro:property name="height_level_4" value="0.203" />
- <xacro:property name="pos_level_4" value="${0.150+height_level_1+height_level_2+height_level_3+height_level_4/2}" />
- <xacro:property name="mass_level_4" value="12" />
- <joint name="level_4_fixe" type="fixed">
- <origin xyz="0 0 ${pos_level_4}" rpy="0 0 0" />
- <parent link="base_footprint"/>
- <child link="level_4" />
- </joint>
- <link name="level_4">
- <collision>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_4}"/>
- </geometry>
- </collision>
- <visual>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_4}"/>
- </geometry>
- <material name="grey">
- <color rgba="0.7 0.7 0.7 1"/>
- </material>
- </visual>
- <inertial>
- <mass value="${mass_level_4}"/>
- <inertia ixx="1.1575" ixy="0.0" ixz="0.0" iyy="1.1575" iyz="0.0" izz="2.2326"/>
- </inertial>
- </link>
- <xacro:property name="height_level_5" value="0.203" />
- <xacro:property name="pos_level_5" value="${0.150+height_level_1+height_level_2+height_level_3+height_level_4+height_level_5/2}" />
- <xacro:property name="mass_level_5" value="25" />
- <joint name="level_5_fixe" type="fixed">
- <origin xyz="0 0 ${pos_level_5}" rpy="0 0 0" />
- <parent link="base_footprint"/>
- <child link="level_5" />
- </joint>
- <link name="level_5">
- <collision>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_5}"/>
- </geometry>
- </collision>
- <visual>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_5}"/>
- </geometry>
- <material name="grey">
- <color rgba="0.7 0.7 0.7 1"/>
- </material>
- </visual>
- <inertial>
- <mass value="${mass_level_5}"/>
- <inertia ixx="2.41147" ixy="0.0" ixz="0.0" iyy="2.41147" iyz="0.0" izz="4.65125"/>
- </inertial>
- </link>
- <xacro:property name="height_level_6" value="0.203" />
- <xacro:property name="pos_level_6" value="${0.150+height_level_1+height_level_2+height_level_3+height_level_4+height_level_5+height_level_6/2}" />
- <xacro:property name="mass_level_6" value="25" />
- <joint name="level_6_fixe" type="fixed">
- <origin xyz="0 0 ${pos_level_6}" rpy="0 0 0" />
- <parent link="base_footprint"/>
- <child link="level_6" />
- </joint>
- <link name="level_6">
- <collision>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_6}"/>
- </geometry>
- </collision>
- <visual>
- <geometry>
- <cylinder radius="${size_base}" length="${height_level_6}"/>
- </geometry>
- <material name="grey">
- <color rgba="0.7 0.7 0.7 1"/>
- </material>
- </visual>
- <inertial>
- <mass value="${mass_level_6}"/>
- <inertia ixx="2.41147" ixy="0.0" ixz="0.0" iyy="2.41147" iyz="0.0" izz="4.65125"/>
- </inertial>
- </link>
- <xacro:property name="pos_poteau" value="${0.150+height_level_1+height_level_2+height_level_3+height_level_4+height_level_5+height_level_6+height_pillier/2}" />
- <joint name="poteau_joint" type="fixed">
- <origin xyz="0 0 ${pos_poteau}" rpy="0 0 0" />
- <parent link="base_footprint"/>
- <child link="poteau_link" />
- </joint>
- <link name="poteau_link">
- <inertial>
- <mass value="${mass_pillier}" />
- <inertia ixx="0.035" ixy="0" ixz="0" iyy="0.035" iyz="0" izz="0.07" />
- </inertial>
- <collision>
- <geometry>
- <cylinder radius="${size_pillier}" length="${height_pillier}"/>
- </geometry>
- </collision>
- <visual>
- <geometry>
- <cylinder radius="${size_pillier}" length="${height_pillier}"/>
- </geometry>
- <material name="red">
- <color rgba="1.0 0.1 0.1 1"/>
- </material>
- </visual>
- </link>
- <xacro:property name="radius_caster" value="0.040" />
- <xacro:property name="pos_front_caster_1" value="0.245" />
- <xacro:caster_sans_contact xyz="${pos_front_caster_1} 0.093 ${radius_caster}" name="front_1" />
- <!--Caster front -->
- <xacro:property name="pos_front_caster_2" value="0.245" />
- <xacro:caster_sans_contact xyz="${pos_front_caster_2} -0.093 ${radius_caster}" name="front_2" />
- <!--Caster back -->
- <xacro:property name="pos_back_caster" value="-0.226" />
- <xacro:caster_sans_contact xyz="${pos_back_caster} 0.0 ${radius_caster}" name="back" />
- <link name="imu_link">
- <inertial>
- <mass value="0.001"/>
- <origin xyz="0 0 0" rpy="0 0 0"/>
- <inertia ixx="${dummy_inertia}" ixy="0.0" ixz="0.0" iyy="${dummy_inertia}" iyz="0.0" izz="${dummy_inertia}"/>
- </inertial>
- </link>
- <joint name="imu_joint" type="fixed">
- <parent link="base_link" />
- <child link="imu_link" />
- <origin xyz="${imu_offset_x} ${imu_offset_y} ${imu_offset_z}" rpy="0 0 0"/>
- </joint>
- <gazebo reference="imu_link">
- </gazebo>
- <link name="wheel_axe">
- <inertial>
- <mass value="1.001"/>
- <origin xyz="0 0 0" rpy="0 0 0"/>
- <inertia ixx="0" ixy="0.0" ixz="0.0" iyy="0" iyz="0.0" izz="0"/>
- </inertial>
- <visual>
- <origin rpy="1.57 0 0" xyz="0.0 0.0 0 "/>
- <geometry>
- <cylinder radius="${radius_caster}" length="0.434"/>
- </geometry>
- </visual>
- </link>
- <joint name="axe_joint" type="fixed">
- <parent link="base_link" />
- <child link="wheel_axe" />
- <origin xyz="0 0 ${wheel_radius}" rpy="0 0 0"/>
- </joint>
- <xacro:wheel rpy="1.57 0.0 0.0" xyz="0.0 0.217 0" name="right" />
- <xacro:wheel rpy="1.57 0.0 0.0" xyz="0.0 -0.217 0" name="left" />
- </robot>
Add Comment
Please, Sign In to add comment