diff --git a/description/robot_core.xacro b/description/robot_core.xacro
index bb661f2..1a554b8 100644
--- a/description/robot_core.xacro
+++ b/description/robot_core.xacro
@@ -78,7 +78,7 @@
     <joint name="chassis_joint" type="fixed">
         <parent link="base_link"/>
         <child link="chassis"/>
-        <origin xyz="${-chassis_length/2 + 0.075} 0 ${wheel_offset_z}"/>
+        <origin xyz="${-chassis_length/2 + 0.075} 0 ${wheel_offset_z + chassis_height}"/>
     </joint>
 
     <link name="chassis">