diff --git a/CMakeLists.txt b/CMakeLists.txt
index e2e1a9fb7cc54d33787f117f1fb5825b4d0543e0..db75b43b88ef363e7e072c810bfa0d2832f57a5a 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -178,7 +178,9 @@ ENDIF(BUILD_PYTHON_INTERFACE)
 
 # Stand alone embedded intepreter with a robot controller.
 add_executable(geometric_simu src/geometric_simu.cpp src/sot_loader.cpp src/sot_loader_basic.cpp)
-pkg_config_use_dependency(geometric_simu roscpp tf)
+pkg_config_use_dependency(geometric_simu tf)
+pkg_config_use_dependency(geometric_simu roscpp)
+pkg_config_use_dependency(geometric_simu dynamic-graph)
 target_link_libraries(geometric_simu  ros_bridge tf ${Boost_LIBRARIES} ${CMAKE_DL_LIBS})
 
 # Sot loader library
diff --git a/src/sot_loader_basic.cpp b/src/sot_loader_basic.cpp
index e30b940e4477357c2abd25f648f9b59f8db59ee4..d2dd6f8be9b2bc5d1d1e40ea9b4d0d15b426bb88 100644
--- a/src/sot_loader_basic.cpp
+++ b/src/sot_loader_basic.cpp
@@ -23,6 +23,8 @@
 #include <dynamic_graph_bridge/sot_loader.hh>
 #include "dynamic_graph_bridge/ros_init.hh"
 
+#include <dynamic-graph/pool.h>
+
 // POSIX.1-2001
 #include <dlfcn.h>
 
@@ -211,6 +213,8 @@ void SotLoaderBasic::Initialization()
 
 void SotLoaderBasic::CleanUp()
 {
+  dynamicgraph::PoolStorage::destroy();
+
   /// Uncount the number of access to this library.
   dlclose(sotRobotControllerLibrary_);
 }