diff --git a/CMakeLists.txt b/CMakeLists.txt
index 7baa17a2573071d910505834d0a567a417b63aaa..efcd9117acc357ac352e73ef6a1177d08d1d2f3e 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -262,6 +262,7 @@ ADD_LIBRARY(${PLUGIN_NAME}
   ${SRCS_YAML}
   )
 TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${CMAKE_THREAD_LIBS_INIT})
+TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${YAMLCPP_LIBRARY})
 
 TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${laser_scan_utils_LIBRARY})
 #Link the created libraries