diff --git a/CMakeLists.txt b/CMakeLists.txt
index 044a9738e0b6311865d1eb1a0811a4b1821f2391..fce1dd1a52b747db0da08dc5588da5fecb4ee181 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -101,7 +101,7 @@ FIND_PACKAGE(wolf REQUIRED)
 FIND_PACKAGE(YamlCpp REQUIRED)
 
 IF(YAMLCPP_FOUND)
-    MESSAGE("yaml-cpp Library FOUND: yaml-cpp related sources will be built.")
+    MESSAGE("yaml-cpp Library FOUND!")
 ELSEIF(YAMLCPP_FOUND)
     MESSAGE("yaml-cpp Library NOT FOUND!")
 ENDIF(YAMLCPP_FOUND)
@@ -265,26 +265,22 @@ ADD_LIBRARY(${PLUGIN_NAME}
   ${SRCS_WRAPPER}
   ${SRCS_YAML}
   )
-TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${CMAKE_THREAD_LIBS_INIT})
 
 #Link the created libraries
 #===============EXAMPLE=========================
 # IF (Ceres_FOUND)
 #     TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${CERES_LIBRARIES})
 # ENDIF(Ceres_FOUND)
-
-
-#Build tests
-#===============EXAMPLE=========================
+TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${CMAKE_THREAD_LIBS_INIT})
+TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${wolf_LIBRARY})
+TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${YAMLCPP_LIBRARY})
 IF (GLOG_FOUND)
     TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${GLOG_LIBRARY})
 ENDIF (GLOG_FOUND)
-#check if this is done correctly
-IF (OPENCV_FOUND AND Apriltag_FOUND)
-    LINK_LIBRARIES(apriltag m)
-    TARGET_LINK_LIBRARIES(${PLUGIN_NAME} ${APRILTAG_LIBRARY}  ${CMAKE_THREAD_LIBS_INIT} ${OPENCV_LDFLAGS} m)
-ENDIF(OPENCV_FOUND AND Apriltag_FOUND)
 
+
+#Build tests
+#===============EXAMPLE=========================
 IF (GLOG_FOUND)
     IF(BUILD_TESTS)
         MESSAGE("Building tests.")