diff --git a/CMakeLists.txt b/CMakeLists.txt
index b659c65..a4a3964 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -161,6 +161,14 @@ install(DIRECTORY config/
   DESTINATION share/${PROJECT_NAME}/config
   PATTERN ".git" EXCLUDE)
 
+# Install URDF and meshes
+install(DIRECTORY urdf/
+  DESTINATION share/${PROJECT_NAME}/urdf
+)
+
+install(DIRECTORY meshes/
+  DESTINATION share/${PROJECT_NAME}/meshes
+)
 
 ###################################
 ## ament specific configuration  ##
diff --git a/meshes/ellipse.stl b/meshes/ellipse.stl
new file mode 100644
index 0000000..27b6b34
Binary files /dev/null and b/meshes/ellipse.stl differ
diff --git a/package.xml b/package.xml
index 704991f..d36643a 100644
--- a/package.xml
+++ b/package.xml
@@ -26,6 +26,10 @@
   <depend>tf2_geometry_msgs</depend>
   <depend>nmea_msgs</depend>
 
+  <build_depend>urdf</build_depend>
+
+  <exec_depend>urdf</exec_depend>
+  <exec_depend>xacro</exec_depend>
   <exec_depend>rosidl_default_runtime</exec_depend>
 
   <member_of_group>rosidl_interface_packages</member_of_group>
diff --git a/urdf/ellipse.urdf b/urdf/ellipse.urdf
new file mode 100644
index 0000000..6622fca
--- /dev/null
+++ b/urdf/ellipse.urdf
@@ -0,0 +1,10 @@
+<robot name="ellipse">
+  <link name="odom">
+    <visual>
+      <origin xyz="0 0 0" rpy="1.5708 0 -1.5708"/> <!-- Add rotation to align the 3D model with odometry -->
+      <geometry>
+        <mesh filename="package://sbg_driver/meshes/ellipse.stl" scale="0.1 0.1 0.1"/>
+      </geometry>
+    </visual>
+  </link>
+</robot>
\ No newline at end of file