diff --git a/CMakeLists.txt b/CMakeLists.txt
index 7cbff70..625ac5f 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -1,4 +1,3 @@
-
 set(sourcedirs
   .
   VectorAlgebra/src
@@ -14,3 +13,38 @@ idf_component_register(
     INCLUDE_DIRS ${includedirs}
     REQUIRES arduino
 )
+
+project(RoboidControl)
+
+set(CMAKE_CXX_STANDARD 11)
+set(CMAKE_POSITION_INDEPENDENT_CODE ON)
+
+add_compile_definitions(GTEST)
+include(FetchContent)
+FetchContent_Declare(
+    googletest
+    URL https://github.com/google/googletest/archive/refs/heads/main.zip
+)
+
+# For Windows: Prevent overriding the parent project's compiler/linker settings
+set(gtest_force_shared_crt ON CACHE BOOL "" FORCE)
+FetchContent_MakeAvailable(googletest)
+    
+add_library(RoboidControl STATIC 
+    "Roboid.cpp"
+)
+
+enable_testing()
+
+add_executable(
+    RoboidControlTest
+    "test/Dummy_test.cc"
+)
+target_link_libraries(
+    RoboidControlTest
+    gtest_main
+    RoboidControl
+)
+
+include(GoogleTest)
+gtest_discover_tests(RoboidControlTest)