diff --git a/CMakeLists.txt b/CMakeLists.txt
index 23d263dd9c50b510beb8d2c395ca9421c69e91fb..cdda9cb7c942c49a470ae0b1c5c8d484572d8343 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -28,11 +28,12 @@ link_directories(${csm_LIBRARY_DIRS})
 message(csm_LIBRARY_DIRS: ${csm_LIBRARY_DIRS})
 # keep only the files in a lib folder: by default the "." is in csm_LIBRARY_DIRS, 
 # which is not acceptable for target_link_directories 
-SET(csm_LIBRARY_DIRS_LENGTH "0")
-list(LENGTH csm_LIBRARY_DIRS csm_LIBRARY_DIRS_LENGTH )
-message("$csm_LIBRARY_DIRS_LENGTH")
-list(FILTER csm_LIBRARY_DIRS EXCLUDE REGEX ".")
+string(REPLACE "./" "/" csm_LIBRARY_DIRS ${csm_LIBRARY_DIRS})
+# SET(csm_LIBRARY_DIRS_LENGTH "0")
+# list(LENGTH csm_LIBRARY_DIRS csm_LIBRARY_DIRS_LENGTH )
 message(csm_LIBRARY_DIRS: ${csm_LIBRARY_DIRS})
+# list(FILTER csm_LIBRARY_DIRS EXCLUDE REGEX ".")
+# message(csm_LIBRARY_DIRS: ${csm_LIBRARY_DIRS})
 
 
 #Build tests
@@ -191,8 +192,12 @@ install(
 
 # Specifies include directories to use when compiling the plugin target
 # This way, include_directories does not need to be called in plugins depending on this one
-target_include_directories(${PROJECT_NAME} INTERFACE
-  $<INSTALL_INTERFACE:${INCLUDE_INSTALL_DIR}>
+# target_include_directories(${PROJECT_NAME} INTERFACE
+#   $<INSTALL_INTERFACE:${INCLUDE_INSTALL_DIR}>
+# )
+target_include_directories(${PROJECT_NAME} PUBLIC  
+    $<BUILD_INTERFACE:${CMAKE_CURRENT_SOURCE_DIR}/include/laser_scan_utils>  
+    $<INSTALL_INTERFACE:${INCLUDE_INSTALL_DIR}>
 )
 
 #Build tests