diff --git a/robots/tiago_description/robots/tiago.urdf b/robots/tiago_description/robots/tiago.urdf
index 9a8ea780c1214963b08e4c34d3bba9068f8764ff..f05f48c9e80132284a4b5d200bb9a94439699fd4 100644
--- a/robots/tiago_description/robots/tiago.urdf
+++ b/robots/tiago_description/robots/tiago.urdf
@@ -132,7 +132,13 @@
     <material>Gazebo/White</material>
   </gazebo>
   <!-- Base footprint -->
-  <link name="base_footprint"/>
+  <link name="base_footprint">
+    <inertial>
+      <mass value="0.0"/>
+      <origin xyz="0.0 0.0 0.0"/>
+      <inertia ixx="0.0" ixy="0.0" ixz="0.0" iyy="0.0" iyz="0.0" izz="0.0"/>
+    </inertial>
+  </link>
   <joint name="base_footprint_joint" type="fixed">
     <origin rpy="0 0 0" xyz="0 0 0.0985"/>
     <child link="base_link"/>
@@ -2959,7 +2965,13 @@
       <mechanicalReduction>0.0739176962651</mechanicalReduction>
     </actuator>
   </transmission>
-  <link name="hand_grasping_frame"/>
+  <link name="hand_grasping_frame">
+    <inertial>
+      <mass value="0.0"/>
+      <origin xyz="0 0 0"/>
+      <inertia ixx="0.0" ixy="0.0" ixz="0.0" iyy="0.0" iyz="0" izz="0.0"/>
+    </inertial>
+  </link>
   <joint name="hand_grasping_fixed_joint" type="fixed">
     <parent link="hand_palm_link"/>
     <child link="hand_grasping_frame"/>
diff --git a/robots/tiago_description/robots/tiago_no_hand.urdf b/robots/tiago_description/robots/tiago_no_hand.urdf
index d088c5d3e7a3c9534afc3320f3b4b945d866e5ee..94f9ad0842208d45db4c7225f76995bccc58d9e2 100644
--- a/robots/tiago_description/robots/tiago_no_hand.urdf
+++ b/robots/tiago_description/robots/tiago_no_hand.urdf
@@ -132,7 +132,14 @@
     <material>Gazebo/White</material>
   </gazebo>
   <!-- Base footprint -->
-  <link name="base_footprint"/>
+  <link name="base_footprint">
+    <inertial>
+      <mass value="0.0"/>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <inertia ixx="0.0" ixy="0.0" ixz="0.0" iyy="0.0" iyz="0.0" izz="0.0"/>
+    </inertial>        
+  </link>
+    
   <joint name="base_footprint_joint" type="fixed">
     <origin rpy="0 0 0" xyz="0 0 0.0985"/>
     <child link="base_link"/>