diff --git a/.vscode/c_cpp_properties.json b/.vscode/c_cpp_properties.json
new file mode 100644
index 0000000..40d76a6
--- /dev/null
+++ b/.vscode/c_cpp_properties.json
@@ -0,0 +1,24 @@
+{
+  "configurations": [
+    {
+      "browse": {
+        "databaseFilename": "${default}",
+        "limitSymbolsToIncludedHeaders": false
+      },
+      "includePath": [
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/odrive_hardware_interface/include/**",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/lslidar_msgs/include/**",
+        "/opt/ros/humble/include/**",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/src/Lslidar_ROS2_driver/lslidar_driver/include/**",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/src/odrive_ros2_control/odrive_hardware_interface/include/**",
+        "/usr/include/**"
+      ],
+      "name": "ROS",
+      "intelliSenseMode": "gcc-x64",
+      "compilerPath": "/usr/bin/gcc",
+      "cStandard": "gnu11",
+      "cppStandard": "c++14"
+    }
+  ],
+  "version": 4
+}
\ No newline at end of file
diff --git a/.vscode/settings.json b/.vscode/settings.json
new file mode 100644
index 0000000..30452d3
--- /dev/null
+++ b/.vscode/settings.json
@@ -0,0 +1,20 @@
+{
+    "python.autoComplete.extraPaths": [
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/bot_mini_bringup/lib/python3.10/site-packages",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/rmp220_teleop/lib/python3.10/site-packages",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/lslidar_msgs/local/lib/python3.10/dist-packages",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/cam_opencv/lib/python3.10/site-packages",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/bot_mini_description/lib/python3.10/site-packages",
+        "/opt/ros/humble/lib/python3.10/site-packages",
+        "/opt/ros/humble/local/lib/python3.10/dist-packages"
+    ],
+    "python.analysis.extraPaths": [
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/bot_mini_bringup/lib/python3.10/site-packages",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/rmp220_teleop/lib/python3.10/site-packages",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/lslidar_msgs/local/lib/python3.10/dist-packages",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/cam_opencv/lib/python3.10/site-packages",
+        "/home/bjorn/Documents/ros_projects/cps_bot_mini_ws/install/bot_mini_description/lib/python3.10/site-packages",
+        "/opt/ros/humble/lib/python3.10/site-packages",
+        "/opt/ros/humble/local/lib/python3.10/dist-packages"
+    ]
+}
\ No newline at end of file
diff --git a/mesh/base_link_collision.stl b/mesh/base_link_collision.stl
new file mode 100644
index 0000000..7fe25f2
Binary files /dev/null and b/mesh/base_link_collision.stl differ
diff --git a/mesh/base_link_visual.stl b/mesh/base_link_visual.stl
new file mode 100644
index 0000000..fb69943
Binary files /dev/null and b/mesh/base_link_visual.stl differ
diff --git a/mesh/camera_link_collision.stl b/mesh/camera_link_collision.stl
new file mode 100644
index 0000000..038fb66
Binary files /dev/null and b/mesh/camera_link_collision.stl differ
diff --git a/mesh/camera_link_visual.stl b/mesh/camera_link_visual.stl
new file mode 100644
index 0000000..7336399
Binary files /dev/null and b/mesh/camera_link_visual.stl differ
diff --git a/mesh/caster_link_collision.stl b/mesh/caster_link_collision.stl
new file mode 100644
index 0000000..9fb9745
Binary files /dev/null and b/mesh/caster_link_collision.stl differ
diff --git a/mesh/caster_link_visual.stl b/mesh/caster_link_visual.stl
new file mode 100644
index 0000000..a4658cb
Binary files /dev/null and b/mesh/caster_link_visual.stl differ
diff --git a/mesh/camera_frame.stl b/mesh/hikvision_ds-u02.stl
similarity index 97%
rename from mesh/camera_frame.stl
rename to mesh/hikvision_ds-u02.stl
index 83ba455..65cc2bf 100644
Binary files a/mesh/camera_frame.stl and b/mesh/hikvision_ds-u02.stl differ
diff --git a/mesh/laser_link_collision.stl b/mesh/laser_link_collision.stl
new file mode 100644
index 0000000..5138c7b
Binary files /dev/null and b/mesh/laser_link_collision.stl differ
diff --git a/mesh/laser_link_visual.stl b/mesh/laser_link_visual.stl
new file mode 100644
index 0000000..5d7352b
Binary files /dev/null and b/mesh/laser_link_visual.stl differ
diff --git a/mesh/wheel_frame.stl b/mesh/wheel_frame.stl
deleted file mode 100644
index 4403563..0000000
Binary files a/mesh/wheel_frame.stl and /dev/null differ
diff --git a/mesh/wheel_link_2_collision.stl b/mesh/wheel_link_2_collision.stl
new file mode 100644
index 0000000..0b3820d
Binary files /dev/null and b/mesh/wheel_link_2_collision.stl differ
diff --git a/mesh/wheel_link_2_visual.stl b/mesh/wheel_link_2_visual.stl
new file mode 100644
index 0000000..1862c22
Binary files /dev/null and b/mesh/wheel_link_2_visual.stl differ
diff --git a/mesh/wheel_link_collision.stl b/mesh/wheel_link_collision.stl
new file mode 100644
index 0000000..e0d3cb6
Binary files /dev/null and b/mesh/wheel_link_collision.stl differ
diff --git a/mesh/wheel_link_visual.stl b/mesh/wheel_link_visual.stl
new file mode 100644
index 0000000..abc5116
Binary files /dev/null and b/mesh/wheel_link_visual.stl differ