diff --git a/demos/CMakeLists.txt b/demos/CMakeLists.txt
index c2246724e290642294b8f71d12075c24e4a345a3..b70da57a8c667882b3028b1f48a1e3f2a610415d 100644
--- a/demos/CMakeLists.txt
+++ b/demos/CMakeLists.txt
@@ -1,26 +1,17 @@
 INCLUDE_DIRECTORIES(
     ${CMAKE_CURRENT_SOURCE_DIR}
-    ${catkin_INCLUDE_DIRS}
 )
 
 FIND_PACKAGE(catkin REQUIRED COMPONENTS
   rosbag
-  rosconsole
   roscpp
-  roslib
-  sensor_msgs
-  std_msgs
-  geometry_msgs
-  tf
-  wolf_ros_node
   wolf_ros_objectslam
 )
-FIND_PACKAGE(wolfimu REQUIRED)
+FIND_PACKAGE(wolfimu REQUIRED CONFIG)
 
 INCLUDE_DIRECTORIES(
-    ${rosbag_INCLUDE_DIRS}
+    ${catkin_INCLUDE_DIRS}
     ${wolf_ros_objectslam_INCLUDE_DIRS}
-    ${std_msgs_INCLUDE_DIRS}
 )
 
 ADD_EXECUTABLE(demo_toy_pbe demo_toy_pbe.cpp)