77 lines
3.1 KiB
XML
77 lines
3.1 KiB
XML
<?xml version="1.0"?>
|
|
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" >
|
|
|
|
<!-- Specify some standard inertial calculations https://en.wikipedia.org/wiki/List_of_moments_of_inertia -->
|
|
<!-- These make use of xacro's mathematical functionality -->
|
|
|
|
<xacro:macro name="inertial_sphere" params="mass radius *origin">
|
|
<inertial>
|
|
<xacro:insert_block name="origin"/>
|
|
<mass value="${mass}" />
|
|
<inertia ixx="${(2/5) * mass * (radius*radius)}" ixy="0.0" ixz="0.0"
|
|
iyy="${(2/5) * mass * (radius*radius)}" iyz="0.0"
|
|
izz="${(2/5) * mass * (radius*radius)}" />
|
|
</inertial>
|
|
</xacro:macro>
|
|
|
|
|
|
<xacro:macro name="inertial_box" params="mass x y z *origin">
|
|
<inertial>
|
|
<xacro:insert_block name="origin"/>
|
|
<mass value="${mass}" />
|
|
<inertia ixx="${(1/12) * mass * (y*y+z*z)}" ixy="0.0" ixz="0.0"
|
|
iyy="${(1/12) * mass * (x*x+z*z)}" iyz="0.0"
|
|
izz="${(1/12) * mass * (x*x+y*y)}" />
|
|
</inertial>
|
|
</xacro:macro>
|
|
|
|
|
|
<xacro:macro name="inertial_cylinder" params="mass length radius *origin">
|
|
<inertial>
|
|
<xacro:insert_block name="origin"/>
|
|
<mass value="${mass}" />
|
|
<inertia ixx="${(1/12) * mass * (3*radius*radius + length*length)}" ixy="0.0" ixz="0.0"
|
|
iyy="${(1/12) * mass * (3*radius*radius + length*length)}" iyz="0.0"
|
|
izz="${(1/2) * mass * (radius*radius)}" />
|
|
</inertial>
|
|
</xacro:macro>
|
|
|
|
<!-- Math constants -->
|
|
<xacro:property name="math_pi" value="3.141592653589793" />
|
|
<xacro:property name="math_pi_over_2" value="1.5707963267948966" />
|
|
<xacro:property name="math_pi_over_4" value="0.785398163397448" />
|
|
|
|
<!-- Inertial for solid cuboid with dimensions x y z -->
|
|
<xacro:macro name="solid_cuboid_inertial" params="rpy xyz mass x y z">
|
|
<inertial>
|
|
<origin rpy="${rpy}" xyz="${xyz}"/>
|
|
<mass value="${mass}" />
|
|
<inertia
|
|
ixx="${mass * (y * y + z * z) / 12.0}" ixy="0.0" ixz="0.0"
|
|
iyy="${mass * (x * x + z * z) / 12.0}" iyz="0.0"
|
|
izz="${mass * (x * x + y * y) / 12.0}" />
|
|
</inertial>
|
|
</xacro:macro>
|
|
|
|
<!-- Inertial for solid cylinder with radius and length aligned to z-axis -->
|
|
<xacro:macro name="solid_cylinder_inertial" params="rpy xyz mass radius length">
|
|
<inertial>
|
|
<origin rpy="${rpy}" xyz="${xyz}"/>
|
|
<mass value="${mass}" />
|
|
<inertia
|
|
ixx="${mass * (3.0 * radius * radius + length * length) / 12.0}" ixy="0.0" ixz="0.0"
|
|
iyy="${mass * (3.0 * radius * radius + length * length) / 12.0}" iyz="0.0"
|
|
izz="${mass * (radius * radius) / 2.0}" />
|
|
</inertial>
|
|
</xacro:macro>
|
|
|
|
<!-- A null inertial - used in placeholder links to esure the model will work in Gazebo -->
|
|
<xacro:macro name="null_inertial">
|
|
<inertial>
|
|
<mass value="0.001"/>
|
|
<inertia ixx="0.001" ixy="0" ixz="0" iyy="0.001" iyz="0" izz="0.001"/>
|
|
</inertial>
|
|
</xacro:macro>
|
|
|
|
|
|
</robot> |