diff --git a/clik/.cache/clangd/index/clik.cpp.F1A65FD4C293F4CF.idx b/clik/.cache/clangd/index/clik.cpp.F1A65FD4C293F4CF.idx
index ab8ca3460b0b92a330e1a9e5dcae4d510b954bb0..73d3d3fa03db6f7f065ccacb9963572a00102dcb 100644
Binary files a/clik/.cache/clangd/index/clik.cpp.F1A65FD4C293F4CF.idx and b/clik/.cache/clangd/index/clik.cpp.F1A65FD4C293F4CF.idx differ
diff --git a/clik/build/CMakeCache.txt b/clik/build/CMakeCache.txt
index bc5843c7d0e0770471a11cf0ddc45c73b91ed7b8..5883d0d0dfbd9fee87273d9846fd65890eb90ad5 100644
--- a/clik/build/CMakeCache.txt
+++ b/clik/build/CMakeCache.txt
@@ -1,5 +1,5 @@
 # This is the CMakeCache file.
-# For build in directory: /home/gospodar/lund/praxis/ur_simple_control/clik/build
+# For build in directory: /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build
 # It was generated by CMake: /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake
 # You can edit this file to change values found and used by cmake.
 # If you do not want to change any of the values, simply exit the editor.
@@ -138,7 +138,7 @@ CMAKE_EXE_LINKER_FLAGS_RELWITHDEBINFO:STRING=
 CMAKE_EXPORT_COMPILE_COMMANDS:BOOL=
 
 //Value Computed by CMake.
-CMAKE_FIND_PACKAGE_REDIRECTS_DIR:STATIC=/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/pkgRedirects
+CMAKE_FIND_PACKAGE_REDIRECTS_DIR:STATIC=/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/pkgRedirects
 
 //Install path prefix, prepended onto install directories.
 CMAKE_INSTALL_PREFIX:PATH=/usr/local
@@ -274,13 +274,13 @@ boost_system_DIR:PATH=/usr/lib/x86_64-linux-gnu/cmake/boost_system-1.74.0
 boost_thread_DIR:PATH=/usr/lib/x86_64-linux-gnu/cmake/boost_thread-1.74.0
 
 //Value Computed by CMake
-clik_BINARY_DIR:STATIC=/home/gospodar/lund/praxis/ur_simple_control/clik/build
+clik_BINARY_DIR:STATIC=/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build
 
 //Value Computed by CMake
 clik_IS_TOP_LEVEL:STATIC=ON
 
 //Value Computed by CMake
-clik_SOURCE_DIR:STATIC=/home/gospodar/lund/praxis/ur_simple_control/clik
+clik_SOURCE_DIR:STATIC=/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik
 
 //The directory containing a CMake configuration file for console_bridge.
 console_bridge_DIR:PATH=/usr/lib/x86_64-linux-gnu/console_bridge/cmake
@@ -343,7 +343,7 @@ CMAKE_ADDR2LINE-ADVANCED:INTERNAL=1
 //ADVANCED property for variable: CMAKE_AR
 CMAKE_AR-ADVANCED:INTERNAL=1
 //This is the directory where this CMakeCache.txt was created
-CMAKE_CACHEFILE_DIR:INTERNAL=/home/gospodar/lund/praxis/ur_simple_control/clik/build
+CMAKE_CACHEFILE_DIR:INTERNAL=/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build
 //Major version of cmake used to create the current loaded cache
 CMAKE_CACHE_MAJOR_VERSION:INTERNAL=3
 //Minor version of cmake used to create the current loaded cache
diff --git a/clik/build/CMakeFiles/CMakeConfigureLog.yaml b/clik/build/CMakeFiles/CMakeConfigureLog.yaml
index bc63fb5d013f6cb267f069e418cefcfbd5e5f7fd..a67f15f79fbb3fe557ac0791050699c165cf9bf4 100644
--- a/clik/build/CMakeFiles/CMakeConfigureLog.yaml
+++ b/clik/build/CMakeFiles/CMakeConfigureLog.yaml
@@ -1545,3 +1545,215 @@ events:
         201402
       exitCode: 0
 ...
+
+---
+events:
+  -
+    kind: "try_run-v1"
+    backtrace:
+      - "/opt/openrobots/lib/cmake/hpp-fcl/cxx-standard.cmake:49 (try_run)"
+      - "/opt/openrobots/lib/cmake/hpp-fcl/hpp-fclConfig.cmake:186 (CHECK_MINIMAL_CXX_STANDARD)"
+      - "/home/gospodar/.local/lib/python3.10/site-packages/cmake/data/share/cmake-3.27/Modules/CMakeFindDependencyMacro.cmake:76 (find_package)"
+      - "/opt/openrobots/lib/cmake/pinocchio/pinocchioConfig.cmake:159 (find_dependency)"
+      - "CMakeLists.txt:47 (find_package)"
+    directories:
+      source: "/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+      binary: "/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+    cmakeVariables:
+      CMAKE_CXX_FLAGS: "     -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn"
+      CMAKE_CXX_FLAGS_DEBUG: "-g"
+      CMAKE_EXE_LINKER_FLAGS: ""
+    buildResult:
+      variable: "_cxx_standard_build_status"
+      cached: true
+      stdout: |
+        Change Dir: '/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+        Run Build Command(s): /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E env VERBOSE=1 /usr/bin/gmake -f Makefile cmTC_436f6/fast
+        gmake[1]: Entering directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        /usr/bin/gmake  -f CMakeFiles/cmTC_436f6.dir/build.make CMakeFiles/cmTC_436f6.dir/build
+        gmake[2]: Entering directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        Building CXX object CMakeFiles/cmTC_436f6.dir/tmp-cxx-standard.cpp.o
+        /usr/bin/c++   -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  -std=gnu++14 -o CMakeFiles/cmTC_436f6.dir/tmp-cxx-standard.cpp.o -c /home/gospodar/lund/praxis/ur_simple_control/clik/build/cmake/tmp-cxx-standard.cpp
+        Linking CXX executable cmTC_436f6
+        /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E cmake_link_script CMakeFiles/cmTC_436f6.dir/link.txt --verbose=1
+        /usr/bin/c++      -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  "CMakeFiles/cmTC_436f6.dir/tmp-cxx-standard.cpp.o" -o cmTC_436f6 
+        gmake[2]: Leaving directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        gmake[1]: Leaving directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+      exitCode: 0
+    runResult:
+      variable: "_cxx_standard_run_status"
+      cached: true
+      stdout: |
+        201402
+      exitCode: 0
+...
+
+---
+events:
+  -
+    kind: "try_run-v1"
+    backtrace:
+      - "/opt/openrobots/lib/cmake/hpp-fcl/cxx-standard.cmake:49 (try_run)"
+      - "/opt/openrobots/lib/cmake/hpp-fcl/hpp-fclConfig.cmake:186 (CHECK_MINIMAL_CXX_STANDARD)"
+      - "/home/gospodar/.local/lib/python3.10/site-packages/cmake/data/share/cmake-3.27/Modules/CMakeFindDependencyMacro.cmake:76 (find_package)"
+      - "/opt/openrobots/lib/cmake/pinocchio/pinocchioConfig.cmake:159 (find_dependency)"
+      - "CMakeLists.txt:47 (find_package)"
+    directories:
+      source: "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+      binary: "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+    cmakeVariables:
+      CMAKE_CXX_FLAGS: "     -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn"
+      CMAKE_CXX_FLAGS_DEBUG: "-g"
+      CMAKE_EXE_LINKER_FLAGS: ""
+    buildResult:
+      variable: "_cxx_standard_build_status"
+      cached: true
+      stdout: |
+        Change Dir: '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+        Run Build Command(s): /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E env VERBOSE=1 /usr/bin/gmake -f Makefile cmTC_9459e/fast
+        /usr/bin/gmake  -f CMakeFiles/cmTC_9459e.dir/build.make CMakeFiles/cmTC_9459e.dir/build
+        gmake[1]: Entering directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        Building CXX object CMakeFiles/cmTC_9459e.dir/tmp-cxx-standard.cpp.o
+        /usr/bin/c++   -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  -std=gnu++11 -o CMakeFiles/cmTC_9459e.dir/tmp-cxx-standard.cpp.o -c /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/cmake/tmp-cxx-standard.cpp
+        Linking CXX executable cmTC_9459e
+        /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E cmake_link_script CMakeFiles/cmTC_9459e.dir/link.txt --verbose=1
+        /usr/bin/c++      -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  "CMakeFiles/cmTC_9459e.dir/tmp-cxx-standard.cpp.o" -o cmTC_9459e 
+        gmake[1]: Leaving directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+      exitCode: 0
+    runResult:
+      variable: "_cxx_standard_run_status"
+      cached: true
+      stdout: |
+        201103
+      exitCode: 0
+...
+
+---
+events:
+  -
+    kind: "try_run-v1"
+    backtrace:
+      - "/opt/openrobots/lib/cmake/hpp-fcl/cxx-standard.cmake:49 (try_run)"
+      - "/opt/openrobots/lib/cmake/hpp-fcl/hpp-fclConfig.cmake:186 (CHECK_MINIMAL_CXX_STANDARD)"
+      - "/home/gospodar/.local/lib/python3.10/site-packages/cmake/data/share/cmake-3.27/Modules/CMakeFindDependencyMacro.cmake:76 (find_package)"
+      - "/opt/openrobots/lib/cmake/pinocchio/pinocchioConfig.cmake:159 (find_dependency)"
+      - "CMakeLists.txt:47 (find_package)"
+    directories:
+      source: "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+      binary: "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+    cmakeVariables:
+      CMAKE_CXX_FLAGS: "     -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn"
+      CMAKE_CXX_FLAGS_DEBUG: "-g"
+      CMAKE_EXE_LINKER_FLAGS: ""
+    buildResult:
+      variable: "_cxx_standard_build_status"
+      cached: true
+      stdout: |
+        Change Dir: '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+        Run Build Command(s): /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E env VERBOSE=1 /usr/bin/gmake -f Makefile cmTC_bfc89/fast
+        /usr/bin/gmake  -f CMakeFiles/cmTC_bfc89.dir/build.make CMakeFiles/cmTC_bfc89.dir/build
+        gmake[1]: Entering directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        Building CXX object CMakeFiles/cmTC_bfc89.dir/tmp-cxx-standard.cpp.o
+        /usr/bin/c++   -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  -std=gnu++14 -o CMakeFiles/cmTC_bfc89.dir/tmp-cxx-standard.cpp.o -c /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/cmake/tmp-cxx-standard.cpp
+        Linking CXX executable cmTC_bfc89
+        /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E cmake_link_script CMakeFiles/cmTC_bfc89.dir/link.txt --verbose=1
+        /usr/bin/c++      -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  "CMakeFiles/cmTC_bfc89.dir/tmp-cxx-standard.cpp.o" -o cmTC_bfc89 
+        gmake[1]: Leaving directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+      exitCode: 0
+    runResult:
+      variable: "_cxx_standard_run_status"
+      cached: true
+      stdout: |
+        201402
+      exitCode: 0
+...
+
+---
+events:
+  -
+    kind: "try_run-v1"
+    backtrace:
+      - "/opt/openrobots/lib/cmake/hpp-fcl/cxx-standard.cmake:49 (try_run)"
+      - "/opt/openrobots/lib/cmake/hpp-fcl/hpp-fclConfig.cmake:186 (CHECK_MINIMAL_CXX_STANDARD)"
+      - "/home/gospodar/.local/lib/python3.10/site-packages/cmake/data/share/cmake-3.27/Modules/CMakeFindDependencyMacro.cmake:76 (find_package)"
+      - "/opt/openrobots/lib/cmake/pinocchio/pinocchioConfig.cmake:159 (find_dependency)"
+      - "CMakeLists.txt:48 (find_package)"
+    directories:
+      source: "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+      binary: "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+    cmakeVariables:
+      CMAKE_CXX_FLAGS: "     -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2 \t-g     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn"
+      CMAKE_CXX_FLAGS_DEBUG: "-g"
+      CMAKE_EXE_LINKER_FLAGS: ""
+    buildResult:
+      variable: "_cxx_standard_build_status"
+      cached: true
+      stdout: |
+        Change Dir: '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+        Run Build Command(s): /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E env VERBOSE=1 /usr/bin/gmake -f Makefile cmTC_21b6d/fast
+        /usr/bin/gmake  -f CMakeFiles/cmTC_21b6d.dir/build.make CMakeFiles/cmTC_21b6d.dir/build
+        gmake[1]: Entering directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        Building CXX object CMakeFiles/cmTC_21b6d.dir/tmp-cxx-standard.cpp.o
+        /usr/bin/c++   -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2 	-g     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  -std=gnu++14 -o CMakeFiles/cmTC_21b6d.dir/tmp-cxx-standard.cpp.o -c /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/cmake/tmp-cxx-standard.cpp
+        Linking CXX executable cmTC_21b6d
+        /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E cmake_link_script CMakeFiles/cmTC_21b6d.dir/link.txt --verbose=1
+        /usr/bin/c++      -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2 	-g     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  "CMakeFiles/cmTC_21b6d.dir/tmp-cxx-standard.cpp.o" -o cmTC_21b6d 
+        gmake[1]: Leaving directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+      exitCode: 0
+    runResult:
+      variable: "_cxx_standard_run_status"
+      cached: true
+      stdout: |
+        201402
+      exitCode: 0
+...
+
+---
+events:
+  -
+    kind: "try_run-v1"
+    backtrace:
+      - "/opt/openrobots/lib/cmake/hpp-fcl/cxx-standard.cmake:49 (try_run)"
+      - "/opt/openrobots/lib/cmake/hpp-fcl/hpp-fclConfig.cmake:186 (CHECK_MINIMAL_CXX_STANDARD)"
+      - "/home/gospodar/.local/lib/python3.10/site-packages/cmake/data/share/cmake-3.27/Modules/CMakeFindDependencyMacro.cmake:76 (find_package)"
+      - "/opt/openrobots/lib/cmake/pinocchio/pinocchioConfig.cmake:159 (find_dependency)"
+      - "CMakeLists.txt:47 (find_package)"
+    directories:
+      source: "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+      binary: "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp"
+    cmakeVariables:
+      CMAKE_CXX_FLAGS: "     -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn"
+      CMAKE_CXX_FLAGS_DEBUG: "-g"
+      CMAKE_EXE_LINKER_FLAGS: ""
+    buildResult:
+      variable: "_cxx_standard_build_status"
+      cached: true
+      stdout: |
+        Change Dir: '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+        Run Build Command(s): /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E env VERBOSE=1 /usr/bin/gmake -f Makefile cmTC_eacfa/fast
+        /usr/bin/gmake  -f CMakeFiles/cmTC_eacfa.dir/build.make CMakeFiles/cmTC_eacfa.dir/build
+        gmake[1]: Entering directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        Building CXX object CMakeFiles/cmTC_eacfa.dir/tmp-cxx-standard.cpp.o
+        /usr/bin/c++   -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  -std=gnu++14 -o CMakeFiles/cmTC_eacfa.dir/tmp-cxx-standard.cpp.o -c /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/cmake/tmp-cxx-standard.cpp
+        Linking CXX executable cmTC_eacfa
+        /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E cmake_link_script CMakeFiles/cmTC_eacfa.dir/link.txt --verbose=1
+        /usr/bin/c++      -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn  "CMakeFiles/cmTC_eacfa.dir/tmp-cxx-standard.cpp.o" -o cmTC_eacfa 
+        gmake[1]: Leaving directory '/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/CMakeTmp'
+        
+      exitCode: 0
+    runResult:
+      variable: "_cxx_standard_run_status"
+      cached: true
+      stdout: |
+        201402
+      exitCode: 0
+...
diff --git a/clik/build/CMakeFiles/CMakeDirectoryInformation.cmake b/clik/build/CMakeFiles/CMakeDirectoryInformation.cmake
index 51fea85c288b0c54521356ac87b541c623e5b5cc..c39b3d50a264d67de9124caad8ee0ba8a4c96f09 100644
--- a/clik/build/CMakeFiles/CMakeDirectoryInformation.cmake
+++ b/clik/build/CMakeFiles/CMakeDirectoryInformation.cmake
@@ -2,8 +2,8 @@
 # Generated by "Unix Makefiles" Generator, CMake Version 3.27
 
 # Relative path conversion top directories.
-set(CMAKE_RELATIVE_PATH_TOP_SOURCE "/home/gospodar/lund/praxis/ur_simple_control/clik")
-set(CMAKE_RELATIVE_PATH_TOP_BINARY "/home/gospodar/lund/praxis/ur_simple_control/clik/build")
+set(CMAKE_RELATIVE_PATH_TOP_SOURCE "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik")
+set(CMAKE_RELATIVE_PATH_TOP_BINARY "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build")
 
 # Force unix paths in dependencies.
 set(CMAKE_FORCE_UNIX_PATHS 1)
diff --git a/clik/build/CMakeFiles/Makefile.cmake b/clik/build/CMakeFiles/Makefile.cmake
index 428afd4f15517ad177edb3d7a6f8b484cd8d0fed..1518c77ce68a1ab2e7bbda1eb724a2f1e6690b64 100644
--- a/clik/build/CMakeFiles/Makefile.cmake
+++ b/clik/build/CMakeFiles/Makefile.cmake
@@ -34,7 +34,7 @@ set(CMAKE_MAKEFILE_DEPENDS
   "/home/gospodar/.local/lib/python3.10/site-packages/cmake/data/share/cmake-3.27/Modules/Platform/Linux-Initialize.cmake"
   "/home/gospodar/.local/lib/python3.10/site-packages/cmake/data/share/cmake-3.27/Modules/Platform/Linux.cmake"
   "/home/gospodar/.local/lib/python3.10/site-packages/cmake/data/share/cmake-3.27/Modules/Platform/UnixPaths.cmake"
-  "/home/gospodar/lund/praxis/ur_simple_control/clik/CMakeLists.txt"
+  "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/CMakeLists.txt"
   "CMakeFiles/3.27.4/CMakeCCompiler.cmake"
   "CMakeFiles/3.27.4/CMakeCXXCompiler.cmake"
   "CMakeFiles/3.27.4/CMakeSystem.cmake"
diff --git a/clik/build/CMakeFiles/Makefile2 b/clik/build/CMakeFiles/Makefile2
index 75a8c7e5c71d21dc414c7c95048dbdef85d30bd3..6535a8533cc1f8bf56ccbd398d4a2985a99bcf72 100644
--- a/clik/build/CMakeFiles/Makefile2
+++ b/clik/build/CMakeFiles/Makefile2
@@ -54,10 +54,10 @@ RM = /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E
 EQUALS = =
 
 # The top-level source directory on which CMake was run.
-CMAKE_SOURCE_DIR = /home/gospodar/lund/praxis/ur_simple_control/clik
+CMAKE_SOURCE_DIR = /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik
 
 # The top-level build directory on which CMake was run.
-CMAKE_BINARY_DIR = /home/gospodar/lund/praxis/ur_simple_control/clik/build
+CMAKE_BINARY_DIR = /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build
 
 #=============================================================================
 # Directory level rules for the build root directory
@@ -81,14 +81,14 @@ clean: CMakeFiles/clik.dir/clean
 CMakeFiles/clik.dir/all:
 	$(MAKE) $(MAKESILENT) -f CMakeFiles/clik.dir/build.make CMakeFiles/clik.dir/depend
 	$(MAKE) $(MAKESILENT) -f CMakeFiles/clik.dir/build.make CMakeFiles/clik.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color "--switch=$(COLOR)" --progress-dir=/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles --progress-num=1,2 "Built target clik"
+	@$(CMAKE_COMMAND) -E cmake_echo_color "--switch=$(COLOR)" --progress-dir=/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles --progress-num=1,2 "Built target clik"
 .PHONY : CMakeFiles/clik.dir/all
 
 # Build rule for subdir invocation for target.
 CMakeFiles/clik.dir/rule: cmake_check_build_system
-	$(CMAKE_COMMAND) -E cmake_progress_start /home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles 2
+	$(CMAKE_COMMAND) -E cmake_progress_start /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles 2
 	$(MAKE) $(MAKESILENT) -f CMakeFiles/Makefile2 CMakeFiles/clik.dir/all
-	$(CMAKE_COMMAND) -E cmake_progress_start /home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles 0
+	$(CMAKE_COMMAND) -E cmake_progress_start /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles 0
 .PHONY : CMakeFiles/clik.dir/rule
 
 # Convenience name for target.
diff --git a/clik/build/CMakeFiles/TargetDirectories.txt b/clik/build/CMakeFiles/TargetDirectories.txt
index 3acf413fa66f73a0a9cc9c507733aa6df31ee264..877642d089a69c6ce56fac7bb38d7cae627d3630 100644
--- a/clik/build/CMakeFiles/TargetDirectories.txt
+++ b/clik/build/CMakeFiles/TargetDirectories.txt
@@ -1,3 +1,3 @@
-/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/clik.dir
-/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/edit_cache.dir
-/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/rebuild_cache.dir
+/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/clik.dir
+/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/edit_cache.dir
+/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/rebuild_cache.dir
diff --git a/clik/build/CMakeFiles/clik.dir/DependInfo.cmake b/clik/build/CMakeFiles/clik.dir/DependInfo.cmake
index 9704757bbd2d3d93205acb544fe6059f1ac2444d..f10f937c19366dd00bdde41b580ce88ac9cc42cc 100644
--- a/clik/build/CMakeFiles/clik.dir/DependInfo.cmake
+++ b/clik/build/CMakeFiles/clik.dir/DependInfo.cmake
@@ -8,7 +8,7 @@ set(CMAKE_DEPENDS_LANGUAGES
 
 # The set of dependency files which are needed:
 set(CMAKE_DEPENDS_DEPENDENCY_FILES
-  "/home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp" "CMakeFiles/clik.dir/src/clik.cpp.o" "gcc" "CMakeFiles/clik.dir/src/clik.cpp.o.d"
+  "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp" "CMakeFiles/clik.dir/src/clik.cpp.o" "gcc" "CMakeFiles/clik.dir/src/clik.cpp.o.d"
   )
 
 # Targets to which this target links which contain Fortran sources.
diff --git a/clik/build/CMakeFiles/clik.dir/build.make b/clik/build/CMakeFiles/clik.dir/build.make
index e47acdb7da8d640e4495c10887c8dee7b316e5df..c27b32ad576ae94baf25040190a1e0ece4fb3141 100644
--- a/clik/build/CMakeFiles/clik.dir/build.make
+++ b/clik/build/CMakeFiles/clik.dir/build.make
@@ -53,10 +53,10 @@ RM = /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E
 EQUALS = =
 
 # The top-level source directory on which CMake was run.
-CMAKE_SOURCE_DIR = /home/gospodar/lund/praxis/ur_simple_control/clik
+CMAKE_SOURCE_DIR = /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik
 
 # The top-level build directory on which CMake was run.
-CMAKE_BINARY_DIR = /home/gospodar/lund/praxis/ur_simple_control/clik/build
+CMAKE_BINARY_DIR = /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build
 
 # Include any dependencies generated for this target.
 include CMakeFiles/clik.dir/depend.make
@@ -70,18 +70,18 @@ include CMakeFiles/clik.dir/progress.make
 include CMakeFiles/clik.dir/flags.make
 
 CMakeFiles/clik.dir/src/clik.cpp.o: CMakeFiles/clik.dir/flags.make
-CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp
+CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp
 CMakeFiles/clik.dir/src/clik.cpp.o: CMakeFiles/clik.dir/compiler_depend.ts
-	@$(CMAKE_COMMAND) -E cmake_echo_color "--switch=$(COLOR)" --green --progress-dir=/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles --progress-num=$(CMAKE_PROGRESS_1) "Building CXX object CMakeFiles/clik.dir/src/clik.cpp.o"
-	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -MD -MT CMakeFiles/clik.dir/src/clik.cpp.o -MF CMakeFiles/clik.dir/src/clik.cpp.o.d -o CMakeFiles/clik.dir/src/clik.cpp.o -c /home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp
+	@$(CMAKE_COMMAND) -E cmake_echo_color "--switch=$(COLOR)" --green --progress-dir=/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles --progress-num=$(CMAKE_PROGRESS_1) "Building CXX object CMakeFiles/clik.dir/src/clik.cpp.o"
+	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -MD -MT CMakeFiles/clik.dir/src/clik.cpp.o -MF CMakeFiles/clik.dir/src/clik.cpp.o.d -o CMakeFiles/clik.dir/src/clik.cpp.o -c /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp
 
 CMakeFiles/clik.dir/src/clik.cpp.i: cmake_force
 	@$(CMAKE_COMMAND) -E cmake_echo_color "--switch=$(COLOR)" --green "Preprocessing CXX source to CMakeFiles/clik.dir/src/clik.cpp.i"
-	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -E /home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp > CMakeFiles/clik.dir/src/clik.cpp.i
+	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -E /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp > CMakeFiles/clik.dir/src/clik.cpp.i
 
 CMakeFiles/clik.dir/src/clik.cpp.s: cmake_force
 	@$(CMAKE_COMMAND) -E cmake_echo_color "--switch=$(COLOR)" --green "Compiling CXX source to assembly CMakeFiles/clik.dir/src/clik.cpp.s"
-	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -S /home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp -o CMakeFiles/clik.dir/src/clik.cpp.s
+	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -S /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp -o CMakeFiles/clik.dir/src/clik.cpp.s
 
 # Object files for target clik
 clik_OBJECTS = \
@@ -109,7 +109,7 @@ clik: /usr/lib/x86_64-linux-gnu/libboost_chrono.so
 clik: /usr/lib/x86_64-linux-gnu/liboctomap.so.1.9.7
 clik: /usr/lib/x86_64-linux-gnu/liboctomath.so.1.9.7
 clik: CMakeFiles/clik.dir/link.txt
-	@$(CMAKE_COMMAND) -E cmake_echo_color "--switch=$(COLOR)" --green --bold --progress-dir=/home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles --progress-num=$(CMAKE_PROGRESS_2) "Linking CXX executable clik"
+	@$(CMAKE_COMMAND) -E cmake_echo_color "--switch=$(COLOR)" --green --bold --progress-dir=/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles --progress-num=$(CMAKE_PROGRESS_2) "Linking CXX executable clik"
 	$(CMAKE_COMMAND) -E cmake_link_script CMakeFiles/clik.dir/link.txt --verbose=$(VERBOSE)
 
 # Rule to build all files generated by this target.
@@ -121,6 +121,6 @@ CMakeFiles/clik.dir/clean:
 .PHONY : CMakeFiles/clik.dir/clean
 
 CMakeFiles/clik.dir/depend:
-	cd /home/gospodar/lund/praxis/ur_simple_control/clik/build && $(CMAKE_COMMAND) -E cmake_depends "Unix Makefiles" /home/gospodar/lund/praxis/ur_simple_control/clik /home/gospodar/lund/praxis/ur_simple_control/clik /home/gospodar/lund/praxis/ur_simple_control/clik/build /home/gospodar/lund/praxis/ur_simple_control/clik/build /home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/clik.dir/DependInfo.cmake "--color=$(COLOR)"
+	cd /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build && $(CMAKE_COMMAND) -E cmake_depends "Unix Makefiles" /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles/clik.dir/DependInfo.cmake "--color=$(COLOR)"
 .PHONY : CMakeFiles/clik.dir/depend
 
diff --git a/clik/build/CMakeFiles/clik.dir/compiler_depend.internal b/clik/build/CMakeFiles/clik.dir/compiler_depend.internal
index 2d0829a1e908cec88db8c067d3007e49069c45d1..4a438f882fe2c507b7747fe2c0f519b5a20c3912 100644
--- a/clik/build/CMakeFiles/clik.dir/compiler_depend.internal
+++ b/clik/build/CMakeFiles/clik.dir/compiler_depend.internal
@@ -2,7 +2,7 @@
 # Generated by "Unix Makefiles" Generator, CMake Version 3.27
 
 CMakeFiles/clik.dir/src/clik.cpp.o
- /home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp
+ /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp
  /opt/openrobots/include/hpp/fcl/BV/AABB.h
  /opt/openrobots/include/hpp/fcl/BV/BV.h
  /opt/openrobots/include/hpp/fcl/BV/BV_node.h
@@ -31,8 +31,14 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /opt/openrobots/include/hpp/fcl/shape/geometric_shapes.h
  /opt/openrobots/include/hpp/fcl/timings.h
  /opt/openrobots/include/hpp/fcl/warning.hh
+ /opt/openrobots/include/pinocchio/algorithm/check.hpp
+ /opt/openrobots/include/pinocchio/algorithm/check.hxx
+ /opt/openrobots/include/pinocchio/algorithm/jacobian.hpp
+ /opt/openrobots/include/pinocchio/algorithm/jacobian.hxx
  /opt/openrobots/include/pinocchio/algorithm/joint-configuration.hpp
  /opt/openrobots/include/pinocchio/algorithm/joint-configuration.hxx
+ /opt/openrobots/include/pinocchio/algorithm/kinematics.hpp
+ /opt/openrobots/include/pinocchio/algorithm/kinematics.hxx
  /opt/openrobots/include/pinocchio/config.hpp
  /opt/openrobots/include/pinocchio/container/aligned-vector.hpp
  /opt/openrobots/include/pinocchio/container/boost-container-limits.hpp
@@ -57,6 +63,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /opt/openrobots/include/pinocchio/multibody/constraint-base.hpp
  /opt/openrobots/include/pinocchio/multibody/constraint-generic.hpp
  /opt/openrobots/include/pinocchio/multibody/constraint.hpp
+ /opt/openrobots/include/pinocchio/multibody/data.hpp
+ /opt/openrobots/include/pinocchio/multibody/data.hxx
  /opt/openrobots/include/pinocchio/multibody/fcl.hpp
  /opt/openrobots/include/pinocchio/multibody/fcl.hxx
  /opt/openrobots/include/pinocchio/multibody/frame.hpp
@@ -103,6 +111,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /opt/openrobots/include/pinocchio/multibody/visitor/fusion.hpp
  /opt/openrobots/include/pinocchio/multibody/visitor/joint-binary-visitor.hpp
  /opt/openrobots/include/pinocchio/multibody/visitor/joint-unary-visitor.hpp
+ /opt/openrobots/include/pinocchio/parsers/sample-models.hpp
+ /opt/openrobots/include/pinocchio/parsers/sample-models.hxx
  /opt/openrobots/include/pinocchio/parsers/urdf.hpp
  /opt/openrobots/include/pinocchio/parsers/urdf/geometry.hxx
  /opt/openrobots/include/pinocchio/parsers/urdf/model.hxx
@@ -619,31 +629,115 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/function_types/property_tags.hpp
  /usr/include/boost/function_types/result_type.hpp
  /usr/include/boost/functional/hash_fwd.hpp
+ /usr/include/boost/fusion/adapted/mpl.hpp
+ /usr/include/boost/fusion/adapted/mpl/detail/at_impl.hpp
  /usr/include/boost/fusion/adapted/mpl/detail/begin_impl.hpp
+ /usr/include/boost/fusion/adapted/mpl/detail/category_of_impl.hpp
+ /usr/include/boost/fusion/adapted/mpl/detail/empty_impl.hpp
  /usr/include/boost/fusion/adapted/mpl/detail/end_impl.hpp
+ /usr/include/boost/fusion/adapted/mpl/detail/has_key_impl.hpp
+ /usr/include/boost/fusion/adapted/mpl/detail/is_sequence_impl.hpp
+ /usr/include/boost/fusion/adapted/mpl/detail/is_view_impl.hpp
+ /usr/include/boost/fusion/adapted/mpl/detail/size_impl.hpp
+ /usr/include/boost/fusion/adapted/mpl/detail/value_at_impl.hpp
  /usr/include/boost/fusion/adapted/mpl/mpl_iterator.hpp
+ /usr/include/boost/fusion/algorithm.hpp
+ /usr/include/boost/fusion/algorithm/iteration.hpp
+ /usr/include/boost/fusion/algorithm/iteration/accumulate.hpp
+ /usr/include/boost/fusion/algorithm/iteration/accumulate_fwd.hpp
+ /usr/include/boost/fusion/algorithm/iteration/detail/for_each.hpp
+ /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/iter_fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/reverse_fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/reverse_iter_fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/detail/segmented_fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/detail/segmented_for_each.hpp
+ /usr/include/boost/fusion/algorithm/iteration/fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/fold_fwd.hpp
+ /usr/include/boost/fusion/algorithm/iteration/for_each.hpp
+ /usr/include/boost/fusion/algorithm/iteration/for_each_fwd.hpp
+ /usr/include/boost/fusion/algorithm/iteration/iter_fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/iter_fold_fwd.hpp
+ /usr/include/boost/fusion/algorithm/iteration/reverse_fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/reverse_fold_fwd.hpp
+ /usr/include/boost/fusion/algorithm/iteration/reverse_iter_fold.hpp
+ /usr/include/boost/fusion/algorithm/iteration/reverse_iter_fold_fwd.hpp
+ /usr/include/boost/fusion/algorithm/query.hpp
+ /usr/include/boost/fusion/algorithm/query/all.hpp
+ /usr/include/boost/fusion/algorithm/query/any.hpp
+ /usr/include/boost/fusion/algorithm/query/count.hpp
+ /usr/include/boost/fusion/algorithm/query/count_if.hpp
+ /usr/include/boost/fusion/algorithm/query/detail/all.hpp
+ /usr/include/boost/fusion/algorithm/query/detail/any.hpp
+ /usr/include/boost/fusion/algorithm/query/detail/count.hpp
+ /usr/include/boost/fusion/algorithm/query/detail/count_if.hpp
+ /usr/include/boost/fusion/algorithm/query/detail/find_if.hpp
+ /usr/include/boost/fusion/algorithm/query/detail/segmented_find.hpp
+ /usr/include/boost/fusion/algorithm/query/detail/segmented_find_if.hpp
+ /usr/include/boost/fusion/algorithm/query/find.hpp
+ /usr/include/boost/fusion/algorithm/query/find_fwd.hpp
+ /usr/include/boost/fusion/algorithm/query/find_if.hpp
+ /usr/include/boost/fusion/algorithm/query/find_if_fwd.hpp
+ /usr/include/boost/fusion/algorithm/query/none.hpp
+ /usr/include/boost/fusion/algorithm/transformation.hpp
+ /usr/include/boost/fusion/algorithm/transformation/clear.hpp
+ /usr/include/boost/fusion/algorithm/transformation/detail/preprocessed/zip.hpp
+ /usr/include/boost/fusion/algorithm/transformation/detail/preprocessed/zip10.hpp
+ /usr/include/boost/fusion/algorithm/transformation/detail/replace.hpp
+ /usr/include/boost/fusion/algorithm/transformation/detail/replace_if.hpp
+ /usr/include/boost/fusion/algorithm/transformation/erase.hpp
+ /usr/include/boost/fusion/algorithm/transformation/erase_key.hpp
+ /usr/include/boost/fusion/algorithm/transformation/filter.hpp
+ /usr/include/boost/fusion/algorithm/transformation/filter_if.hpp
+ /usr/include/boost/fusion/algorithm/transformation/flatten.hpp
+ /usr/include/boost/fusion/algorithm/transformation/insert.hpp
+ /usr/include/boost/fusion/algorithm/transformation/insert_range.hpp
+ /usr/include/boost/fusion/algorithm/transformation/join.hpp
+ /usr/include/boost/fusion/algorithm/transformation/pop_back.hpp
+ /usr/include/boost/fusion/algorithm/transformation/pop_front.hpp
  /usr/include/boost/fusion/algorithm/transformation/push_back.hpp
  /usr/include/boost/fusion/algorithm/transformation/push_front.hpp
+ /usr/include/boost/fusion/algorithm/transformation/remove.hpp
+ /usr/include/boost/fusion/algorithm/transformation/remove_if.hpp
+ /usr/include/boost/fusion/algorithm/transformation/replace.hpp
+ /usr/include/boost/fusion/algorithm/transformation/replace_if.hpp
+ /usr/include/boost/fusion/algorithm/transformation/reverse.hpp
+ /usr/include/boost/fusion/algorithm/transformation/transform.hpp
+ /usr/include/boost/fusion/algorithm/transformation/zip.hpp
+ /usr/include/boost/fusion/container/deque/deque_fwd.hpp
+ /usr/include/boost/fusion/container/generation/make_list.hpp
  /usr/include/boost/fusion/container/generation/make_vector.hpp
+ /usr/include/boost/fusion/container/list.hpp
  /usr/include/boost/fusion/container/list/cons.hpp
  /usr/include/boost/fusion/container/list/cons_fwd.hpp
  /usr/include/boost/fusion/container/list/cons_iterator.hpp
+ /usr/include/boost/fusion/container/list/convert.hpp
  /usr/include/boost/fusion/container/list/detail/at_impl.hpp
  /usr/include/boost/fusion/container/list/detail/begin_impl.hpp
+ /usr/include/boost/fusion/container/list/detail/build_cons.hpp
+ /usr/include/boost/fusion/container/list/detail/convert_impl.hpp
  /usr/include/boost/fusion/container/list/detail/deref_impl.hpp
  /usr/include/boost/fusion/container/list/detail/empty_impl.hpp
  /usr/include/boost/fusion/container/list/detail/end_impl.hpp
  /usr/include/boost/fusion/container/list/detail/equal_to_impl.hpp
+ /usr/include/boost/fusion/container/list/detail/list_to_cons.hpp
  /usr/include/boost/fusion/container/list/detail/next_impl.hpp
  /usr/include/boost/fusion/container/list/detail/reverse_cons.hpp
  /usr/include/boost/fusion/container/list/detail/value_at_impl.hpp
  /usr/include/boost/fusion/container/list/detail/value_of_impl.hpp
+ /usr/include/boost/fusion/container/list/list.hpp
  /usr/include/boost/fusion/container/list/list_fwd.hpp
  /usr/include/boost/fusion/container/list/nil.hpp
+ /usr/include/boost/fusion/container/map/map_fwd.hpp
+ /usr/include/boost/fusion/container/set/set_fwd.hpp
+ /usr/include/boost/fusion/container/vector.hpp
+ /usr/include/boost/fusion/container/vector/convert.hpp
  /usr/include/boost/fusion/container/vector/detail/advance_impl.hpp
+ /usr/include/boost/fusion/container/vector/detail/as_vector.hpp
  /usr/include/boost/fusion/container/vector/detail/at_impl.hpp
  /usr/include/boost/fusion/container/vector/detail/begin_impl.hpp
  /usr/include/boost/fusion/container/vector/detail/config.hpp
+ /usr/include/boost/fusion/container/vector/detail/convert_impl.hpp
  /usr/include/boost/fusion/container/vector/detail/deref_impl.hpp
  /usr/include/boost/fusion/container/vector/detail/distance_impl.hpp
  /usr/include/boost/fusion/container/vector/detail/end_impl.hpp
@@ -653,11 +747,13 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/fusion/container/vector/detail/value_at_impl.hpp
  /usr/include/boost/fusion/container/vector/detail/value_of_impl.hpp
  /usr/include/boost/fusion/container/vector/vector.hpp
+ /usr/include/boost/fusion/container/vector/vector10.hpp
  /usr/include/boost/fusion/container/vector/vector_fwd.hpp
  /usr/include/boost/fusion/container/vector/vector_iterator.hpp
  /usr/include/boost/fusion/functional/invocation/detail/that_ptr.hpp
  /usr/include/boost/fusion/functional/invocation/invoke.hpp
  /usr/include/boost/fusion/functional/invocation/limits.hpp
+ /usr/include/boost/fusion/include/equal_to.hpp
  /usr/include/boost/fusion/include/invoke.hpp
  /usr/include/boost/fusion/iterator/advance.hpp
  /usr/include/boost/fusion/iterator/deref.hpp
@@ -672,8 +768,10 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/fusion/iterator/detail/segmented_next_impl.hpp
  /usr/include/boost/fusion/iterator/distance.hpp
  /usr/include/boost/fusion/iterator/equal_to.hpp
+ /usr/include/boost/fusion/iterator/iterator_adapter.hpp
  /usr/include/boost/fusion/iterator/iterator_facade.hpp
  /usr/include/boost/fusion/iterator/key_of.hpp
+ /usr/include/boost/fusion/iterator/mpl.hpp
  /usr/include/boost/fusion/iterator/mpl/convert_iterator.hpp
  /usr/include/boost/fusion/iterator/mpl/fusion_iterator.hpp
  /usr/include/boost/fusion/iterator/next.hpp
@@ -681,8 +779,29 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/fusion/iterator/segmented_iterator.hpp
  /usr/include/boost/fusion/iterator/value_of.hpp
  /usr/include/boost/fusion/iterator/value_of_data.hpp
+ /usr/include/boost/fusion/mpl.hpp
+ /usr/include/boost/fusion/mpl/at.hpp
+ /usr/include/boost/fusion/mpl/back.hpp
  /usr/include/boost/fusion/mpl/begin.hpp
+ /usr/include/boost/fusion/mpl/clear.hpp
+ /usr/include/boost/fusion/mpl/detail/clear.hpp
+ /usr/include/boost/fusion/mpl/empty.hpp
  /usr/include/boost/fusion/mpl/end.hpp
+ /usr/include/boost/fusion/mpl/erase.hpp
+ /usr/include/boost/fusion/mpl/erase_key.hpp
+ /usr/include/boost/fusion/mpl/front.hpp
+ /usr/include/boost/fusion/mpl/has_key.hpp
+ /usr/include/boost/fusion/mpl/insert.hpp
+ /usr/include/boost/fusion/mpl/insert_range.hpp
+ /usr/include/boost/fusion/mpl/pop_back.hpp
+ /usr/include/boost/fusion/mpl/pop_front.hpp
+ /usr/include/boost/fusion/mpl/push_back.hpp
+ /usr/include/boost/fusion/mpl/push_front.hpp
+ /usr/include/boost/fusion/mpl/size.hpp
+ /usr/include/boost/fusion/sequence/comparison/detail/equal_to.hpp
+ /usr/include/boost/fusion/sequence/comparison/enable_comparison.hpp
+ /usr/include/boost/fusion/sequence/comparison/equal_to.hpp
+ /usr/include/boost/fusion/sequence/convert.hpp
  /usr/include/boost/fusion/sequence/intrinsic/at.hpp
  /usr/include/boost/fusion/sequence/intrinsic/begin.hpp
  /usr/include/boost/fusion/sequence/intrinsic/detail/segmented_begin.hpp
@@ -693,10 +812,12 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/fusion/sequence/intrinsic/empty.hpp
  /usr/include/boost/fusion/sequence/intrinsic/end.hpp
  /usr/include/boost/fusion/sequence/intrinsic/front.hpp
+ /usr/include/boost/fusion/sequence/intrinsic/has_key.hpp
  /usr/include/boost/fusion/sequence/intrinsic/segments.hpp
  /usr/include/boost/fusion/sequence/intrinsic/size.hpp
  /usr/include/boost/fusion/sequence/intrinsic/value_at.hpp
  /usr/include/boost/fusion/sequence/intrinsic_fwd.hpp
+ /usr/include/boost/fusion/support/as_const.hpp
  /usr/include/boost/fusion/support/category_of.hpp
  /usr/include/boost/fusion/support/config.hpp
  /usr/include/boost/fusion/support/detail/access.hpp
@@ -707,16 +828,35 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/fusion/support/detail/is_mpl_sequence.hpp
  /usr/include/boost/fusion/support/detail/is_native_fusion_sequence.hpp
  /usr/include/boost/fusion/support/detail/mpl_iterator_category.hpp
+ /usr/include/boost/fusion/support/detail/pp_round.hpp
  /usr/include/boost/fusion/support/detail/segmented_fold_until_impl.hpp
  /usr/include/boost/fusion/support/is_iterator.hpp
  /usr/include/boost/fusion/support/is_segmented.hpp
  /usr/include/boost/fusion/support/is_sequence.hpp
  /usr/include/boost/fusion/support/is_view.hpp
  /usr/include/boost/fusion/support/iterator_base.hpp
+ /usr/include/boost/fusion/support/segmented_fold_until.hpp
  /usr/include/boost/fusion/support/sequence_base.hpp
  /usr/include/boost/fusion/support/tag_of.hpp
  /usr/include/boost/fusion/support/tag_of_fwd.hpp
+ /usr/include/boost/fusion/support/unused.hpp
  /usr/include/boost/fusion/support/void.hpp
+ /usr/include/boost/fusion/view/detail/strictest_traversal.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/begin_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/deref_data_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/deref_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/end_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/equal_to_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/key_of_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/next_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/size_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/value_of_data_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/detail/value_of_impl.hpp
+ /usr/include/boost/fusion/view/filter_view/filter_view.hpp
+ /usr/include/boost/fusion/view/filter_view/filter_view_iterator.hpp
+ /usr/include/boost/fusion/view/flatten_view.hpp
+ /usr/include/boost/fusion/view/flatten_view/flatten_view.hpp
+ /usr/include/boost/fusion/view/flatten_view/flatten_view_iterator.hpp
  /usr/include/boost/fusion/view/iterator_range.hpp
  /usr/include/boost/fusion/view/iterator_range/detail/at_impl.hpp
  /usr/include/boost/fusion/view/iterator_range/detail/begin_impl.hpp
@@ -727,6 +867,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/fusion/view/iterator_range/detail/size_impl.hpp
  /usr/include/boost/fusion/view/iterator_range/detail/value_at_impl.hpp
  /usr/include/boost/fusion/view/iterator_range/iterator_range.hpp
+ /usr/include/boost/fusion/view/joint_view.hpp
  /usr/include/boost/fusion/view/joint_view/detail/begin_impl.hpp
  /usr/include/boost/fusion/view/joint_view/detail/deref_data_impl.hpp
  /usr/include/boost/fusion/view/joint_view/detail/deref_impl.hpp
@@ -738,6 +879,21 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/fusion/view/joint_view/joint_view.hpp
  /usr/include/boost/fusion/view/joint_view/joint_view_fwd.hpp
  /usr/include/boost/fusion/view/joint_view/joint_view_iterator.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/advance_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/at_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/begin_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/deref_data_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/deref_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/distance_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/end_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/key_of_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/next_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/prior_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/value_at_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/value_of_data_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/detail/value_of_impl.hpp
+ /usr/include/boost/fusion/view/reverse_view/reverse_view.hpp
+ /usr/include/boost/fusion/view/reverse_view/reverse_view_iterator.hpp
  /usr/include/boost/fusion/view/single_view/detail/advance_impl.hpp
  /usr/include/boost/fusion/view/single_view/detail/at_impl.hpp
  /usr/include/boost/fusion/view/single_view/detail/begin_impl.hpp
@@ -752,6 +908,36 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/fusion/view/single_view/detail/value_of_impl.hpp
  /usr/include/boost/fusion/view/single_view/single_view.hpp
  /usr/include/boost/fusion/view/single_view/single_view_iterator.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/advance_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/at_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/begin_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/deref_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/distance_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/end_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/equal_to_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/next_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/prior_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/value_at_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/detail/value_of_impl.hpp
+ /usr/include/boost/fusion/view/transform_view/transform_view.hpp
+ /usr/include/boost/fusion/view/transform_view/transform_view_fwd.hpp
+ /usr/include/boost/fusion/view/transform_view/transform_view_iterator.hpp
+ /usr/include/boost/fusion/view/zip_view.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/advance_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/at_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/begin_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/deref_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/distance_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/end_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/equal_to_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/next_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/prior_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/size_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/value_at_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/detail/value_of_impl.hpp
+ /usr/include/boost/fusion/view/zip_view/zip_view.hpp
+ /usr/include/boost/fusion/view/zip_view/zip_view_iterator.hpp
+ /usr/include/boost/fusion/view/zip_view/zip_view_iterator_fwd.hpp
  /usr/include/boost/get_pointer.hpp
  /usr/include/boost/integer.hpp
  /usr/include/boost/integer/common_factor_ct.hpp
@@ -909,6 +1095,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/aux_/arity.hpp
  /usr/include/boost/mpl/aux_/arity_spec.hpp
  /usr/include/boost/mpl/aux_/at_impl.hpp
+ /usr/include/boost/mpl/aux_/back_impl.hpp
  /usr/include/boost/mpl/aux_/begin_end_impl.hpp
  /usr/include/boost/mpl/aux_/clear_impl.hpp
  /usr/include/boost/mpl/aux_/common_name_wknd.hpp
@@ -942,6 +1129,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/aux_/config/workaround.hpp
  /usr/include/boost/mpl/aux_/contains_impl.hpp
  /usr/include/boost/mpl/aux_/empty_impl.hpp
+ /usr/include/boost/mpl/aux_/erase_impl.hpp
+ /usr/include/boost/mpl/aux_/erase_key_impl.hpp
  /usr/include/boost/mpl/aux_/find_if_pred.hpp
  /usr/include/boost/mpl/aux_/fold_impl.hpp
  /usr/include/boost/mpl/aux_/fold_impl_body.hpp
@@ -949,6 +1138,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/aux_/full_lambda.hpp
  /usr/include/boost/mpl/aux_/has_apply.hpp
  /usr/include/boost/mpl/aux_/has_begin.hpp
+ /usr/include/boost/mpl/aux_/has_key_impl.hpp
  /usr/include/boost/mpl/aux_/has_size.hpp
  /usr/include/boost/mpl/aux_/has_tag.hpp
  /usr/include/boost/mpl/aux_/has_type.hpp
@@ -978,6 +1168,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/aux_/nttp_decl.hpp
  /usr/include/boost/mpl/aux_/numeric_cast_utils.hpp
  /usr/include/boost/mpl/aux_/numeric_op.hpp
+ /usr/include/boost/mpl/aux_/pop_back_impl.hpp
  /usr/include/boost/mpl/aux_/pop_front_impl.hpp
  /usr/include/boost/mpl/aux_/preprocessor/add.hpp
  /usr/include/boost/mpl/aux_/preprocessor/def_params_tail.hpp
@@ -994,14 +1185,17 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/aux_/reverse_fold_impl.hpp
  /usr/include/boost/mpl/aux_/reverse_fold_impl_body.hpp
  /usr/include/boost/mpl/aux_/sequence_wrapper.hpp
+ /usr/include/boost/mpl/aux_/single_element_iter.hpp
  /usr/include/boost/mpl/aux_/size_impl.hpp
  /usr/include/boost/mpl/aux_/static_cast.hpp
  /usr/include/boost/mpl/aux_/template_arity.hpp
  /usr/include/boost/mpl/aux_/template_arity_fwd.hpp
  /usr/include/boost/mpl/aux_/traits_lambda_spec.hpp
+ /usr/include/boost/mpl/aux_/transform_iter.hpp
  /usr/include/boost/mpl/aux_/type_wrapper.hpp
  /usr/include/boost/mpl/aux_/value_wknd.hpp
  /usr/include/boost/mpl/aux_/yes_no.hpp
+ /usr/include/boost/mpl/back.hpp
  /usr/include/boost/mpl/back_fwd.hpp
  /usr/include/boost/mpl/back_inserter.hpp
  /usr/include/boost/mpl/begin.hpp
@@ -1027,6 +1221,10 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/end.hpp
  /usr/include/boost/mpl/equal.hpp
  /usr/include/boost/mpl/equal_to.hpp
+ /usr/include/boost/mpl/erase.hpp
+ /usr/include/boost/mpl/erase_fwd.hpp
+ /usr/include/boost/mpl/erase_key.hpp
+ /usr/include/boost/mpl/erase_key_fwd.hpp
  /usr/include/boost/mpl/eval_if.hpp
  /usr/include/boost/mpl/find.hpp
  /usr/include/boost/mpl/find_if.hpp
@@ -1036,6 +1234,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/front_inserter.hpp
  /usr/include/boost/mpl/greater.hpp
  /usr/include/boost/mpl/greater_equal.hpp
+ /usr/include/boost/mpl/has_key.hpp
+ /usr/include/boost/mpl/has_key_fwd.hpp
  /usr/include/boost/mpl/has_xxx.hpp
  /usr/include/boost/mpl/identity.hpp
  /usr/include/boost/mpl/if.hpp
@@ -1087,6 +1287,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/long.hpp
  /usr/include/boost/mpl/long_fwd.hpp
  /usr/include/boost/mpl/max_element.hpp
+ /usr/include/boost/mpl/min.hpp
  /usr/include/boost/mpl/min_max.hpp
  /usr/include/boost/mpl/minus.hpp
  /usr/include/boost/mpl/multiplies.hpp
@@ -1101,6 +1302,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/pair_view.hpp
  /usr/include/boost/mpl/placeholders.hpp
  /usr/include/boost/mpl/plus.hpp
+ /usr/include/boost/mpl/pop_back.hpp
  /usr/include/boost/mpl/pop_back_fwd.hpp
  /usr/include/boost/mpl/pop_front.hpp
  /usr/include/boost/mpl/pop_front_fwd.hpp
@@ -1118,6 +1320,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/same_as.hpp
  /usr/include/boost/mpl/sequence_tag.hpp
  /usr/include/boost/mpl/sequence_tag_fwd.hpp
+ /usr/include/boost/mpl/single_view.hpp
  /usr/include/boost/mpl/size.hpp
  /usr/include/boost/mpl/size_fwd.hpp
  /usr/include/boost/mpl/size_t.hpp
@@ -1126,6 +1329,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/tag.hpp
  /usr/include/boost/mpl/times.hpp
  /usr/include/boost/mpl/transform.hpp
+ /usr/include/boost/mpl/transform_view.hpp
+ /usr/include/boost/mpl/unpack_args.hpp
  /usr/include/boost/mpl/vector.hpp
  /usr/include/boost/mpl/vector/aux_/O1_size.hpp
  /usr/include/boost/mpl/vector/aux_/at.hpp
@@ -1150,6 +1355,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o
  /usr/include/boost/mpl/vector/vector30.hpp
  /usr/include/boost/mpl/void.hpp
  /usr/include/boost/mpl/void_fwd.hpp
+ /usr/include/boost/mpl/zip_view.hpp
  /usr/include/boost/next_prior.hpp
  /usr/include/boost/noncopyable.hpp
  /usr/include/boost/numeric/conversion/bounds.hpp
diff --git a/clik/build/CMakeFiles/clik.dir/compiler_depend.make b/clik/build/CMakeFiles/clik.dir/compiler_depend.make
index 9a5acd4a8fcfe585d0e8c05751839ebdfe2e0d1d..1c973afbdef359a3b8f4d568a7f23d2eaf4d54b8 100644
--- a/clik/build/CMakeFiles/clik.dir/compiler_depend.make
+++ b/clik/build/CMakeFiles/clik.dir/compiler_depend.make
@@ -1,7 +1,7 @@
 # CMAKE generated file: DO NOT EDIT!
 # Generated by "Unix Makefiles" Generator, CMake Version 3.27
 
-CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp \
+CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp \
   /opt/openrobots/include/hpp/fcl/BV/AABB.h \
   /opt/openrobots/include/hpp/fcl/BV/BV.h \
   /opt/openrobots/include/hpp/fcl/BV/BV_node.h \
@@ -30,8 +30,14 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /opt/openrobots/include/hpp/fcl/shape/geometric_shapes.h \
   /opt/openrobots/include/hpp/fcl/timings.h \
   /opt/openrobots/include/hpp/fcl/warning.hh \
+  /opt/openrobots/include/pinocchio/algorithm/check.hpp \
+  /opt/openrobots/include/pinocchio/algorithm/check.hxx \
+  /opt/openrobots/include/pinocchio/algorithm/jacobian.hpp \
+  /opt/openrobots/include/pinocchio/algorithm/jacobian.hxx \
   /opt/openrobots/include/pinocchio/algorithm/joint-configuration.hpp \
   /opt/openrobots/include/pinocchio/algorithm/joint-configuration.hxx \
+  /opt/openrobots/include/pinocchio/algorithm/kinematics.hpp \
+  /opt/openrobots/include/pinocchio/algorithm/kinematics.hxx \
   /opt/openrobots/include/pinocchio/config.hpp \
   /opt/openrobots/include/pinocchio/container/aligned-vector.hpp \
   /opt/openrobots/include/pinocchio/container/boost-container-limits.hpp \
@@ -56,6 +62,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /opt/openrobots/include/pinocchio/multibody/constraint-base.hpp \
   /opt/openrobots/include/pinocchio/multibody/constraint-generic.hpp \
   /opt/openrobots/include/pinocchio/multibody/constraint.hpp \
+  /opt/openrobots/include/pinocchio/multibody/data.hpp \
+  /opt/openrobots/include/pinocchio/multibody/data.hxx \
   /opt/openrobots/include/pinocchio/multibody/fcl.hpp \
   /opt/openrobots/include/pinocchio/multibody/fcl.hxx \
   /opt/openrobots/include/pinocchio/multibody/frame.hpp \
@@ -102,6 +110,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /opt/openrobots/include/pinocchio/multibody/visitor/fusion.hpp \
   /opt/openrobots/include/pinocchio/multibody/visitor/joint-binary-visitor.hpp \
   /opt/openrobots/include/pinocchio/multibody/visitor/joint-unary-visitor.hpp \
+  /opt/openrobots/include/pinocchio/parsers/sample-models.hpp \
+  /opt/openrobots/include/pinocchio/parsers/sample-models.hxx \
   /opt/openrobots/include/pinocchio/parsers/urdf.hpp \
   /opt/openrobots/include/pinocchio/parsers/urdf/geometry.hxx \
   /opt/openrobots/include/pinocchio/parsers/urdf/model.hxx \
@@ -618,31 +628,115 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/function_types/property_tags.hpp \
   /usr/include/boost/function_types/result_type.hpp \
   /usr/include/boost/functional/hash_fwd.hpp \
+  /usr/include/boost/fusion/adapted/mpl.hpp \
+  /usr/include/boost/fusion/adapted/mpl/detail/at_impl.hpp \
   /usr/include/boost/fusion/adapted/mpl/detail/begin_impl.hpp \
+  /usr/include/boost/fusion/adapted/mpl/detail/category_of_impl.hpp \
+  /usr/include/boost/fusion/adapted/mpl/detail/empty_impl.hpp \
   /usr/include/boost/fusion/adapted/mpl/detail/end_impl.hpp \
+  /usr/include/boost/fusion/adapted/mpl/detail/has_key_impl.hpp \
+  /usr/include/boost/fusion/adapted/mpl/detail/is_sequence_impl.hpp \
+  /usr/include/boost/fusion/adapted/mpl/detail/is_view_impl.hpp \
+  /usr/include/boost/fusion/adapted/mpl/detail/size_impl.hpp \
+  /usr/include/boost/fusion/adapted/mpl/detail/value_at_impl.hpp \
   /usr/include/boost/fusion/adapted/mpl/mpl_iterator.hpp \
+  /usr/include/boost/fusion/algorithm.hpp \
+  /usr/include/boost/fusion/algorithm/iteration.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/accumulate.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/accumulate_fwd.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/detail/for_each.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/iter_fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/reverse_fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/reverse_iter_fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/detail/segmented_fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/detail/segmented_for_each.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/fold_fwd.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/for_each.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/for_each_fwd.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/iter_fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/iter_fold_fwd.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/reverse_fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/reverse_fold_fwd.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/reverse_iter_fold.hpp \
+  /usr/include/boost/fusion/algorithm/iteration/reverse_iter_fold_fwd.hpp \
+  /usr/include/boost/fusion/algorithm/query.hpp \
+  /usr/include/boost/fusion/algorithm/query/all.hpp \
+  /usr/include/boost/fusion/algorithm/query/any.hpp \
+  /usr/include/boost/fusion/algorithm/query/count.hpp \
+  /usr/include/boost/fusion/algorithm/query/count_if.hpp \
+  /usr/include/boost/fusion/algorithm/query/detail/all.hpp \
+  /usr/include/boost/fusion/algorithm/query/detail/any.hpp \
+  /usr/include/boost/fusion/algorithm/query/detail/count.hpp \
+  /usr/include/boost/fusion/algorithm/query/detail/count_if.hpp \
+  /usr/include/boost/fusion/algorithm/query/detail/find_if.hpp \
+  /usr/include/boost/fusion/algorithm/query/detail/segmented_find.hpp \
+  /usr/include/boost/fusion/algorithm/query/detail/segmented_find_if.hpp \
+  /usr/include/boost/fusion/algorithm/query/find.hpp \
+  /usr/include/boost/fusion/algorithm/query/find_fwd.hpp \
+  /usr/include/boost/fusion/algorithm/query/find_if.hpp \
+  /usr/include/boost/fusion/algorithm/query/find_if_fwd.hpp \
+  /usr/include/boost/fusion/algorithm/query/none.hpp \
+  /usr/include/boost/fusion/algorithm/transformation.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/clear.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/detail/preprocessed/zip.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/detail/preprocessed/zip10.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/detail/replace.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/detail/replace_if.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/erase.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/erase_key.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/filter.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/filter_if.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/flatten.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/insert.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/insert_range.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/join.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/pop_back.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/pop_front.hpp \
   /usr/include/boost/fusion/algorithm/transformation/push_back.hpp \
   /usr/include/boost/fusion/algorithm/transformation/push_front.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/remove.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/remove_if.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/replace.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/replace_if.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/reverse.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/transform.hpp \
+  /usr/include/boost/fusion/algorithm/transformation/zip.hpp \
+  /usr/include/boost/fusion/container/deque/deque_fwd.hpp \
+  /usr/include/boost/fusion/container/generation/make_list.hpp \
   /usr/include/boost/fusion/container/generation/make_vector.hpp \
+  /usr/include/boost/fusion/container/list.hpp \
   /usr/include/boost/fusion/container/list/cons.hpp \
   /usr/include/boost/fusion/container/list/cons_fwd.hpp \
   /usr/include/boost/fusion/container/list/cons_iterator.hpp \
+  /usr/include/boost/fusion/container/list/convert.hpp \
   /usr/include/boost/fusion/container/list/detail/at_impl.hpp \
   /usr/include/boost/fusion/container/list/detail/begin_impl.hpp \
+  /usr/include/boost/fusion/container/list/detail/build_cons.hpp \
+  /usr/include/boost/fusion/container/list/detail/convert_impl.hpp \
   /usr/include/boost/fusion/container/list/detail/deref_impl.hpp \
   /usr/include/boost/fusion/container/list/detail/empty_impl.hpp \
   /usr/include/boost/fusion/container/list/detail/end_impl.hpp \
   /usr/include/boost/fusion/container/list/detail/equal_to_impl.hpp \
+  /usr/include/boost/fusion/container/list/detail/list_to_cons.hpp \
   /usr/include/boost/fusion/container/list/detail/next_impl.hpp \
   /usr/include/boost/fusion/container/list/detail/reverse_cons.hpp \
   /usr/include/boost/fusion/container/list/detail/value_at_impl.hpp \
   /usr/include/boost/fusion/container/list/detail/value_of_impl.hpp \
+  /usr/include/boost/fusion/container/list/list.hpp \
   /usr/include/boost/fusion/container/list/list_fwd.hpp \
   /usr/include/boost/fusion/container/list/nil.hpp \
+  /usr/include/boost/fusion/container/map/map_fwd.hpp \
+  /usr/include/boost/fusion/container/set/set_fwd.hpp \
+  /usr/include/boost/fusion/container/vector.hpp \
+  /usr/include/boost/fusion/container/vector/convert.hpp \
   /usr/include/boost/fusion/container/vector/detail/advance_impl.hpp \
+  /usr/include/boost/fusion/container/vector/detail/as_vector.hpp \
   /usr/include/boost/fusion/container/vector/detail/at_impl.hpp \
   /usr/include/boost/fusion/container/vector/detail/begin_impl.hpp \
   /usr/include/boost/fusion/container/vector/detail/config.hpp \
+  /usr/include/boost/fusion/container/vector/detail/convert_impl.hpp \
   /usr/include/boost/fusion/container/vector/detail/deref_impl.hpp \
   /usr/include/boost/fusion/container/vector/detail/distance_impl.hpp \
   /usr/include/boost/fusion/container/vector/detail/end_impl.hpp \
@@ -652,11 +746,13 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/fusion/container/vector/detail/value_at_impl.hpp \
   /usr/include/boost/fusion/container/vector/detail/value_of_impl.hpp \
   /usr/include/boost/fusion/container/vector/vector.hpp \
+  /usr/include/boost/fusion/container/vector/vector10.hpp \
   /usr/include/boost/fusion/container/vector/vector_fwd.hpp \
   /usr/include/boost/fusion/container/vector/vector_iterator.hpp \
   /usr/include/boost/fusion/functional/invocation/detail/that_ptr.hpp \
   /usr/include/boost/fusion/functional/invocation/invoke.hpp \
   /usr/include/boost/fusion/functional/invocation/limits.hpp \
+  /usr/include/boost/fusion/include/equal_to.hpp \
   /usr/include/boost/fusion/include/invoke.hpp \
   /usr/include/boost/fusion/iterator/advance.hpp \
   /usr/include/boost/fusion/iterator/deref.hpp \
@@ -671,8 +767,10 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/fusion/iterator/detail/segmented_next_impl.hpp \
   /usr/include/boost/fusion/iterator/distance.hpp \
   /usr/include/boost/fusion/iterator/equal_to.hpp \
+  /usr/include/boost/fusion/iterator/iterator_adapter.hpp \
   /usr/include/boost/fusion/iterator/iterator_facade.hpp \
   /usr/include/boost/fusion/iterator/key_of.hpp \
+  /usr/include/boost/fusion/iterator/mpl.hpp \
   /usr/include/boost/fusion/iterator/mpl/convert_iterator.hpp \
   /usr/include/boost/fusion/iterator/mpl/fusion_iterator.hpp \
   /usr/include/boost/fusion/iterator/next.hpp \
@@ -680,8 +778,29 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/fusion/iterator/segmented_iterator.hpp \
   /usr/include/boost/fusion/iterator/value_of.hpp \
   /usr/include/boost/fusion/iterator/value_of_data.hpp \
+  /usr/include/boost/fusion/mpl.hpp \
+  /usr/include/boost/fusion/mpl/at.hpp \
+  /usr/include/boost/fusion/mpl/back.hpp \
   /usr/include/boost/fusion/mpl/begin.hpp \
+  /usr/include/boost/fusion/mpl/clear.hpp \
+  /usr/include/boost/fusion/mpl/detail/clear.hpp \
+  /usr/include/boost/fusion/mpl/empty.hpp \
   /usr/include/boost/fusion/mpl/end.hpp \
+  /usr/include/boost/fusion/mpl/erase.hpp \
+  /usr/include/boost/fusion/mpl/erase_key.hpp \
+  /usr/include/boost/fusion/mpl/front.hpp \
+  /usr/include/boost/fusion/mpl/has_key.hpp \
+  /usr/include/boost/fusion/mpl/insert.hpp \
+  /usr/include/boost/fusion/mpl/insert_range.hpp \
+  /usr/include/boost/fusion/mpl/pop_back.hpp \
+  /usr/include/boost/fusion/mpl/pop_front.hpp \
+  /usr/include/boost/fusion/mpl/push_back.hpp \
+  /usr/include/boost/fusion/mpl/push_front.hpp \
+  /usr/include/boost/fusion/mpl/size.hpp \
+  /usr/include/boost/fusion/sequence/comparison/detail/equal_to.hpp \
+  /usr/include/boost/fusion/sequence/comparison/enable_comparison.hpp \
+  /usr/include/boost/fusion/sequence/comparison/equal_to.hpp \
+  /usr/include/boost/fusion/sequence/convert.hpp \
   /usr/include/boost/fusion/sequence/intrinsic/at.hpp \
   /usr/include/boost/fusion/sequence/intrinsic/begin.hpp \
   /usr/include/boost/fusion/sequence/intrinsic/detail/segmented_begin.hpp \
@@ -692,10 +811,12 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/fusion/sequence/intrinsic/empty.hpp \
   /usr/include/boost/fusion/sequence/intrinsic/end.hpp \
   /usr/include/boost/fusion/sequence/intrinsic/front.hpp \
+  /usr/include/boost/fusion/sequence/intrinsic/has_key.hpp \
   /usr/include/boost/fusion/sequence/intrinsic/segments.hpp \
   /usr/include/boost/fusion/sequence/intrinsic/size.hpp \
   /usr/include/boost/fusion/sequence/intrinsic/value_at.hpp \
   /usr/include/boost/fusion/sequence/intrinsic_fwd.hpp \
+  /usr/include/boost/fusion/support/as_const.hpp \
   /usr/include/boost/fusion/support/category_of.hpp \
   /usr/include/boost/fusion/support/config.hpp \
   /usr/include/boost/fusion/support/detail/access.hpp \
@@ -706,16 +827,35 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/fusion/support/detail/is_mpl_sequence.hpp \
   /usr/include/boost/fusion/support/detail/is_native_fusion_sequence.hpp \
   /usr/include/boost/fusion/support/detail/mpl_iterator_category.hpp \
+  /usr/include/boost/fusion/support/detail/pp_round.hpp \
   /usr/include/boost/fusion/support/detail/segmented_fold_until_impl.hpp \
   /usr/include/boost/fusion/support/is_iterator.hpp \
   /usr/include/boost/fusion/support/is_segmented.hpp \
   /usr/include/boost/fusion/support/is_sequence.hpp \
   /usr/include/boost/fusion/support/is_view.hpp \
   /usr/include/boost/fusion/support/iterator_base.hpp \
+  /usr/include/boost/fusion/support/segmented_fold_until.hpp \
   /usr/include/boost/fusion/support/sequence_base.hpp \
   /usr/include/boost/fusion/support/tag_of.hpp \
   /usr/include/boost/fusion/support/tag_of_fwd.hpp \
+  /usr/include/boost/fusion/support/unused.hpp \
   /usr/include/boost/fusion/support/void.hpp \
+  /usr/include/boost/fusion/view/detail/strictest_traversal.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/begin_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/deref_data_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/deref_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/end_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/equal_to_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/key_of_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/next_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/size_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/value_of_data_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/detail/value_of_impl.hpp \
+  /usr/include/boost/fusion/view/filter_view/filter_view.hpp \
+  /usr/include/boost/fusion/view/filter_view/filter_view_iterator.hpp \
+  /usr/include/boost/fusion/view/flatten_view.hpp \
+  /usr/include/boost/fusion/view/flatten_view/flatten_view.hpp \
+  /usr/include/boost/fusion/view/flatten_view/flatten_view_iterator.hpp \
   /usr/include/boost/fusion/view/iterator_range.hpp \
   /usr/include/boost/fusion/view/iterator_range/detail/at_impl.hpp \
   /usr/include/boost/fusion/view/iterator_range/detail/begin_impl.hpp \
@@ -726,6 +866,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/fusion/view/iterator_range/detail/size_impl.hpp \
   /usr/include/boost/fusion/view/iterator_range/detail/value_at_impl.hpp \
   /usr/include/boost/fusion/view/iterator_range/iterator_range.hpp \
+  /usr/include/boost/fusion/view/joint_view.hpp \
   /usr/include/boost/fusion/view/joint_view/detail/begin_impl.hpp \
   /usr/include/boost/fusion/view/joint_view/detail/deref_data_impl.hpp \
   /usr/include/boost/fusion/view/joint_view/detail/deref_impl.hpp \
@@ -737,6 +878,21 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/fusion/view/joint_view/joint_view.hpp \
   /usr/include/boost/fusion/view/joint_view/joint_view_fwd.hpp \
   /usr/include/boost/fusion/view/joint_view/joint_view_iterator.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/advance_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/at_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/begin_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/deref_data_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/deref_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/distance_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/end_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/key_of_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/next_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/prior_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/value_at_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/value_of_data_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/detail/value_of_impl.hpp \
+  /usr/include/boost/fusion/view/reverse_view/reverse_view.hpp \
+  /usr/include/boost/fusion/view/reverse_view/reverse_view_iterator.hpp \
   /usr/include/boost/fusion/view/single_view/detail/advance_impl.hpp \
   /usr/include/boost/fusion/view/single_view/detail/at_impl.hpp \
   /usr/include/boost/fusion/view/single_view/detail/begin_impl.hpp \
@@ -751,6 +907,36 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/fusion/view/single_view/detail/value_of_impl.hpp \
   /usr/include/boost/fusion/view/single_view/single_view.hpp \
   /usr/include/boost/fusion/view/single_view/single_view_iterator.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/advance_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/at_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/begin_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/deref_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/distance_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/end_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/equal_to_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/next_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/prior_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/value_at_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/detail/value_of_impl.hpp \
+  /usr/include/boost/fusion/view/transform_view/transform_view.hpp \
+  /usr/include/boost/fusion/view/transform_view/transform_view_fwd.hpp \
+  /usr/include/boost/fusion/view/transform_view/transform_view_iterator.hpp \
+  /usr/include/boost/fusion/view/zip_view.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/advance_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/at_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/begin_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/deref_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/distance_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/end_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/equal_to_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/next_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/prior_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/size_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/value_at_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/detail/value_of_impl.hpp \
+  /usr/include/boost/fusion/view/zip_view/zip_view.hpp \
+  /usr/include/boost/fusion/view/zip_view/zip_view_iterator.hpp \
+  /usr/include/boost/fusion/view/zip_view/zip_view_iterator_fwd.hpp \
   /usr/include/boost/get_pointer.hpp \
   /usr/include/boost/integer.hpp \
   /usr/include/boost/integer/common_factor_ct.hpp \
@@ -908,6 +1094,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/aux_/arity.hpp \
   /usr/include/boost/mpl/aux_/arity_spec.hpp \
   /usr/include/boost/mpl/aux_/at_impl.hpp \
+  /usr/include/boost/mpl/aux_/back_impl.hpp \
   /usr/include/boost/mpl/aux_/begin_end_impl.hpp \
   /usr/include/boost/mpl/aux_/clear_impl.hpp \
   /usr/include/boost/mpl/aux_/common_name_wknd.hpp \
@@ -941,6 +1128,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/aux_/config/workaround.hpp \
   /usr/include/boost/mpl/aux_/contains_impl.hpp \
   /usr/include/boost/mpl/aux_/empty_impl.hpp \
+  /usr/include/boost/mpl/aux_/erase_impl.hpp \
+  /usr/include/boost/mpl/aux_/erase_key_impl.hpp \
   /usr/include/boost/mpl/aux_/find_if_pred.hpp \
   /usr/include/boost/mpl/aux_/fold_impl.hpp \
   /usr/include/boost/mpl/aux_/fold_impl_body.hpp \
@@ -948,6 +1137,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/aux_/full_lambda.hpp \
   /usr/include/boost/mpl/aux_/has_apply.hpp \
   /usr/include/boost/mpl/aux_/has_begin.hpp \
+  /usr/include/boost/mpl/aux_/has_key_impl.hpp \
   /usr/include/boost/mpl/aux_/has_size.hpp \
   /usr/include/boost/mpl/aux_/has_tag.hpp \
   /usr/include/boost/mpl/aux_/has_type.hpp \
@@ -977,6 +1167,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/aux_/nttp_decl.hpp \
   /usr/include/boost/mpl/aux_/numeric_cast_utils.hpp \
   /usr/include/boost/mpl/aux_/numeric_op.hpp \
+  /usr/include/boost/mpl/aux_/pop_back_impl.hpp \
   /usr/include/boost/mpl/aux_/pop_front_impl.hpp \
   /usr/include/boost/mpl/aux_/preprocessor/add.hpp \
   /usr/include/boost/mpl/aux_/preprocessor/def_params_tail.hpp \
@@ -993,14 +1184,17 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/aux_/reverse_fold_impl.hpp \
   /usr/include/boost/mpl/aux_/reverse_fold_impl_body.hpp \
   /usr/include/boost/mpl/aux_/sequence_wrapper.hpp \
+  /usr/include/boost/mpl/aux_/single_element_iter.hpp \
   /usr/include/boost/mpl/aux_/size_impl.hpp \
   /usr/include/boost/mpl/aux_/static_cast.hpp \
   /usr/include/boost/mpl/aux_/template_arity.hpp \
   /usr/include/boost/mpl/aux_/template_arity_fwd.hpp \
   /usr/include/boost/mpl/aux_/traits_lambda_spec.hpp \
+  /usr/include/boost/mpl/aux_/transform_iter.hpp \
   /usr/include/boost/mpl/aux_/type_wrapper.hpp \
   /usr/include/boost/mpl/aux_/value_wknd.hpp \
   /usr/include/boost/mpl/aux_/yes_no.hpp \
+  /usr/include/boost/mpl/back.hpp \
   /usr/include/boost/mpl/back_fwd.hpp \
   /usr/include/boost/mpl/back_inserter.hpp \
   /usr/include/boost/mpl/begin.hpp \
@@ -1026,6 +1220,10 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/end.hpp \
   /usr/include/boost/mpl/equal.hpp \
   /usr/include/boost/mpl/equal_to.hpp \
+  /usr/include/boost/mpl/erase.hpp \
+  /usr/include/boost/mpl/erase_fwd.hpp \
+  /usr/include/boost/mpl/erase_key.hpp \
+  /usr/include/boost/mpl/erase_key_fwd.hpp \
   /usr/include/boost/mpl/eval_if.hpp \
   /usr/include/boost/mpl/find.hpp \
   /usr/include/boost/mpl/find_if.hpp \
@@ -1035,6 +1233,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/front_inserter.hpp \
   /usr/include/boost/mpl/greater.hpp \
   /usr/include/boost/mpl/greater_equal.hpp \
+  /usr/include/boost/mpl/has_key.hpp \
+  /usr/include/boost/mpl/has_key_fwd.hpp \
   /usr/include/boost/mpl/has_xxx.hpp \
   /usr/include/boost/mpl/identity.hpp \
   /usr/include/boost/mpl/if.hpp \
@@ -1086,6 +1286,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/long.hpp \
   /usr/include/boost/mpl/long_fwd.hpp \
   /usr/include/boost/mpl/max_element.hpp \
+  /usr/include/boost/mpl/min.hpp \
   /usr/include/boost/mpl/min_max.hpp \
   /usr/include/boost/mpl/minus.hpp \
   /usr/include/boost/mpl/multiplies.hpp \
@@ -1100,6 +1301,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/pair_view.hpp \
   /usr/include/boost/mpl/placeholders.hpp \
   /usr/include/boost/mpl/plus.hpp \
+  /usr/include/boost/mpl/pop_back.hpp \
   /usr/include/boost/mpl/pop_back_fwd.hpp \
   /usr/include/boost/mpl/pop_front.hpp \
   /usr/include/boost/mpl/pop_front_fwd.hpp \
@@ -1117,6 +1319,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/same_as.hpp \
   /usr/include/boost/mpl/sequence_tag.hpp \
   /usr/include/boost/mpl/sequence_tag_fwd.hpp \
+  /usr/include/boost/mpl/single_view.hpp \
   /usr/include/boost/mpl/size.hpp \
   /usr/include/boost/mpl/size_fwd.hpp \
   /usr/include/boost/mpl/size_t.hpp \
@@ -1125,6 +1328,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/tag.hpp \
   /usr/include/boost/mpl/times.hpp \
   /usr/include/boost/mpl/transform.hpp \
+  /usr/include/boost/mpl/transform_view.hpp \
+  /usr/include/boost/mpl/unpack_args.hpp \
   /usr/include/boost/mpl/vector.hpp \
   /usr/include/boost/mpl/vector/aux_/O1_size.hpp \
   /usr/include/boost/mpl/vector/aux_/at.hpp \
@@ -1149,6 +1354,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
   /usr/include/boost/mpl/vector/vector30.hpp \
   /usr/include/boost/mpl/void.hpp \
   /usr/include/boost/mpl/void_fwd.hpp \
+  /usr/include/boost/mpl/zip_view.hpp \
   /usr/include/boost/next_prior.hpp \
   /usr/include/boost/noncopyable.hpp \
   /usr/include/boost/numeric/conversion/bounds.hpp \
@@ -2292,27 +2498,37 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
 
 /usr/local/include/urcl/log.h:
 
+/usr/local/include/ur_rtde/rtde_receive_interface.h:
+
+/usr/local/include/ur_rtde/rtde_control_interface.h:
+
 /usr/local/include/ur_rtde/rtde.h:
 
 /usr/local/include/ur_rtde/robot_state.h:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/stdint.h:
+/usr/lib/gcc/x86_64-linux-gnu/11/include/syslimits.h:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/quadmath.h:
+/usr/lib/gcc/x86_64-linux-gnu/11/include/stdint.h:
 
 /usr/lib/gcc/x86_64-linux-gnu/11/include/mmintrin.h:
 
+/usr/lib/gcc/x86_64-linux-gnu/11/include/float.h:
+
+/usr/lib/gcc/x86_64-linux-gnu/11/include/emmintrin.h:
+
+/usr/include/x86_64-linux-gnu/sys/uio.h:
+
+/usr/include/x86_64-linux-gnu/sys/ucontext.h:
+
 /usr/include/x86_64-linux-gnu/sys/ttydefaults.h:
 
-/usr/include/x86_64-linux-gnu/sys/time.h:
+/usr/include/x86_64-linux-gnu/sys/timerfd.h:
 
 /usr/include/x86_64-linux-gnu/sys/stat.h:
 
-/usr/include/x86_64-linux-gnu/sys/select.h:
-
-/usr/include/x86_64-linux-gnu/sys/poll.h:
+/usr/include/x86_64-linux-gnu/sys/socket.h:
 
-/usr/include/x86_64-linux-gnu/sys/eventfd.h:
+/usr/include/x86_64-linux-gnu/sys/single_threaded.h:
 
 /usr/include/x86_64-linux-gnu/sys/epoll.h:
 
@@ -2320,4540 +2536,4942 @@ CMakeFiles/clik.dir/src/clik.cpp.o: /home/gospodar/lund/praxis/ur_simple_control
 
 /usr/include/x86_64-linux-gnu/gnu/stubs-64.h:
 
+/usr/include/x86_64-linux-gnu/c++/11/bits/time_members.h:
+
 /usr/include/x86_64-linux-gnu/c++/11/bits/os_defines.h:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/cxxabi_tweaks.h:
+/usr/include/x86_64-linux-gnu/c++/11/bits/opt_random.h:
+
+/usr/include/x86_64-linux-gnu/c++/11/bits/messages_members.h:
+
+/usr/include/x86_64-linux-gnu/c++/11/bits/error_constants.h:
+
+/usr/include/x86_64-linux-gnu/c++/11/bits/ctype_inline.h:
 
 /usr/include/x86_64-linux-gnu/c++/11/bits/ctype_base.h:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/cpu_defines.h:
+/usr/include/x86_64-linux-gnu/c++/11/bits/c++io.h:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/c++locale.h:
+/usr/include/x86_64-linux-gnu/c++/11/bits/c++config.h:
+
+/usr/include/x86_64-linux-gnu/c++/11/bits/c++allocator.h:
+
+/usr/include/x86_64-linux-gnu/c++/11/bits/basic_file.h:
 
 /usr/include/x86_64-linux-gnu/bits/wctype-wchar.h:
 
+/usr/include/x86_64-linux-gnu/bits/wchar2.h:
+
+/usr/include/x86_64-linux-gnu/bits/wchar.h:
+
+/usr/include/x86_64-linux-gnu/bits/waitstatus.h:
+
+/usr/include/x86_64-linux-gnu/bits/waitflags.h:
+
 /usr/include/x86_64-linux-gnu/bits/unistd_ext.h:
 
-/usr/include/x86_64-linux-gnu/bits/uio_lim.h:
+/usr/include/x86_64-linux-gnu/bits/uio-ext.h:
+
+/usr/include/x86_64-linux-gnu/bits/uintn-identity.h:
+
+/usr/include/x86_64-linux-gnu/bits/types/wint_t.h:
 
 /usr/include/x86_64-linux-gnu/bits/types/timer_t.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/time_t.h:
+/usr/include/x86_64-linux-gnu/bits/types/struct_timeval.h:
 
 /usr/include/x86_64-linux-gnu/bits/types/struct_timespec.h:
 
 /usr/include/x86_64-linux-gnu/bits/types/struct_statx_timestamp.h:
 
+/usr/include/x86_64-linux-gnu/bits/types/struct_statx.h:
+
+/usr/include/x86_64-linux-gnu/bits/types/struct_sigstack.h:
+
+/usr/include/x86_64-linux-gnu/bits/types/struct_sched_param.h:
+
 /usr/include/x86_64-linux-gnu/bits/types/struct_osockaddr.h:
 
 /usr/include/x86_64-linux-gnu/bits/types/struct_itimerspec.h:
 
 /usr/include/x86_64-linux-gnu/bits/types/struct_iovec.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/struct_FILE.h:
-
-/usr/include/x86_64-linux-gnu/bits/types/stack_t.h:
+/usr/include/x86_64-linux-gnu/bits/types/struct___jmp_buf_tag.h:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/atomic_word.h:
+/usr/include/x86_64-linux-gnu/bits/types/sigset_t.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/siginfo_t.h:
+/usr/include/x86_64-linux-gnu/bits/types/sigevent_t.h:
 
 /usr/include/x86_64-linux-gnu/bits/types/sig_atomic_t.h:
 
+/usr/include/x86_64-linux-gnu/bits/types/locale_t.h:
+
 /usr/include/x86_64-linux-gnu/bits/types/cookie_io_functions_t.h:
 
+/usr/include/x86_64-linux-gnu/bits/types/clockid_t.h:
+
+/usr/include/x86_64-linux-gnu/bits/types/__sigval_t.h:
+
 /usr/include/x86_64-linux-gnu/bits/types/__sigset_t.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/__mbstate_t.h:
+/usr/include/x86_64-linux-gnu/bits/types/__locale_t.h:
 
 /usr/include/x86_64-linux-gnu/bits/types/__fpos_t.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/__fpos64_t.h:
+/usr/include/x86_64-linux-gnu/bits/types/__FILE.h:
 
-/usr/include/x86_64-linux-gnu/bits/timex.h:
+/usr/include/x86_64-linux-gnu/bits/types/FILE.h:
 
-/usr/include/x86_64-linux-gnu/bits/struct_stat.h:
+/usr/include/x86_64-linux-gnu/bits/types.h:
 
-/usr/include/x86_64-linux-gnu/bits/struct_mutex.h:
+/usr/include/x86_64-linux-gnu/bits/timesize.h:
 
-/usr/include/x86_64-linux-gnu/bits/stdlib.h:
+/usr/include/x86_64-linux-gnu/bits/timerfd.h:
 
-/usr/include/x86_64-linux-gnu/bits/stdlib-bsearch.h:
+/usr/include/x86_64-linux-gnu/bits/time64.h:
 
-/usr/include/x86_64-linux-gnu/bits/stdio_lim.h:
+/usr/include/x86_64-linux-gnu/bits/time.h:
 
-/usr/include/x86_64-linux-gnu/bits/statx-generic.h:
+/usr/include/x86_64-linux-gnu/bits/thread-shared-types.h:
 
-/usr/include/x86_64-linux-gnu/bits/stat.h:
+/usr/include/x86_64-linux-gnu/bits/struct_stat.h:
 
-/usr/include/x86_64-linux-gnu/bits/sigstack.h:
+/usr/include/x86_64-linux-gnu/bits/struct_rwlock.h:
 
-/usr/include/x86_64-linux-gnu/bits/signum-generic.h:
+/usr/include/x86_64-linux-gnu/bits/strings_fortified.h:
 
-/usr/include/x86_64-linux-gnu/bits/signum-arch.h:
+/usr/include/x86_64-linux-gnu/bits/string_fortified.h:
 
-/usr/include/x86_64-linux-gnu/bits/siginfo-consts.h:
+/usr/include/x86_64-linux-gnu/bits/stdlib-float.h:
 
-/usr/include/x86_64-linux-gnu/bits/siginfo-consts-arch.h:
+/usr/include/x86_64-linux-gnu/bits/stdio.h:
 
-/usr/include/x86_64-linux-gnu/bits/sigevent-consts.h:
+/usr/include/x86_64-linux-gnu/bits/stdint-intn.h:
 
-/usr/include/x86_64-linux-gnu/bits/sigaction.h:
+/usr/include/x86_64-linux-gnu/bits/statx-generic.h:
 
-/usr/include/x86_64-linux-gnu/bits/setjmp.h:
+/usr/include/x86_64-linux-gnu/bits/stat.h:
 
-/usr/include/x86_64-linux-gnu/bits/pthreadtypes-arch.h:
+/usr/include/x86_64-linux-gnu/bits/ss_flags.h:
 
-/usr/local/include/ur_rtde/rtde_export.h:
+/usr/include/x86_64-linux-gnu/bits/sockaddr.h:
 
-/usr/include/x86_64-linux-gnu/bits/pthread_stack_min-dynamic.h:
+/usr/include/x86_64-linux-gnu/bits/sigthread.h:
 
-/usr/include/x86_64-linux-gnu/bits/posix2_lim.h:
+/usr/include/x86_64-linux-gnu/bits/sigstksz.h:
 
-/usr/include/x86_64-linux-gnu/bits/posix1_lim.h:
+/usr/include/x86_64-linux-gnu/bits/sigstack.h:
 
-/usr/include/x86_64-linux-gnu/bits/poll2.h:
+/usr/include/boost/serialization/assume_abstract.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/poll.h:
+/usr/include/boost/mpl/aux_/config/eti.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/netdb.h:
+/usr/include/boost/preprocessor/tuple/elem.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/long-double.h:
+/usr/include/boost/mpl/aux_/config/dtp.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/local_lim.h:
+/usr/include/boost/utility.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/libc-header-start.h:
+/usr/include/boost/mpl/list/aux_/empty.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/ioctls.h:
+/usr/include/boost/mpl/aux_/config/adl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/in.h:
+/usr/include/boost/mpl/aux_/at_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/getopt_posix.h:
+/usr/include/boost/container/container_fwd.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/getopt_core.h:
+/usr/include/boost/fusion/view/joint_view/detail/deref_data_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/floatn.h:
+/usr/include/boost/mpl/joint_view.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/fcntl.h:
+/usr/include/boost/mpl/aux_/adl_barrier.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/fcntl-linux.h:
+/usr/include/boost/fusion/mpl/end.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/eventfd.h:
+/usr/include/boost/mpl/aux_/O1_size_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/errno.h:
+/usr/include/boost/mpl/aux_/config/forwarding.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/endianness.h:
+/usr/include/boost/type_index/type_index_facade.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/endian.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/Tensor.h:
 
-/usr/include/x86_64-linux-gnu/bits/confname.h:
+/usr/include/boost/mpl/at.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/byteswap.h:
+/usr/include/boost/fusion/sequence/convert.hpp:
 
-/usr/include/x86_64-linux-gnu/asm/posix_types_64.h:
+/usr/include/boost/type_traits/is_constructible.hpp:
 
-/usr/include/x86_64-linux-gnu/asm/ioctls.h:
+/usr/include/boost/iostreams/detail/streambuf.hpp:
 
-/usr/include/x86_64-linux-gnu/asm/ioctl.h:
+/usr/include/boost/mpl/and.hpp:
 
-/usr/include/x86_64-linux-gnu/asm/errno.h:
+/usr/include/boost/move/utility_core.hpp:
 
-/usr/include/x86_64-linux-gnu/sys/socket.h:
+/usr/include/boost/asio/async_result.hpp:
 
-/usr/include/x86_64-linux-gnu/asm/bitsperlong.h:
+/usr/include/boost/move/utility.hpp:
 
-/usr/include/strings.h:
+/usr/include/boost/move/detail/type_traits.hpp:
 
-/usr/include/stdc-predef.h:
+/usr/include/boost/date_time/gregorian/greg_day.hpp:
 
-/usr/include/sched.h:
+/usr/include/boost/mpl/aux_/config/gpu.hpp:
 
-/usr/include/pthread.h:
+/usr/include/boost/math/tools/promotion.hpp:
 
-/usr/include/netinet/in.h:
+/usr/include/boost/fusion/mpl/push_front.hpp:
 
-/usr/include/netdb.h:
+/usr/include/c++/11/version:
 
-/usr/include/math.h:
+/usr/include/boost/math/tools/precision.hpp:
 
-/usr/include/linux/version.h:
+/usr/include/boost/asio/detail/tss_ptr.hpp:
 
-/usr/include/linux/types.h:
+/usr/include/boost/math/tools/cxx03_warn.hpp:
 
-/usr/include/linux/limits.h:
+/usr/include/boost/math/tools/convert_from_string.hpp:
 
-/usr/include/linux/falloc.h:
+/usr/include/boost/type_traits/is_assignable.hpp:
 
-/usr/include/libintl.h:
+/usr/include/boost/fusion/algorithm/transformation/erase_key.hpp:
 
-/usr/include/features-time64.h:
+/usr/include/boost/math/special_functions/math_fwd.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/epoll.h:
+/usr/include/boost/math/tools/user.hpp:
 
-/usr/include/fcntl.h:
+/usr/include/boost/math/special_functions/detail/round_fwd.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsHalf.h:
+/usr/include/boost/preprocessor/repetition/enum_shifted_params.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsFunctors.h:
+/usr/include/boost/math/policies/policy.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsBFloat16.h:
+/usr/include/boost/smart_ptr/make_shared_array.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsFunctors.h:
+/usr/include/c++/11/bits/basic_ios.tcc:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsArrayAPI.h:
+/usr/include/boost/fusion/algorithm/transformation/flatten.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/util/MaxSizeVector.h:
+/usr/include/boost/is_placeholder.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/util/CXX11Workarounds.h:
+/usr/include/boost/lexical_cast/bad_lexical_cast.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/util/CXX11Meta.h:
+/usr/include/boost/iterator/detail/config_undef.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorTrace.h:
+/usr/include/boost/mpl/placeholders.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorScan.h:
+/usr/include/boost/mpl/list/list20.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorRef.h:
+/usr/include/boost/iostreams/seek.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorReductionGpu.h:
+/usr/include/boost/iostreams/pipeline.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorTraits.h:
+/usr/include/boost/iostreams/input_sequence.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorReduction.h:
+/usr/include/boost/mpl/aux_/reverse_fold_impl.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorRandom.h:
+/usr/include/boost/iostreams/get.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorPadding.h:
+/usr/include/boost/preprocessor/seq/rest_n.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorMeta.h:
+/usr/include/boost/iterator/advance.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorLayoutSwap.h:
+/usr/include/boost/iostreams/put.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorInitializer.h:
+/usr/include/boost/iostreams/device/null.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorImagePatch.h:
+/usr/include/boost/iostreams/detail/select_by_size.hpp:
 
-/usr/include/stdlib.h:
+/usr/include/boost/asio/detail/is_executor.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorIO.h:
+/usr/include/boost/iterator/iterator_adaptor.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorGlobalFunctions.h:
+/usr/include/asm-generic/posix_types.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorFunctors.h:
+/usr/include/boost/mpl/aux_/erase_impl.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorForwardDeclarations.h:
+/usr/include/boost/iostreams/detail/resolve.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorFFT.h:
+/usr/include/boost/iostreams/detail/functional.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorEvaluator.h:
+/usr/include/c++/11/bits/concept_check.h:
 
-/usr/include/linux/ioctl.h:
+/usr/include/boost/iostreams/detail/error.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDimensions.h:
+/usr/include/boost/asio/streambuf.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDeviceThreadPool.h:
+/usr/include/boost/iostreams/detail/default_arg.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDeviceSycl.h:
+/usr/include/boost/iostreams/detail/config/unreachable_return.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDevice.h:
+/usr/include/boost/variant/detail/apply_visitor_delayed.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorCostModel.h:
+/usr/include/boost/asio/ip/tcp.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContractionThreadPool.h:
+/usr/include/boost/iostreams/detail/config/enable_warnings.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContractionMapper.h:
+/usr/include/c++/11/cassert:
 
-/usr/include/x86_64-linux-gnu/bits/stdint-intn.h:
+/usr/include/boost/iostreams/detail/config/codecvt.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorBroadcasting.h:
+/usr/include/boost/iostreams/detail/char_traits.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorBlock.h:
+/usr/include/c++/11/bits/basic_ios.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorAssign.h:
+/usr/include/boost/iostreams/detail/call_traits.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/Tensor:
+/usr/include/boost/lexical_cast/detail/lcast_unsigned_converters.hpp:
 
-/usr/include/eigen3/Eigen/src/plugins/ReshapedMethods.h:
+/usr/include/boost/assert.hpp:
 
-/usr/include/eigen3/Eigen/src/plugins/MatrixCwiseBinaryOps.h:
+/usr/include/boost/iostreams/detail/adapter/range_adapter.hpp:
 
-/usr/include/eigen3/Eigen/src/plugins/IndexedViewMethods.h:
+/usr/include/boost/date_time/c_time.hpp:
 
-/usr/include/eigen3/Eigen/src/plugins/CommonCwiseBinaryOps.h:
+/usr/include/boost/asio/ip/impl/basic_endpoint.hpp:
 
-/usr/include/linux/posix_types.h:
+/usr/include/boost/date_time/date_generators.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDimensionList.h:
+/usr/include/eigen3/Eigen/src/Core/functors/TernaryFunctors.h:
 
-/usr/include/eigen3/Eigen/src/plugins/ArrayCwiseUnaryOps.h:
+/usr/include/boost/iostreams/detail/adapter/mode_adapter.hpp:
 
-/usr/include/eigen3/Eigen/src/plugins/ArrayCwiseBinaryOps.h:
+/usr/include/boost/preprocessor/repetition/detail/for.hpp:
 
-/usr/include/eigen3/Eigen/src/misc/Kernel.h:
+/usr/include/boost/iostreams/categories.hpp:
 
-/usr/include/eigen3/Eigen/src/StlSupport/StdVector.h:
+/usr/include/boost/mpl/aux_/common_name_wknd.hpp:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/stdarg.h:
+/usr/include/boost/variant/detail/backup_holder.hpp:
 
-/usr/include/eigen3/Eigen/src/SVD/JacobiSVD.h:
+/usr/include/boost/integer/static_min_max.hpp:
 
-/usr/include/eigen3/Eigen/src/SVD/BDCSVD.h:
+/usr/include/boost/get_pointer.hpp:
 
-/usr/include/eigen3/Eigen/src/QR/FullPivHouseholderQR.h:
+/usr/include/boost/preprocessor/repeat.hpp:
 
-/usr/include/eigen3/Eigen/src/QR/CompleteOrthogonalDecomposition.h:
+/usr/include/boost/fusion/view/zip_view/detail/value_of_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/LU/PartialPivLU.h:
+/usr/include/boost/fusion/view/zip_view/detail/next_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/sys/ioctl.h:
+/usr/include/boost/fusion/view/transform_view/transform_view.hpp:
 
-/usr/include/eigen3/Eigen/src/LU/InverseImpl.h:
+/usr/include/boost/fusion/view/transform_view/detail/value_of_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/LU/Determinant.h:
+/usr/include/boost/math/constants/constants.hpp:
 
-/usr/include/eigen3/Eigen/src/Jacobi/Jacobi.h:
+/usr/include/boost/fusion/view/transform_view/detail/prior_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Householder/HouseholderSequence.h:
+/usr/include/boost/serialization/split_member.hpp:
 
-/usr/include/eigen3/Eigen/src/Householder/BlockHouseholder.h:
+/usr/include/boost/lexical_cast/try_lexical_convert.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/arch/Geometry_SIMD.h:
+/usr/include/c++/11/bits/std_mutex.h:
 
-/usr/include/eigen3/Eigen/src/Geometry/Transform.h:
+/usr/include/boost/concept/detail/concept_undef.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/Scaling.h:
+/usr/include/boost/fusion/view/transform_view/detail/end_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/RotationBase.h:
+/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-base.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/Rotation2D.h:
+/usr/include/boost/predef/os/bsd.h:
 
-/usr/include/eigen3/Eigen/src/Geometry/AngleAxis.h:
+/usr/include/boost/mpl/aux_/config/has_apply.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/AlignedBox.h:
+/usr/include/boost/range/detail/sfinae.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/Tridiagonalization.h:
+/usr/include/boost/fusion/view/single_view/detail/next_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/SelfAdjointEigenSolver.h:
+/usr/include/boost/preprocessor/tuple/detail/is_single_return.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/RealSchur.h:
+/usr/include/boost/fusion/view/single_view/detail/deref_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/RealQZ.h:
+/usr/include/boost/fusion/view/single_view/detail/begin_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/MatrixBaseEigenvalues.h:
+/usr/include/boost/range/reverse_iterator.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/GeneralizedEigenSolver.h:
+/usr/include/boost/fusion/view/single_view/detail/at_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/sys/cdefs.h:
+/usr/include/boost/fusion/view/reverse_view/detail/prior_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/ComplexSchur.h:
+/usr/include/boost/asio/execution/invocable_archetype.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/ComplexEigenSolver.h:
+/usr/include/boost/fusion/view/joint_view/detail/next_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/XprHelper.h:
+/usr/include/boost/fusion/view/joint_view/detail/end_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/SymbolicIndex.h:
+/usr/include/boost/iterator/detail/enable_if.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/StaticAssert.h:
+/usr/include/boost/asio/associated_executor.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/MKL_support.h:
+/usr/include/linux/stddef.h:
 
-/usr/local/include/ur_rtde/rtde_receive_interface.h:
+/usr/include/boost/fusion/view/iterator_range/detail/size_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/IntegralConstant.h:
+/usr/include/boost/detail/workaround.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/Homogeneous.h:
+/usr/include/boost/fusion/view/iterator_range.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/Constants.h:
+/usr/include/x86_64-linux-gnu/bits/xopen_lim.h:
 
-/usr/include/x86_64-linux-gnu/bits/libm-simd-decl-stubs.h:
+/usr/include/boost/fusion/view/flatten_view/flatten_view_iterator.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/TriangularMatrixVector.h:
+/usr/include/boost/fusion/view/filter_view/detail/next_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/SelfadjointRank2Update.h:
+/usr/include/boost/asio/traits/query_member.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/SelfadjointMatrixMatrix.h:
+/usr/include/boost/mpl/vector/vector20.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/GeneralBlockPanelKernel.h:
+/usr/include/boost/fusion/view/filter_view/detail/equal_to_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/functors/StlFunctors.h:
+/usr/include/boost/asio/execution/bulk_execute.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorStorage.h:
+/usr/include/boost/mpl/aux_/numeric_cast_utils.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/SSE/PacketMath.h:
+/usr/include/boost/preprocessor/identity.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/SSE/MathFunctions.h:
+/usr/include/boost/fusion/view/detail/strictest_traversal.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/SSE/Complex.h:
+/usr/include/boost/asio/handler_invoke_hook.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/Default/GenericPacketMathFunctions.h:
+/usr/include/x86_64-linux-gnu/asm/types.h:
 
-/usr/include/eigen3/Eigen/src/Core/VectorwiseOp.h:
+/usr/include/boost/fusion/support/unused.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/VectorBlock.h:
+/usr/include/boost/fusion/support/segmented_fold_until.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/TriangularMatrix.h:
+/usr/include/eigen3/Eigen/src/Eigenvalues/ComplexSchur.h:
 
-/usr/include/x86_64-linux-gnu/bits/wchar2.h:
+/usr/include/boost/fusion/support/iterator_base.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/wint_t.h:
+/usr/include/boost/fusion/support/is_sequence.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Transpositions.h:
+/usr/include/boost/fusion/support/is_iterator.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Swap.h:
+/usr/include/boost/function_types/config/cc_names.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Stride.h:
+/usr/include/boost/fusion/adapted/mpl/detail/has_key_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/StlIterators.h:
+/usr/include/boost/move/core.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/StableNorm.h:
+/usr/include/boost/fusion/support/detail/index_sequence.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/SolveTriangular.h:
+/usr/include/boost/type_traits/copy_cv_ref.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Select.h:
+/usr/include/boost/fusion/support/detail/enabler.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Reshaped.h:
+/usr/include/boost/mpl/aux_/inserter_algorithm.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Replicate.h:
+/opt/openrobots/include/pinocchio/core/unary-op.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/waitstatus.h:
+/usr/include/string.h:
 
-/usr/include/eigen3/Eigen/src/Geometry/EulerAngles.h:
+/usr/include/x86_64-linux-gnu/bits/floatn.h:
 
-/usr/include/eigen3/Eigen/src/Core/Ref.h:
+/usr/include/boost/fusion/support/as_const.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/thread-shared-types.h:
+/usr/include/boost/mpl/O1_size.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/ProductEvaluators.h:
+/usr/include/c++/11/bits/stl_iterator_base_types.h:
 
-/usr/include/eigen3/Eigen/src/Core/Product.h:
+/usr/include/boost/fusion/sequence/intrinsic_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/PlainObjectBase.h:
+/usr/include/boost/fusion/sequence/intrinsic/value_at.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContractionBlocking.h:
+/usr/include/boost/fusion/iterator/iterator_facade.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/MathFunctionsImpl.h:
+/usr/include/boost/preprocessor/control/if.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/MathFunctions.h:
+/usr/include/boost/asio/traits/connect_free.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Inverse.h:
+/usr/include/boost/fusion/sequence/intrinsic/end.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/IndexedView.h:
+/usr/include/boost/move/detail/meta_utils_core.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/GlobalFunctions.h:
+/usr/include/boost/lexical_cast/detail/converter_lexical.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/Meta.h:
+/usr/include/boost/fusion/sequence/intrinsic/empty.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Fuzzy.h:
+/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_end_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/DiagonalMatrix.h:
+/usr/include/boost/fusion/include/equal_to.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/DenseCoeffsBase.h:
+/usr/include/boost/fusion/container/list.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/DenseBase.h:
+/usr/include/boost/preprocessor/slot/detail/def.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/CwiseTernaryOp.h:
+/usr/include/boost/fusion/sequence/intrinsic/at.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/CwiseNullaryOp.h:
+/usr/include/boost/fusion/view/filter_view/detail/begin_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/CoreIterators.h:
+/usr/include/boost/asio/ip/basic_resolver_results.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/ConditionEstimator.h:
+/usr/include/boost/mpl/aux_/config/bind.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/CommaInitializer.h:
+/usr/include/boost/fusion/sequence/comparison/enable_comparison.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Assign.h:
+/usr/include/x86_64-linux-gnu/bits/socket_type.h:
 
-/usr/include/eigen3/Eigen/src/Core/ArrayWrapper.h:
+/usr/include/boost/fusion/sequence/comparison/equal_to.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/ArithmeticSequence.h:
+/usr/include/boost/mpl/arg_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Cholesky/LLT.h:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-revolute-unaligned.hpp:
 
-/usr/include/eigen3/Eigen/StdVector:
+/usr/include/boost/move/detail/meta_utils.hpp:
 
-/usr/include/eigen3/Eigen/QR:
+/usr/include/boost/archive/detail/abi_suffix.hpp:
 
-/usr/include/eigen3/Eigen/LU:
+/usr/include/boost/fusion/view/zip_view/detail/end_impl.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorExpr.h:
+/usr/include/boost/mpl/list/aux_/O1_size.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Diagonal.h:
+/usr/include/boost/fusion/mpl/has_key.hpp:
 
-/usr/include/eigen3/Eigen/Jacobi:
+/usr/include/x86_64-linux-gnu/bits/stdlib-bsearch.h:
 
-/usr/include/eigen3/Eigen/Householder:
+/usr/include/boost/fusion/mpl/erase_key.hpp:
 
-/usr/include/eigen3/Eigen/Geometry:
+/usr/include/boost/preprocessor/variadic/size.hpp:
 
-/usr/include/c++/11/utility:
+/usr/include/stdint.h:
 
-/usr/include/c++/11/tuple:
+/usr/include/boost/fusion/mpl/detail/clear.hpp:
 
-/usr/include/c++/11/thread:
+/opt/openrobots/include/pinocchio/parsers/urdf/model.hxx:
 
-/usr/include/c++/11/system_error:
+/usr/include/boost/fusion/mpl.hpp:
 
-/usr/include/c++/11/sstream:
+/usr/include/boost/fusion/iterator/value_of_data.hpp:
 
-/usr/include/c++/11/ratio:
+/usr/include/boost/iostreams/detail/config/disable_warnings.hpp:
 
-/usr/include/c++/11/random:
+/usr/include/boost/asio/detail/timer_queue_ptime.hpp:
 
-/usr/include/c++/11/numeric:
+/usr/include/boost/fusion/iterator/segmented_iterator.hpp:
 
-/usr/include/c++/11/mutex:
+/usr/include/boost/mpl/list/aux_/pop_front.hpp:
 
-/usr/include/c++/11/math.h:
+/usr/include/boost/fusion/iterator/prior.hpp:
 
-/usr/include/c++/11/map:
+/usr/include/boost/fusion/algorithm/transformation/insert_range.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsPacketMath.h:
+/usr/include/boost/asio/detail/posix_global.hpp:
 
-/usr/include/c++/11/list:
+/usr/include/boost/fusion/algorithm/transformation/pop_back.hpp:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/float.h:
+/usr/include/c++/11/backward/auto_ptr.h:
 
-/usr/include/c++/11/iterator:
+/usr/include/boost/fusion/iterator/detail/segmented_equal_to.hpp:
 
-/usr/include/c++/11/istream:
+/usr/include/boost/mpl/apply_fwd.hpp:
 
-/usr/include/c++/11/ios:
+/usr/include/boost/asio/detail/reactive_null_buffers_op.hpp:
 
-/usr/include/c++/11/iomanip:
+/usr/include/boost/fusion/iterator/detail/segment_sequence.hpp:
 
-/usr/include/eigen3/Eigen/src/SVD/UpperBidiagonalization.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorMorphing.h:
 
-/usr/include/c++/11/ext/type_traits.h:
+/usr/include/boost/functional/hash_fwd.hpp:
 
-/usr/include/linux/close_range.h:
+/usr/include/boost/date_time/locale_config.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/BandMatrix.h:
+/usr/include/boost/mpl/aux_/has_type.hpp:
 
-/usr/include/c++/11/ext/string_conversions.h:
+/usr/include/boost/fusion/iterator/detail/distance.hpp:
 
-/usr/include/c++/11/ext/numeric_traits.h:
+/usr/include/rpc/netdb.h:
 
-/usr/include/c++/11/ext/new_allocator.h:
+/usr/include/boost/mpl/aux_/config/ctps.hpp:
 
-/usr/include/c++/11/ext/aligned_buffer.h:
+/usr/include/boost/fusion/view/single_view/detail/prior_impl.hpp:
 
-/usr/include/c++/11/experimental/string_view:
+/usr/include/boost/smart_ptr/detail/sp_nullptr_t.hpp:
 
-/usr/include/c++/11/experimental/bits/string_view.tcc:
+/usr/include/boost/fusion/functional/invocation/limits.hpp:
 
-/usr/include/c++/11/debug/debug.h:
+/usr/include/boost/fusion/view/transform_view/detail/equal_to_impl.hpp:
 
-/usr/include/c++/11/debug/assertions.h:
+/usr/include/boost/fusion/container/vector/vector_fwd.hpp:
 
-/usr/include/c++/11/cxxabi.h:
+/usr/include/boost/fusion/container/vector/detail/value_at_impl.hpp:
 
-/usr/include/c++/11/initializer_list:
+/usr/include/boost/iostreams/detail/dispatch.hpp:
 
-/usr/include/c++/11/cwchar:
+/usr/include/boost/fusion/container/vector/detail/next_impl.hpp:
 
-/usr/include/c++/11/cstdarg:
+/usr/include/boost/fusion/iterator/mpl/convert_iterator.hpp:
 
-/usr/include/c++/11/clocale:
+/usr/include/boost/mpl/list/list10.hpp:
 
-/usr/include/c++/11/climits:
+/usr/include/boost/smart_ptr/detail/sp_counted_base_gcc_atomic.hpp:
 
-/usr/include/c++/11/cinttypes:
+/usr/include/boost/mpl/aux_/begin_end_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/struct_tm.h:
+/usr/include/boost/fusion/container/vector/detail/config.hpp:
 
-/usr/include/c++/11/cerrno:
+/usr/include/boost/fusion/iterator/detail/segmented_iterator.hpp:
 
-/usr/include/c++/11/bits/uses_allocator.h:
+/usr/include/boost/fusion/container/vector/detail/begin_impl.hpp:
 
-/usr/include/c++/11/bits/uniform_int_dist.h:
+/usr/include/boost/fusion/container/vector/detail/at_impl.hpp:
 
-/usr/include/c++/11/bits/stringfwd.h:
+/usr/include/c++/11/cwctype:
 
-/usr/include/c++/11/bits/streambuf_iterator.h:
+/usr/include/boost/fusion/container/vector/detail/as_vector.hpp:
 
-/usr/include/c++/11/bits/streambuf.tcc:
+/usr/include/x86_64-linux-gnu/bits/sigaction.h:
 
-/usr/include/c++/11/bits/stl_vector.h:
+/usr/include/boost/mpl/less_equal.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/Umeyama.h:
+/usr/include/boost/fusion/container/list/nil.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/functors/UnaryFunctors.h:
+/usr/include/boost/asio/steady_timer.hpp:
 
-/usr/include/c++/11/bits/stl_uninitialized.h:
+/usr/include/boost/preprocessor/control/expr_iif.hpp:
 
-/usr/include/c++/11/bits/stl_tree.h:
+/usr/include/boost/variant/detail/substitute_fwd.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorGenerator.h:
+/usr/include/boost/fusion/sequence/intrinsic/segments.hpp:
 
-/usr/include/c++/11/bits/stl_tempbuf.h:
+/usr/include/boost/fusion/container/list/detail/value_of_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/plugins/CommonCwiseUnaryOps.h:
+/usr/include/boost/fusion/container/list/detail/list_to_cons.hpp:
 
-/usr/include/c++/11/bits/stl_raw_storage_iter.h:
+/usr/include/boost/fusion/container/list/detail/empty_impl.hpp:
 
-/usr/include/c++/11/bits/stl_multiset.h:
+/opt/openrobots/include/pinocchio/spatial/explog-quaternion.hpp:
 
-/usr/include/c++/11/bits/stl_map.h:
+/usr/include/boost/variant/detail/cast_storage.hpp:
 
-/usr/include/c++/11/bits/stl_list.h:
+/usr/include/boost/fusion/container/list/detail/deref_impl.hpp:
 
-/usr/include/c++/11/bits/stl_function.h:
+/usr/include/arpa/inet.h:
 
-/usr/include/c++/11/bits/stl_construct.h:
+/usr/include/boost/fusion/algorithm/transformation/transform.hpp:
 
-/usr/include/c++/11/bits/stl_bvector.h:
+/usr/include/boost/iostreams/constants.hpp:
 
-/usr/include/c++/11/bits/stl_algobase.h:
+/usr/include/boost/iostreams/detail/push_params.hpp:
 
-/usr/include/eigen3/Eigen/Core:
+/usr/include/boost/fusion/container/list/detail/convert_impl.hpp:
 
-/usr/include/c++/11/bits/stl_algo.h:
+/usr/include/boost/fusion/container/list/detail/at_impl.hpp:
 
-/usr/include/c++/11/bits/std_thread.h:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-model-base.hpp:
 
-/usr/include/c++/11/bits/std_abs.h:
+/usr/include/boost/iostreams/close.hpp:
 
-/usr/include/features.h:
+/usr/include/boost/fusion/container/generation/make_list.hpp:
 
-/usr/include/c++/11/cstdio:
+/usr/include/boost/cerrno.hpp:
 
-/usr/include/c++/11/bits/shared_ptr_base.h:
+/usr/include/boost/fusion/algorithm/transformation/reverse.hpp:
 
-/usr/include/c++/11/bits/shared_ptr_atomic.h:
+/usr/include/boost/function_types/is_member_pointer.hpp:
 
-/usr/include/c++/11/bits/shared_ptr.h:
+/usr/include/boost/fusion/view/zip_view/detail/equal_to_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/ReturnByValue.h:
+/usr/include/boost/smart_ptr/detail/local_counted_base.hpp:
 
-/usr/include/c++/11/bits/refwrap.h:
+/usr/include/boost/fusion/algorithm/transformation/replace_if.hpp:
 
-/usr/include/c++/11/bits/ranges_base.h:
+/usr/include/c++/11/random:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/stddef.h:
+/usr/include/boost/fusion/algorithm/transformation/push_back.hpp:
 
-/usr/include/c++/11/bits/random.h:
+/usr/include/boost/fusion/algorithm/transformation/pop_front.hpp:
 
-/usr/include/limits.h:
+/usr/include/boost/fusion/algorithm/transformation/insert.hpp:
 
-/usr/include/c++/11/bits/quoted_string.h:
+/usr/include/boost/fusion/algorithm/transformation/filter_if.hpp:
 
-/usr/include/c++/11/bits/ptr_traits.h:
+/usr/include/boost/fusion/algorithm/transformation/filter.hpp:
 
-/usr/include/eigen3/Eigen/Dense:
+/usr/include/boost/fusion/algorithm/transformation/erase.hpp:
 
-/usr/include/c++/11/bits/nested_exception.h:
+/usr/include/boost/preprocessor/iteration/iterate.hpp:
 
-/usr/include/c++/11/bits/move.h:
+/opt/openrobots/include/pinocchio/utils/helpers.hpp:
 
-/usr/include/c++/11/bits/localefwd.h:
+/usr/include/boost/fusion/algorithm/transformation/detail/replace.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/sigset_t.h:
+/usr/include/x86_64-linux-gnu/bits/netdb.h:
 
-/usr/include/c++/11/bits/locale_facets_nonio.h:
+/usr/include/boost/fusion/view/reverse_view/detail/distance_impl.hpp:
 
-/usr/include/c++/11/bits/locale_facets.tcc:
+/usr/include/boost/fusion/algorithm/transformation/detail/preprocessed/zip.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/Default/BFloat16.h:
+/usr/include/boost/fusion/algorithm/transformation.hpp:
 
-/usr/include/c++/11/bits/locale_facets.h:
+/usr/include/eigen3/Eigen/src/Core/Product.h:
 
-/usr/include/c++/11/bits/locale_classes.tcc:
+/usr/include/boost/fusion/algorithm/query/find_if_fwd.hpp:
 
-/usr/include/c++/11/bits/stl_multimap.h:
+/usr/include/c++/11/utility:
 
-/usr/include/c++/11/bits/ios_base.h:
+/usr/include/boost/iostreams/detail/push.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/TriangularMatrixMatrix.h:
+/usr/include/boost/iterator/interoperable.hpp:
 
-/usr/include/c++/11/bits/invoke.h:
+/usr/include/boost/fusion/algorithm/query/find.hpp:
 
-/usr/include/c++/11/bits/hashtable.h:
+/usr/include/boost/mpl/vector/aux_/tag.hpp:
 
-/usr/include/c++/11/bits/hash_bytes.h:
+/usr/include/boost/type_traits/is_const.hpp:
 
-/usr/include/c++/11/bits/exception_ptr.h:
+/usr/include/boost/fusion/algorithm/query/detail/segmented_find_if.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/typesizes.h:
+/usr/include/boost/iostreams/detail/config/gcc.hpp:
 
-/usr/include/c++/11/bits/exception_defines.h:
+/usr/include/boost/type_traits/enable_if.hpp:
 
-/usr/include/c++/11/bits/erase_if.h:
+/usr/include/eigen3/Eigen/src/Core/arch/Default/GenericPacketMathFunctionsFwd.h:
 
-/usr/include/c++/11/bits/cxxabi_init_exception.h:
+/usr/include/boost/archive/detail/basic_oarchive.hpp:
 
-/usr/include/c++/11/bits/cxxabi_forced.h:
+/usr/include/boost/fusion/view/reverse_view/detail/next_impl.hpp:
 
-/usr/include/c++/11/bits/codecvt.h:
+/usr/include/boost/concept/assert.hpp:
 
-/usr/include/c++/11/bits/char_traits.h:
+/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_begin.hpp:
 
-/usr/include/c++/11/bits/atomic_lockfree_defines.h:
+/usr/include/boost/type_traits/detail/is_member_function_pointer_cxx_11.hpp:
 
-/usr/include/c++/11/bits/allocator.h:
+/usr/include/boost/archive/detail/iserializer.hpp:
 
-/usr/include/c++/11/bits/allocated_ptr.h:
+/usr/include/boost/fusion/algorithm/query/detail/count_if.hpp:
 
-/usr/include/c++/11/bits/alloc_traits.h:
+/usr/include/boost/asio/detail/io_control.hpp:
 
-/usr/include/c++/11/bits/align.h:
+/usr/include/boost/variant/detail/variant_io.hpp:
 
-/usr/include/c++/11/bit:
+/usr/include/boost/math/constants/calculate_constants.hpp:
 
-/usr/include/c++/11/backward/binders.h:
+/usr/include/boost/date_time/gregorian/greg_ymd.hpp:
 
-/usr/include/c++/11/array:
+/usr/include/c++/11/unordered_map:
 
-/usr/include/c++/11/algorithm:
+/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_size.hpp:
 
-/usr/include/boost/variant/variant.hpp:
+/usr/include/boost/type_traits/is_class.hpp:
 
-/usr/include/c++/11/set:
+/usr/include/boost/fusion/algorithm/query/detail/any.hpp:
 
-/usr/include/boost/variant/static_visitor.hpp:
+/usr/lib/gcc/x86_64-linux-gnu/11/include/mm_malloc.h:
 
-/usr/include/boost/variant/recursive_wrapper_fwd.hpp:
+/usr/include/boost/fusion/algorithm/query/detail/all.hpp:
 
-/usr/include/boost/variant/detail/visitation_impl.hpp:
+/usr/include/boost/fusion/support/detail/mpl_iterator_category.hpp:
 
-/usr/include/boost/variant/detail/over_sequence.hpp:
+/usr/include/boost/fusion/view/single_view/detail/end_impl.hpp:
 
-/usr/include/boost/variant/detail/move.hpp:
+/opt/openrobots/include/pinocchio/spatial/se3-tpl.hpp:
 
-/usr/include/boost/variant/detail/make_variant_list.hpp:
+/usr/include/boost/fusion/container/list/cons_iterator.hpp:
 
-/usr/include/boost/variant/detail/has_result_type.hpp:
+/usr/include/boost/fusion/algorithm/query/all.hpp:
 
-/usr/include/boost/variant/detail/forced_return.hpp:
+/usr/include/boost/asio/detail/chrono_time_traits.hpp:
 
-/usr/include/boost/variant/detail/enable_recursive.hpp:
+/usr/include/x86_64-linux-gnu/bits/uio_lim.h:
 
-/usr/include/boost/variant/detail/element_index.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/ParametrizedLine.h:
 
-/usr/include/boost/variant/detail/config.hpp:
+/usr/include/boost/fusion/view/reverse_view/reverse_view.hpp:
 
-/usr/include/boost/variant/detail/apply_visitor_unary.hpp:
+/usr/include/boost/fusion/algorithm/iteration/iter_fold.hpp:
 
-/usr/include/boost/variant/detail/apply_visitor_binary.hpp:
+/usr/include/boost/fusion/container/vector/detail/value_of_impl.hpp:
 
-/usr/include/boost/variant/apply_visitor.hpp:
+/usr/include/boost/archive/xml_oarchive.hpp:
 
-/usr/include/boost/variant.hpp:
+/usr/include/boost/fusion/algorithm/iteration/for_each_fwd.hpp:
 
-/usr/include/boost/utility/enable_if.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/Scaling.h:
 
-/usr/include/boost/utility/detail/result_of_iterate.hpp:
+/usr/include/x86_64-linux-gnu/bits/types/siginfo_t.h:
 
-/usr/include/boost/utility/declval.hpp:
+/usr/include/boost/date_time/period.hpp:
 
-/usr/include/boost/type_traits/type_with_alignment.hpp:
+/usr/include/boost/fusion/algorithm/iteration/detail/segmented_for_each.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/Parallelizer.h:
+/usr/include/boost/type_traits/has_right_shift.hpp:
 
-/usr/include/boost/type_traits/type_identity.hpp:
+/usr/include/boost/mpl/begin.hpp:
 
-/usr/include/boost/type_traits/remove_volatile.hpp:
+/usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/fold.hpp:
 
-/usr/include/boost/type_traits/remove_pointer.hpp:
+/usr/include/boost/fusion/adapted/mpl/mpl_iterator.hpp:
 
-/usr/include/boost/type_traits/remove_cv_ref.hpp:
+/usr/include/eigen3/Eigen/src/Core/CwiseUnaryView.h:
 
-/usr/include/boost/type_traits/remove_cv.hpp:
+/usr/include/boost/iostreams/device/array.hpp:
 
-/usr/include/boost/type_traits/remove_bounds.hpp:
+/usr/include/eigen3/Eigen/LU:
 
-/usr/include/c++/11/ext/alloc_traits.h:
+/usr/include/boost/fusion/adapted/mpl/detail/size_impl.hpp:
 
-/usr/include/boost/type_traits/rank.hpp:
+/usr/include/boost/asio/execution/schedule.hpp:
 
-/usr/include/c++/11/bits/istream.tcc:
+/usr/include/boost/fusion/adapted/mpl/detail/is_sequence_impl.hpp:
 
-/usr/include/boost/type_traits/negation.hpp:
+/usr/include/boost/asio/detail/posix_mutex.hpp:
 
-/usr/include/boost/type_traits/make_void.hpp:
+/usr/include/boost/fusion/view/transform_view/transform_view_fwd.hpp:
 
-/usr/include/boost/type_traits/make_unsigned.hpp:
+/usr/include/boost/archive/detail/register_archive.hpp:
 
-/usr/include/boost/type_traits/make_signed.hpp:
+/usr/include/boost/fusion/adapted/mpl/detail/empty_impl.hpp:
 
-/usr/include/boost/type_traits/is_void.hpp:
+/usr/include/boost/fusion/container/list/list.hpp:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/xmmintrin.h:
+/usr/include/boost/function_types/is_member_function_pointer.hpp:
 
-/usr/include/boost/type_traits/is_virtual_base_of.hpp:
+/usr/include/boost/fusion/mpl/erase.hpp:
 
-/usr/include/boost/type_traits/is_unsigned.hpp:
+/usr/include/boost/move/adl_move_swap.hpp:
 
-/usr/include/boost/type_traits/is_unbounded_array.hpp:
+/usr/include/boost/fusion/include/invoke.hpp:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/error_constants.h:
+/usr/include/boost/fusion/view/filter_view/detail/end_impl.hpp:
 
-/usr/include/c++/11/bits/stream_iterator.h:
+/usr/include/boost/type_traits/has_trivial_destructor.hpp:
 
-/usr/include/boost/type_traits/is_trivially_copyable.hpp:
+/usr/include/boost/function_types/is_callable_builtin.hpp:
 
-/usr/include/boost/type_traits/is_scoped_enum.hpp:
+/usr/include/boost/function_types/detail/pp_variate_loop/preprocessed.hpp:
 
-/usr/include/c++/11/bits/fstream.tcc:
+/usr/include/boost/serialization/array_wrapper.hpp:
 
-/usr/include/boost/type_traits/is_scalar.hpp:
+/usr/include/boost/asio/prefer.hpp:
 
-/usr/include/boost/type_traits/is_same.hpp:
+/usr/include/boost/function_types/detail/pp_tags/preprocessed.hpp:
 
-/usr/include/boost/type_traits/is_reference.hpp:
+/usr/include/boost/iostreams/optimal_buffer_size.hpp:
 
-/usr/include/boost/type_traits/is_polymorphic.hpp:
+/usr/include/boost/function_types/detail/pp_tags/cc_tag.hpp:
 
-/usr/include/boost/type_traits/is_pointer.hpp:
+/usr/include/c++/11/bits/stl_iterator.h:
 
-/usr/include/boost/type_traits/is_pod.hpp:
+/usr/include/x86_64-linux-gnu/bits/select2.h:
 
-/usr/include/boost/type_traits/is_object.hpp:
+/usr/include/boost/function_types/detail/pp_retag_default_cc/preprocessed.hpp:
 
-/usr/include/boost/type_traits/is_nothrow_swappable.hpp:
+/usr/include/boost/type_traits/remove_const.hpp:
 
-/usr/include/boost/type_traits/is_noncopyable.hpp:
+/usr/include/boost/iostreams/traits_fwd.hpp:
 
-/usr/include/boost/type_traits/is_lvalue_reference.hpp:
+/usr/include/boost/date_time/date_clock_device.hpp:
 
-/usr/include/boost/type_traits/is_list_constructible.hpp:
+/usr/include/boost/function_types/detail/pp_cc_loop/preprocessed.hpp:
 
-/usr/include/boost/type_traits/is_integral.hpp:
+/opt/openrobots/include/hpp/fcl/distance.h:
 
-/usr/include/boost/type_traits/is_function.hpp:
+/usr/local/include/urcl/tcp_server.h:
 
-/usr/include/eigen3/Eigen/src/Core/arch/Default/Settings.h:
+/opt/openrobots/include/pinocchio/spatial/cartesian-axis.hpp:
 
-/usr/include/boost/type_traits/is_floating_point.hpp:
+/usr/include/boost/function_types/detail/encoding/def.hpp:
 
-/usr/include/boost/type_traits/is_final.hpp:
+/usr/include/boost/asio/traits/prefer_member.hpp:
 
-/usr/include/c++/11/bits/vector.tcc:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorFixedSize.h:
 
-/usr/include/boost/type_traits/is_empty.hpp:
+/usr/include/boost/fusion/container/list/detail/build_cons.hpp:
 
-/usr/include/boost/type_traits/is_destructible.hpp:
+/usr/include/boost/type_traits/add_lvalue_reference.hpp:
 
-/usr/include/boost/type_traits/is_copy_constructible.hpp:
+/usr/include/boost/function_types/detail/encoding/aliases_def.hpp:
 
-/usr/include/boost/type_traits/is_compound.hpp:
+/usr/include/boost/function_types/detail/components_impl/arity20_1.hpp:
 
-/usr/include/boost/type_traits/is_complex.hpp:
+/usr/include/boost/function_types/detail/retag_default_cc.hpp:
 
-/usr/include/boost/type_traits/is_complete.hpp:
+/usr/include/boost/fusion/mpl/empty.hpp:
 
-/usr/include/boost/type_traits/is_base_of.hpp:
+/usr/include/x86_64-linux-gnu/sys/time.h:
 
-/usr/include/boost/type_traits/is_base_and_derived.hpp:
+/usr/include/boost/function_types/detail/components_as_mpl_sequence.hpp:
 
-/usr/include/c++/11/vector:
+/usr/include/boost/config/pragma_message.hpp:
 
-/usr/include/boost/type_traits/is_array.hpp:
+/usr/include/boost/function_types/detail/class_transform.hpp:
 
-/usr/include/boost/type_traits/is_abstract.hpp:
+/usr/include/boost/function_types/config/compiler.hpp:
 
-/usr/include/boost/type_traits/integral_promotion.hpp:
+/usr/include/boost/variant/detail/hash_variant.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/select.h:
+/usr/include/boost/foreach_fwd.hpp:
 
-/usr/include/c++/11/bits/stl_set.h:
+/usr/include/boost/detail/select_type.hpp:
 
-/usr/include/boost/type_traits/integral_constant.hpp:
+/usr/include/boost/detail/lcast_precision.hpp:
 
-/usr/include/boost/type_traits/has_unary_plus.hpp:
+/usr/include/boost/detail/is_incrementable.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/locale.h:
+/usr/include/x86_64-linux-gnu/bits/cpu-set.h:
 
-/usr/include/boost/type_traits/has_trivial_move_constructor.hpp:
+/usr/include/boost/detail/call_traits.hpp:
 
-/usr/include/boost/type_traits/has_trivial_move_assign.hpp:
+/usr/include/boost/function_types/result_type.hpp:
 
-/usr/include/boost/type_traits/has_trivial_copy.hpp:
+/usr/include/boost/concept/usage.hpp:
 
-/usr/include/boost/type_traits/has_trivial_assign.hpp:
+/usr/include/boost/mpl/empty.hpp:
 
-/usr/include/boost/type_traits/has_right_shift.hpp:
+/usr/include/boost/date_time/time_system_counted.hpp:
 
-/usr/include/boost/type_traits/has_pre_decrement.hpp:
+/usr/include/boost/detail/reference_content.hpp:
 
-/usr/include/boost/type_traits/has_post_increment.hpp:
+/usr/include/boost/mpl/aux_/pop_front_impl.hpp:
 
-/usr/include/boost/type_traits/has_plus_assign.hpp:
+/usr/include/boost/fusion/iterator/equal_to.hpp:
 
-/usr/include/boost/type_traits/has_nothrow_destructor.hpp:
+/usr/include/boost/fusion/algorithm/transformation/remove.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/SSE/TypeCasting.h:
+/usr/include/boost/mpl/has_xxx.hpp:
 
-/usr/include/boost/type_traits/remove_extent.hpp:
+/usr/include/boost/mpl/apply_wrap.hpp:
 
-/usr/include/boost/type_traits/has_nothrow_copy.hpp:
+/usr/include/boost/date_time/time_clock.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/Macros.h:
+/usr/include/boost/date_time/time.hpp:
 
-/usr/include/c++/11/bits/charconv.h:
+/usr/include/c++/11/bits/unique_lock.h:
 
-/usr/include/boost/type_traits/has_nothrow_constructor.hpp:
+/usr/include/boost/archive/detail/basic_pointer_oserializer.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorStriding.h:
+/usr/include/boost/mpl/aux_/traits_lambda_spec.hpp:
 
-/usr/include/boost/type_traits/has_nothrow_assign.hpp:
+/usr/include/boost/fusion/functional/invocation/detail/that_ptr.hpp:
 
-/usr/include/boost/type_traits/has_not_equal_to.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/ConfigureVectorization.h:
 
-/usr/include/boost/type_traits/has_new_operator.hpp:
+/usr/include/boost/date_time/posix_time/ptime.hpp:
 
-/usr/include/x86_64-linux-gnu/asm/sockios.h:
+/usr/include/boost/date_time/gregorian_calendar.ipp:
 
-/usr/include/boost/type_traits/has_negate.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-composite.hpp:
 
-/usr/include/boost/type_traits/has_multiplies_assign.hpp:
+/usr/include/boost/date_time/gregorian_calendar.hpp:
 
-/usr/include/boost/type_traits/has_multiplies.hpp:
+/usr/include/boost/mpl/iterator_tags.hpp:
 
-/usr/include/boost/type_traits/has_modulus_assign.hpp:
+/usr/include/boost/fusion/container/list/detail/value_at_impl.hpp:
 
-/usr/include/boost/variant/detail/substitute.hpp:
+/usr/include/boost/type_traits/same_traits.hpp:
 
-/usr/include/boost/type_traits/has_minus_assign.hpp:
+/usr/include/boost/iostreams/checked_operations.hpp:
 
-/usr/include/boost/type_traits/has_minus.hpp:
+/usr/include/boost/date_time/gregorian/greg_year.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorPatch.h:
+/usr/include/boost/date_time/gregorian/greg_weekday.hpp:
 
-/usr/include/boost/type_traits/has_logical_not.hpp:
+/usr/include/errno.h:
 
-/usr/include/boost/type_traits/has_less.hpp:
+/usr/include/boost/fusion/support/config.hpp:
 
-/usr/include/boost/type_traits/has_left_shift.hpp:
+/usr/include/locale.h:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/limits.h:
+/usr/include/boost/iostreams/detail/wrap_unwrap.hpp:
 
-/usr/include/c++/11/bits/unordered_map.h:
+/usr/include/boost/iostreams/detail/config/fpos.hpp:
 
-/usr/include/boost/type_traits/has_greater_equal.hpp:
+/usr/include/boost/asio/deadline_timer.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/CwiseBinaryOp.h:
+/opt/openrobots/include/hpp/fcl/BV/RSS.h:
 
-/usr/include/boost/type_traits/has_greater.hpp:
+/usr/include/boost/mpl/list/aux_/begin_end.hpp:
 
-/usr/include/boost/variant/detail/std_hash.hpp:
+/usr/include/boost/utility/addressof.hpp:
 
-/usr/include/boost/type_traits/has_dereference.hpp:
+/usr/include/boost/move/detail/std_ns_end.hpp:
 
-/usr/include/boost/type_traits/has_bit_xor_assign.hpp:
+/usr/include/x86_64-linux-gnu/bits/types/mbstate_t.h:
 
-/usr/include/boost/type_traits/has_bit_xor.hpp:
+/usr/include/boost/iostreams/detail/is_iterator_range.hpp:
 
-/usr/include/boost/type_traits/has_bit_or_assign.hpp:
+/usr/include/boost/fusion/view/zip_view/detail/size_impl.hpp:
 
-/usr/include/boost/type_traits/has_bit_or.hpp:
+/usr/include/boost/date_time/gregorian/greg_date.hpp:
 
-/usr/include/boost/type_traits/has_bit_and_assign.hpp:
+/usr/include/x86_64-linux-gnu/c++/11/bits/gthr-default.h:
 
-/usr/include/boost/type_traits/function_traits.hpp:
+/usr/include/boost/date_time/dst_rules.hpp:
 
-/usr/include/eigen3/Eigen/Eigenvalues:
+/usr/include/boost/date_time/date_iterator.hpp:
 
-/usr/include/boost/type_traits/floating_point_promotion.hpp:
+/usr/include/boost/variant/get.hpp:
 
-/usr/include/boost/type_traits/extent.hpp:
+/usr/include/boost/fusion/algorithm/iteration/reverse_iter_fold.hpp:
 
-/usr/include/c++/11/cstdint:
+/usr/include/boost/bind/mem_fn.hpp:
 
-/usr/include/boost/type_traits/detail/yes_no_type.hpp:
+/usr/include/boost/fusion/iterator/mpl/fusion_iterator.hpp:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/basic_file.h:
+/usr/include/boost/date_time/date_defs.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/pthreadtypes.h:
+/usr/include/boost/date_time/constrained_value.hpp:
 
-/usr/include/boost/type_traits/detail/mp_defer.hpp:
+/usr/include/boost/fusion/view/iterator_range/detail/value_at_impl.hpp:
 
-/usr/include/boost/type_traits/detail/has_postfix_operator.hpp:
+/usr/include/boost/fusion/support/is_view.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Redux.h:
+/usr/include/c++/11/bits/stl_iterator_base_funcs.h:
 
-/usr/include/boost/type_traits/detail/has_binary_operator.hpp:
+/usr/include/boost/fusion/iterator/value_of.hpp:
 
-/usr/include/boost/type_traits/detail/config.hpp:
+/usr/include/boost/asio/detail/global.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/__sigval_t.h:
+/usr/include/boost/fusion/view/filter_view/filter_view_iterator.hpp:
 
-/usr/include/boost/type_traits/detail/bool_trait_undef.hpp:
+/usr/include/boost/fusion/algorithm/iteration.hpp:
 
-/usr/include/c++/11/cstddef:
+/usr/include/boost/asio/detail/executor_function.hpp:
 
-/usr/include/boost/type_traits/declval.hpp:
+/usr/include/boost/fusion/container/list/detail/equal_to_impl.hpp:
 
-/usr/include/c++/11/chrono:
+/usr/include/boost/mpl/aux_/logical_op.hpp:
 
-/usr/include/boost/type_traits/decay.hpp:
+/usr/include/eigen3/Eigen/src/Core/arch/SSE/Complex.h:
 
-/usr/include/boost/type_traits/conversion_traits.hpp:
+/usr/include/boost/archive/detail/common_iarchive.hpp:
 
-/usr/include/boost/type_traits/alignment_of.hpp:
+/usr/include/boost/asio/detail/completion_handler.hpp:
 
-/usr/include/boost/type_traits/add_volatile.hpp:
+/usr/include/boost/mpl/aux_/erase_key_impl.hpp:
 
-/usr/include/inttypes.h:
+/usr/include/boost/asio/impl/io_context.ipp:
 
-/usr/include/boost/type_traits/add_rvalue_reference.hpp:
+/usr/include/boost/asio/basic_streambuf_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/Default/ConjHelper.h:
+/usr/include/boost/detail/indirect_traits.hpp:
 
-/usr/include/boost/type_traits/add_pointer.hpp:
+/usr/include/boost/date_time/gregorian/greg_duration.hpp:
 
-/usr/include/boost/type_traits/is_union.hpp:
+/opt/openrobots/include/pinocchio/utils/cast.hpp:
 
-/usr/include/boost/type_traits/add_cv.hpp:
+/opt/openrobots/include/pinocchio/spatial/motion-zero.hpp:
 
-/usr/include/boost/type_traits.hpp:
+/usr/include/boost/fusion/view/iterator_range/detail/begin_impl.hpp:
 
-/usr/include/boost/type_index/stl_type_index.hpp:
+/usr/include/boost/asio/detail/reactive_socket_recvmsg_op.hpp:
 
-/usr/include/boost/type_index.hpp:
+/usr/include/boost/iostreams/output_sequence.hpp:
 
-/usr/include/boost/type.hpp:
+/usr/include/boost/asio/basic_socket.hpp:
 
-/usr/include/boost/system/system_error.hpp:
+/usr/include/boost/asio/execution_context.hpp:
 
-/usr/include/boost/system/error_code.hpp:
+/usr/include/c++/11/typeinfo:
 
-/usr/include/boost/system/detail/system_category_posix.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/SelfadjointProduct.h:
 
-/usr/include/boost/system/api_config.hpp:
+/usr/include/boost/fusion/mpl/size.hpp:
 
-/usr/include/boost/swap.hpp:
+/usr/include/boost/fusion/view/joint_view/joint_view.hpp:
 
-/usr/include/boost/static_assert.hpp:
+/usr/include/boost/variant/detail/enable_recursive_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/PartialReduxEvaluator.h:
+/usr/include/boost/asio/traits/execute_free.hpp:
 
-/usr/include/boost/smart_ptr/scoped_ptr.hpp:
+/usr/include/boost/asio/detail/scheduler_thread_info.hpp:
 
-/usr/include/boost/smart_ptr/make_shared_object.hpp:
+/opt/openrobots/include/pinocchio/multibody/geometry.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/functors/NullaryFunctors.h:
+/usr/include/boost/range/iterator_range_core.hpp:
 
-/usr/include/boost/smart_ptr/make_shared.hpp:
+/opt/openrobots/include/hpp/fcl/BV/OBBRSS.h:
 
-/usr/include/poll.h:
+/usr/include/c++/11/bits/functional_hash.h:
 
-/usr/include/boost/smart_ptr/detail/spinlock_gcc_atomic.hpp:
+/usr/include/boost/archive/detail/interface_iarchive.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_typeinfo_.hpp:
+/usr/include/boost/asio/execution/detail/as_operation.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_thread_sleep.hpp:
+/usr/include/boost/archive/detail/decl.hpp:
 
-/usr/include/c++/11/bits/ostream.tcc:
+/usr/include/boost/asio/detail/concurrency_hint.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_has_gcc_intrinsics.hpp:
+/usr/include/boost/type_traits/detail/has_prefix_operator.hpp:
 
-/usr/include/boost/variant/visitor_ptr.hpp:
+/usr/include/x86_64-linux-gnu/bits/unistd.h:
 
-/usr/include/boost/type_traits/has_modulus.hpp:
+/usr/include/boost/mpl/aux_/advance_backward.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_forward.hpp:
+/opt/openrobots/include/pinocchio/multibody/frame.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_counted_impl.hpp:
+/usr/include/boost/mpl/long.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_counted_base.hpp:
+/usr/include/boost/archive/detail/basic_iserializer.hpp:
 
-/usr/include/boost/smart_ptr/detail/operator_bool.hpp:
+/usr/include/boost/asio/detail/posix_event.hpp:
 
-/usr/include/boost/smart_ptr/allocate_shared_array.hpp:
+/usr/include/boost/mpl/iter_fold_if.hpp:
 
-/usr/include/boost/shared_ptr.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorChipping.h:
 
-/usr/include/c++/11/bits/locale_facets_nonio.tcc:
+/usr/include/boost/type_traits/is_enum.hpp:
 
-/usr/include/c++/11/bits/locale_conv.h:
+/usr/include/boost/core/typeinfo.hpp:
 
-/usr/include/boost/serialization/void_cast_fwd.hpp:
+/usr/include/boost/fusion/iterator/mpl.hpp:
 
-/usr/include/boost/serialization/void_cast.hpp:
+/opt/openrobots/include/pinocchio/spatial/log.hxx:
 
-/usr/include/boost/serialization/version.hpp:
+/usr/include/boost/serialization/wrapper.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorConcatenation.h:
+/usr/include/boost/iostreams/detail/streambuf/indirect_streambuf.hpp:
 
-/usr/include/boost/serialization/traits.hpp:
+/usr/include/c++/11/bits/erase_if.h:
 
-/usr/include/eigen3/Eigen/src/Core/Random.h:
+/usr/include/boost/asio/io_service.hpp:
 
-/usr/include/boost/serialization/tracking_enum.hpp:
+/usr/include/boost/type_traits/is_rvalue_reference.hpp:
 
-/usr/include/stdio.h:
+/usr/include/boost/archive/detail/archive_serializer_map.hpp:
 
-/usr/include/boost/serialization/tracking.hpp:
+/usr/include/boost/fusion/algorithm/query.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/math-vector.h:
+/usr/include/boost/predef/os/bsd/open.h:
 
-/usr/include/boost/serialization/throw_exception.hpp:
+/usr/include/boost/date_time/gregorian/greg_calendar.hpp:
 
-/usr/include/c++/11/ctime:
+/usr/include/boost/mpl/minus.hpp:
 
-/usr/include/boost/serialization/string.hpp:
+/usr/include/boost/asio/detail/resolve_op.hpp:
 
-/usr/include/boost/system/detail/config.hpp:
+/usr/include/boost/asio/traits/query_free.hpp:
 
-/usr/include/boost/serialization/static_warning.hpp:
+/usr/include/boost/fusion/support/is_segmented.hpp:
 
-/usr/include/boost/serialization/split_member.hpp:
+/usr/include/boost/type_traits.hpp:
 
-/usr/include/c++/11/bits/stl_numeric.h:
+/usr/include/boost/archive/binary_iarchive.hpp:
 
-/usr/include/boost/serialization/singleton.hpp:
+/usr/include/boost/date_time/gregorian/greg_month.hpp:
 
-/usr/include/boost/serialization/serialization.hpp:
+/opt/openrobots/include/pinocchio/multibody/fwd.hpp:
 
-/usr/include/endian.h:
+/usr/include/boost/archive/basic_xml_oarchive.hpp:
 
-/usr/include/boost/serialization/nvp.hpp:
+/usr/include/boost/fusion/view/joint_view/detail/deref_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/__FILE.h:
+/usr/include/boost/fusion/view/joint_view/joint_view_fwd.hpp:
 
-/usr/include/boost/serialization/library_version_type.hpp:
+/usr/include/boost/asio/time_traits.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/GeneralMatrixVector.h:
+/usr/include/boost/utility/base_from_member.hpp:
 
-/usr/include/boost/serialization/level_enum.hpp:
+/usr/include/boost/archive/basic_text_oprimitive.hpp:
 
-/usr/include/boost/serialization/is_bitwise_serializable.hpp:
+/usr/include/boost/archive/basic_text_iprimitive.hpp:
 
-/usr/include/boost/serialization/factory.hpp:
+/usr/include/boost/fusion/view/iterator_range/iterator_range.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorArgMax.h:
+/usr/include/eigen3/Eigen/src/Core/SelfAdjointView.h:
 
-/usr/include/boost/serialization/extended_type_info_typeid.hpp:
+/usr/include/boost/mpl/begin_end_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Dot.h:
+/usr/include/boost/asio/detail/handler_alloc_helpers.hpp:
 
-/usr/include/boost/serialization/extended_type_info.hpp:
+/usr/include/boost/mpl/void.hpp:
 
-/usr/include/boost/type_traits/is_convertible.hpp:
+/usr/include/boost/fusion/mpl/push_back.hpp:
 
-/usr/include/boost/serialization/detail/stack_constructor.hpp:
+/usr/include/boost/asio/traits/schedule_member.hpp:
 
-/usr/include/c++/11/ostream:
+/usr/include/boost/asio/detail/fenced_block.hpp:
 
-/usr/include/boost/serialization/config.hpp:
+/opt/openrobots/include/pinocchio/multibody/visitor/joint-binary-visitor.hpp:
 
-/usr/include/boost/serialization/collection_traits.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorForcedEval.h:
 
-/usr/include/x86_64-linux-gnu/bits/posix_opt.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorExecutor.h:
 
-/usr/include/boost/serialization/collection_size_type.hpp:
+/usr/include/boost/iterator/iterator_concepts.hpp:
 
-/usr/include/boost/serialization/base_object.hpp:
+/usr/include/boost/archive/basic_binary_iarchive.hpp:
 
-/usr/include/boost/serialization/array_optimization.hpp:
+/usr/include/boost/iostreams/detail/adapter/non_blocking_adapter.hpp:
 
-/usr/include/boost/serialization/array.hpp:
+/usr/include/boost/iostreams/detail/streambuf/linked_streambuf.hpp:
 
-/usr/include/boost/scoped_ptr.hpp:
+/usr/include/boost/aligned_storage.hpp:
 
-/usr/include/c++/11/cstdlib:
+/opt/openrobots/include/pinocchio/math/rotation.hpp:
 
-/usr/include/boost/range/value_type.hpp:
+/usr/include/boost/fusion/view/single_view/detail/value_at_impl.hpp:
 
-/usr/include/boost/smart_ptr/bad_weak_ptr.hpp:
+/usr/include/boost/asio/execution/context.hpp:
 
-/usr/include/boost/range/size_type.hpp:
+/usr/include/boost/fusion/adapted/mpl.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/Translation.h:
+/usr/include/boost/date_time/time_iterator.hpp:
 
-/usr/include/boost/range/size.hpp:
+/usr/include/boost/asio/detail/reactor_op.hpp:
 
-/usr/include/boost/range/rend.hpp:
+/usr/include/eigen3/unsupported/Eigen/SpecialFunctions:
 
-/usr/include/x86_64-linux-gnu/bits/siginfo-arch.h:
+/usr/include/asm-generic/errno.h:
 
-/usr/include/boost/range/rbegin.hpp:
+/usr/include/boost/mpl/aux_/config/arrays.hpp:
 
-/usr/include/eigen3/Eigen/src/QR/ColPivHouseholderQR.h:
+/usr/include/boost/asio/basic_socket_acceptor.hpp:
 
-/usr/include/boost/range/range_fwd.hpp:
+/usr/include/boost/mpl/vector/aux_/push_front.hpp:
 
-/usr/include/c++/11/bits/unique_ptr.h:
+/usr/include/boost/preprocessor/comparison/less_equal.hpp:
 
-/usr/include/boost/range/mutable_iterator.hpp:
+/usr/include/boost/preprocessor/punctuation/comma.hpp:
 
-/usr/include/boost/type_traits/is_bounded_array.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorIndexList.h:
 
-/usr/include/boost/range/iterator_range_io.hpp:
+/usr/include/boost/range/difference_type.hpp:
 
-/usr/include/boost/range/functions.hpp:
+/usr/include/boost/mpl/reverse_fold.hpp:
 
-/usr/include/boost/variant/recursive_variant.hpp:
+/usr/include/c++/11/experimental/bits/lfts_config.h:
 
-/usr/include/boost/range/empty.hpp:
+/usr/include/boost/date_time/gregorian/greg_day_of_year.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsPacketMath.h:
+/usr/include/boost/archive/basic_archive.hpp:
 
-/usr/include/boost/range/distance.hpp:
+/usr/include/boost/mpl/always.hpp:
 
-/usr/include/boost/range/detail/safe_bool.hpp:
+/usr/include/boost/assert/source_location.hpp:
 
-/usr/include/boost/range/detail/msvc_has_iterator_workaround.hpp:
+/usr/include/asm-generic/bitsperlong.h:
 
-/usr/include/boost/range/detail/implementation_help.hpp:
+/usr/include/boost/visit_each.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/HessenbergDecomposition.h:
+/usr/include/boost/fusion/mpl/insert_range.hpp:
 
-/usr/include/boost/range/detail/extract_optional_type.hpp:
+/usr/include/boost/integer.hpp:
 
-/usr/include/c++/11/ext/atomicity.h:
+/usr/include/boost/fusion/sequence/intrinsic/size.hpp:
 
-/usr/include/boost/range/const_iterator.hpp:
+/opt/openrobots/include/pinocchio/math/matrix.hpp:
 
-/usr/include/boost/range/concepts.hpp:
+/usr/include/boost/asio/detail/date_time_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/CoreEvaluators.h:
+/usr/include/boost/fusion/algorithm/query/detail/find_if.hpp:
 
-/usr/include/boost/range/begin.hpp:
+/opt/openrobots/include/pinocchio/spatial/motion-dense.hpp:
 
-/usr/include/boost/range/algorithm/equal.hpp:
+/usr/include/boost/mpl/aux_/arity_spec.hpp:
 
-/usr/include/boost/preprocessor/variadic/elem.hpp:
+/usr/include/boost/mpl/int.hpp:
 
-/usr/include/boost/preprocessor/stringize.hpp:
+/usr/include/boost/fusion/mpl/clear.hpp:
 
-/usr/include/c++/11/bits/functexcept.h:
+/usr/include/boost/type_traits/add_rvalue_reference.hpp:
 
-/usr/include/boost/preprocessor/slot/slot.hpp:
+/usr/include/inttypes.h:
 
-/usr/include/boost/preprocessor/slot/detail/shared.hpp:
+/usr/include/boost/function_types/property_tags.hpp:
 
-/usr/include/boost/type_traits/has_logical_and.hpp:
+/usr/include/boost/type_traits/has_left_shift_assign.hpp:
 
-/usr/include/boost/preprocessor/seq/transform.hpp:
+/usr/include/boost/iterator/detail/config_def.hpp:
 
-/usr/include/boost/preprocessor/seq/size.hpp:
+/usr/include/boost/asio/system_executor.hpp:
 
-/usr/include/boost/preprocessor/seq/seq.hpp:
+/usr/include/boost/type_traits/has_plus.hpp:
 
-/usr/include/boost/preprocessor/seq/fold_left.hpp:
+/opt/openrobots/include/hpp/fcl/collision_object.h:
 
-/usr/include/boost/preprocessor/seq/enum.hpp:
+/usr/include/boost/asio/detail/impl/buffer_sequence_adapter.ipp:
 
-/usr/include/boost/preprocessor/seq/detail/split.hpp:
+/usr/include/boost/asio/execution/blocking_adaptation.hpp:
 
-/usr/include/boost/preprocessor/repetition/repeat.hpp:
+/usr/include/boost/bind/mem_fn_template.hpp:
 
-/usr/include/boost/preprocessor/repetition/enum_trailing_params.hpp:
+/usr/include/boost/fusion/view/reverse_view/detail/at_impl.hpp:
 
-/usr/include/boost/preprocessor/repetition/enum_shifted.hpp:
+/usr/include/boost/fusion/view/joint_view/detail/value_of_data_impl.hpp:
 
-/usr/include/boost/preprocessor/repetition/enum_binary_params.hpp:
+/usr/include/x86_64-linux-gnu/bits/atomic_wide_counter.h:
 
-/usr/include/boost/preprocessor/repetition/enum.hpp:
+/opt/openrobots/include/pinocchio/utils/eigen-fix.hpp:
 
-/usr/include/ctype.h:
+/usr/include/eigen3/Eigen/src/Core/Visitor.h:
 
-/usr/include/boost/preprocessor/punctuation/paren.hpp:
+/usr/include/boost/archive/detail/abi_prefix.hpp:
 
-/usr/include/boost/preprocessor/punctuation/comma_if.hpp:
+/opt/openrobots/include/pinocchio/spatial/spatial-axis.hpp:
 
-/usr/include/boost/preprocessor/logical/compl.hpp:
+/usr/include/boost/asio/ip/impl/address_v6.hpp:
 
-/usr/include/boost/preprocessor/logical/bitand.hpp:
+/opt/openrobots/include/pinocchio/spatial/skew.hpp:
 
-/usr/include/boost/preprocessor/logical/and.hpp:
+/usr/include/boost/fusion/view/filter_view/detail/deref_impl.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_thread_pause.hpp:
+/usr/include/boost/fusion/view/flatten_view/flatten_view.hpp:
 
-/usr/include/boost/preprocessor/list/reverse.hpp:
+/usr/include/boost/fusion/support/detail/as_fusion_element.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/FILE.h:
+/usr/include/boost/asio/ip/address_v4.hpp:
 
-/usr/include/boost/preprocessor/list/fold_right.hpp:
+/usr/include/boost/asio/detail/op_queue.hpp:
 
-/usr/include/boost/preprocessor/list/fold_left.hpp:
+/usr/include/c++/11/bits/exception.h:
 
-/usr/include/boost/preprocessor/list/detail/fold_right.hpp:
+/opt/openrobots/include/pinocchio/spatial/se3.hpp:
 
-/usr/include/c++/11/exception:
+/usr/include/boost/fusion/algorithm/iteration/reverse_fold_fwd.hpp:
 
-/usr/include/boost/preprocessor/list/detail/fold_left.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/SelfadjointMatrixVector.h:
 
-/usr/include/boost/preprocessor/iteration/local.hpp:
+/usr/include/boost/smart_ptr/make_shared_object.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorIndexList.h:
+/usr/include/boost/archive/detail/common_oarchive.hpp:
 
-/usr/include/boost/preprocessor/iteration/iterate.hpp:
+/usr/include/boost/fusion/functional/invocation/invoke.hpp:
 
-/usr/include/boost/preprocessor/iteration/detail/local.hpp:
+/usr/include/boost/archive/detail/interface_oarchive.hpp:
 
-/usr/include/boost/version.hpp:
+/usr/include/boost/asio/associated_allocator.hpp:
 
-/usr/include/boost/preprocessor/iteration/detail/iter/reverse1.hpp:
+/usr/include/asm-generic/types.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorBase.h:
+/usr/include/boost/asio/traits/equality_comparable.hpp:
 
-/usr/include/boost/type_traits/is_member_function_pointer.hpp:
+/usr/include/boost/fusion/mpl/at.hpp:
 
-/usr/include/boost/preprocessor/iteration/detail/iter/forward2.hpp:
+/usr/include/boost/asio/detail/wait_handler.hpp:
 
-/usr/include/boost/preprocessor/iteration/detail/bounds/upper2.hpp:
+/usr/include/boost/asio/detail/bind_handler.hpp:
 
-/usr/include/boost/preprocessor/iteration/detail/bounds/upper1.hpp:
+/usr/include/boost/asio/detail/call_stack.hpp:
 
-/usr/include/boost/preprocessor/iteration/detail/bounds/lower2.hpp:
+/usr/include/boost/asio/detail/throw_error.hpp:
 
-/usr/include/boost/preprocessor/iteration/detail/bounds/lower1.hpp:
+/usr/include/boost/fusion/view/reverse_view/detail/deref_impl.hpp:
 
-/usr/include/boost/preprocessor/iterate.hpp:
+/usr/include/boost/archive/detail/basic_oserializer.hpp:
 
-/usr/include/boost/preprocessor/identity.hpp:
+/usr/include/boost/type_traits/is_base_of.hpp:
 
-/usr/include/boost/preprocessor/facilities/intercept.hpp:
+/usr/include/boost/mpl/aux_/config/overload_resolution.hpp:
 
-/usr/include/boost/range/iterator_range.hpp:
+/opt/openrobots/include/pinocchio/spatial/log.hpp:
 
-/usr/include/boost/preprocessor/facilities/expand.hpp:
+/usr/include/boost/fusion/container/list/detail/reverse_cons.hpp:
 
-/usr/include/boost/preprocessor/enum_params_with_a_default.hpp:
+/opt/openrobots/include/pinocchio/spatial/force-dense.hpp:
 
-/usr/include/boost/preprocessor/enum.hpp:
+/usr/include/boost/preprocessor/tuple/eat.hpp:
 
-/usr/include/boost/preprocessor/empty.hpp:
+/usr/include/boost/asio/execution/prefer_only.hpp:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/syslimits.h:
+/opt/openrobots/include/pinocchio/math/taylor-expansion.hpp:
 
-/usr/include/boost/serialization/collections_save_imp.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-basic-visitors.hpp:
 
-/usr/include/boost/preprocessor/detail/check.hpp:
+/usr/include/boost/asio/execution/set_value.hpp:
 
-/usr/include/boost/preprocessor/dec.hpp:
+/usr/include/boost/asio/ip/detail/impl/endpoint.ipp:
 
-/usr/include/c++/11/bits/this_thread_sleep.h:
+/opt/openrobots/include/pinocchio/multibody/visitor/joint-unary-visitor.hpp:
 
-/usr/include/boost/preprocessor/debug/error.hpp:
+/opt/openrobots/include/hpp/fcl/collision_func_matrix.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorIntDiv.h:
+/usr/include/boost/asio/execution/relationship.hpp:
 
-/usr/include/boost/preprocessor/control/while.hpp:
+/usr/include/boost/date_time/date_duration.hpp:
 
-/usr/include/boost/type_traits/remove_reference.hpp:
+/usr/include/boost/asio/detail/handler_tracking.hpp:
 
-/usr/include/boost/preprocessor/control/iif.hpp:
+/usr/include/boost/preprocessor/enum_shifted_params.hpp:
 
-/usr/include/linux/errno.h:
+/usr/include/x86_64-linux-gnu/bits/struct_mutex.h:
 
-/usr/include/boost/preprocessor/control/detail/while.hpp:
+/usr/include/boost/iterator/iterator_traits.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/__locale_t.h:
+/usr/include/boost/asio/impl/system_context.hpp:
 
-/usr/include/boost/preprocessor/comparison/not_equal.hpp:
+/usr/include/eigen3/Eigen/Cholesky:
 
-/usr/include/boost/preprocessor/comma_if.hpp:
+/usr/include/boost/asio/multiple_exceptions.hpp:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/opt_random.h:
+/usr/include/boost/fusion/support/void.hpp:
 
-/usr/include/boost/preprocessor/array/size.hpp:
+/usr/include/boost/asio/detail/winsock_init.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/Default/TypeCasting.h:
+/usr/include/boost/asio/detail/impl/service_registry.hpp:
 
-/usr/include/boost/preprocessor/array/elem.hpp:
+/usr/include/boost/lexical_cast.hpp:
 
-/usr/include/boost/preprocessor/array/data.hpp:
+/usr/include/boost/asio/ip/resolver_query_base.hpp:
 
-/usr/include/boost/preprocessor/arithmetic/mod.hpp:
+/usr/include/boost/mpl/apply.hpp:
 
-/usr/include/boost/preprocessor/arithmetic/inc.hpp:
+/usr/include/boost/type_traits/is_stateless.hpp:
 
-/usr/include/boost/preprocessor/arithmetic/detail/div_base.hpp:
+/usr/include/boost/mpl/list/aux_/clear.hpp:
 
-/usr/include/boost/preprocessor/arithmetic/add.hpp:
+/usr/include/boost/preprocessor/control/expr_if.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_convertible.hpp:
+/usr/include/boost/exception/exception.hpp:
 
-/usr/include/boost/predef/version_number.h:
+/usr/include/boost/mpl/same_as.hpp:
 
-/usr/include/boost/type_traits/is_member_pointer.hpp:
+/usr/include/boost/asio/traits/set_value_member.hpp:
 
-/usr/include/boost/type_traits/add_const.hpp:
+/usr/include/boost/fusion/container/vector/detail/advance_impl.hpp:
 
-/usr/include/boost/predef/other/endian.h:
+/usr/include/boost/function_types/detail/components_impl/arity20_0.hpp:
 
-/usr/include/boost/predef/os/macos.h:
+/usr/include/boost/asio/detail/deadline_timer_service.hpp:
 
-/usr/include/boost/predef/os/ios.h:
+/usr/include/boost/type_traits/has_divides_assign.hpp:
 
-/usr/include/boost/predef/os/bsd/net.h:
+/usr/include/c++/11/bits/list.tcc:
 
-/usr/include/x86_64-linux-gnu/bits/struct_rwlock.h:
+/usr/include/boost/mpl/aux_/has_apply.hpp:
 
-/usr/include/boost/predef/os/bsd/free.h:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsImpl.h:
 
-/usr/include/boost/predef/os/bsd/dragonfly.h:
+/usr/include/boost/date_time/posix_time/posix_time_system.hpp:
 
-/usr/include/boost/predef/make.h:
+/usr/include/alloca.h:
 
-/usr/include/boost/predef/detail/test.h:
+/usr/include/linux/stat.h:
 
-/usr/include/boost/predef/architecture/x86/64.h:
+/opt/openrobots/include/pinocchio/math/fwd.hpp:
 
-/usr/include/boost/predef/architecture/x86.h:
+/usr/include/x86_64-linux-gnu/bits/stdio_lim.h:
 
-/usr/include/boost/numeric/conversion/udt_builtin_mixture_enum.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-data-base.hpp:
 
-/usr/include/boost/numeric/conversion/sign_mixture_enum.hpp:
+/usr/include/boost/mpl/aux_/numeric_op.hpp:
 
-/usr/include/boost/numeric/conversion/numeric_cast_traits.hpp:
+/usr/include/boost/mpl/front.hpp:
 
-/usr/include/c++/11/bits/atomic_base.h:
+/usr/include/eigen3/Eigen/src/Core/Array.h:
 
-/usr/include/boost/numeric/conversion/int_float_mixture_enum.hpp:
+/usr/include/boost/iostreams/operations_fwd.hpp:
 
-/usr/include/boost/numeric/conversion/detail/udt_builtin_mixture.hpp:
+/opt/openrobots/include/pinocchio/spatial/symmetric3.hpp:
 
-/usr/include/boost/numeric/conversion/detail/sign_mixture.hpp:
+/opt/openrobots/include/pinocchio/algorithm/check.hpp:
 
-/usr/include/boost/numeric/conversion/detail/preprocessed/numeric_cast_traits_long_long.hpp:
+/usr/include/boost/smart_ptr/detail/shared_count.hpp:
 
-/usr/include/boost/range/detail/common.hpp:
+/usr/include/boost/mpl/single_view.hpp:
 
-/usr/include/boost/numeric/conversion/detail/preprocessed/numeric_cast_traits_common.hpp:
+/usr/include/boost/mpl/aux_/back_impl.hpp:
 
-/usr/include/boost/numeric/conversion/detail/meta.hpp:
+/usr/include/boost/concept/detail/backward_compatibility.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/socket_type.h:
+/usr/include/boost/fusion/algorithm/iteration/accumulate.hpp:
 
-/usr/include/boost/numeric/conversion/detail/int_float_mixture.hpp:
+/usr/include/boost/function_types/is_function.hpp:
 
-/usr/include/boost/numeric/conversion/detail/converter.hpp:
+/usr/include/boost/move/traits.hpp:
 
-/usr/include/wchar.h:
+/usr/include/boost/asio/detail/impl/null_event.ipp:
 
-/usr/include/eigen3/Eigen/src/plugins/MatrixCwiseUnaryOps.h:
+/opt/openrobots/include/pinocchio/math/comparison-operators.hpp:
 
-/usr/include/boost/numeric/conversion/detail/conversion_traits.hpp:
+/opt/openrobots/include/pinocchio/deprecated.hpp:
 
-/usr/include/boost/utility/binary.hpp:
+/usr/include/boost/config/workaround.hpp:
 
-/usr/include/boost/numeric/conversion/detail/bounds.hpp:
+/opt/openrobots/include/hpp/fcl/BV/kDOP.h:
 
-/usr/include/boost/type_traits/is_nothrow_move_constructible.hpp:
+/opt/openrobots/include/pinocchio/deprecated-namespaces.hpp:
 
-/usr/include/boost/numeric/conversion/converter_policies.hpp:
+/usr/include/boost/fusion/view/reverse_view/detail/key_of_impl.hpp:
 
-/usr/include/boost/numeric/conversion/conversion_traits.hpp:
+/usr/include/boost/type_traits/integral_constant.hpp:
 
-/usr/include/boost/numeric/conversion/bounds.hpp:
+/usr/include/c++/11/bits/stl_set.h:
 
-/usr/include/boost/type_traits/is_volatile.hpp:
+/usr/include/x86_64-linux-gnu/bits/select.h:
 
-/usr/include/boost/next_prior.hpp:
+/opt/openrobots/include/pinocchio/algorithm/jacobian.hxx:
 
-/usr/include/boost/mpl/vector/vector30.hpp:
+/usr/include/boost/asio/detail/epoll_reactor.hpp:
 
-/usr/include/boost/mpl/vector/vector10.hpp:
+/usr/include/eigen3/Eigen/src/Core/NoAlias.h:
 
-/usr/include/boost/mpl/vector/aux_/vector0.hpp:
+/usr/include/x86_64-linux-gnu/bits/flt-eval-method.h:
 
-/usr/include/boost/type_traits/is_const.hpp:
+/usr/local/include/ur_rtde/rtde_utility.h:
 
-/usr/include/boost/mpl/vector/aux_/tag.hpp:
+/usr/include/boost/fusion/algorithm/transformation/join.hpp:
 
-/usr/include/boost/mpl/vector/aux_/size.hpp:
+/usr/include/boost/range/rbegin.hpp:
 
-/usr/include/boost/mpl/vector/aux_/push_back.hpp:
+/usr/include/x86_64-linux-gnu/bits/siginfo-arch.h:
 
-/usr/include/boost/mpl/vector/aux_/iterator.hpp:
+/usr/include/boost/archive/detail/basic_iarchive.hpp:
 
-/usr/include/boost/mpl/vector/aux_/front.hpp:
+/usr/include/c++/11/complex:
 
-/usr/include/boost/mpl/vector/aux_/empty.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-algo.hpp:
 
-/usr/include/boost/mpl/vector/aux_/clear.hpp:
+/usr/include/boost/asio/execution/any_executor.hpp:
 
-/usr/include/boost/mpl/vector/aux_/back.hpp:
+/usr/include/boost/preprocessor/seq/first_n.hpp:
 
-/usr/include/boost/mpl/vector/aux_/at.hpp:
+/opt/openrobots/include/pinocchio/spatial/force-base.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/sched.h:
+/usr/include/boost/archive/detail/check.hpp:
 
-/usr/include/boost/mpl/vector/aux_/O1_size.hpp:
+/usr/include/boost/asio/detail/io_object_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/c++config.h:
+/usr/include/boost/mpl/aux_/msvc_never_true.hpp:
 
-/usr/include/c++/11/bits/std_function.h:
+/usr/include/boost/mpl/list/aux_/numbered.hpp:
 
-/usr/include/boost/mpl/vector.hpp:
+/usr/include/boost/fusion/container/vector/detail/end_impl.hpp:
 
-/usr/include/boost/type_traits/has_logical_or.hpp:
+/usr/include/boost/type_traits/has_trivial_constructor.hpp:
 
-/usr/include/boost/mpl/times.hpp:
+/usr/include/boost/config/no_tr1/cmath.hpp:
 
-/usr/include/boost/mpl/tag.hpp:
+/usr/include/boost/utility/identity_type.hpp:
 
-/usr/include/boost/mpl/sizeof.hpp:
+/usr/include/boost/fusion/support/detail/and.hpp:
 
-/usr/include/boost/mpl/size_t_fwd.hpp:
+/usr/include/netinet/tcp.h:
 
-/usr/include/boost/mpl/size_fwd.hpp:
+/usr/include/boost/fusion/adapted/mpl/detail/value_at_impl.hpp:
 
-/usr/include/boost/mpl/sequence_tag_fwd.hpp:
+/usr/include/boost/fusion/mpl/begin.hpp:
 
-/usr/include/c++/11/bits/enable_special_members.h:
+/usr/include/boost/preprocessor/repetition/enum_params_with_a_default.hpp:
 
-/usr/include/boost/mpl/remove_if.hpp:
+/usr/include/boost/asio/basic_stream_socket.hpp:
 
-/usr/include/c++/11/memory:
+/usr/include/eigen3/Eigen/src/Core/util/ReshapedHelper.h:
 
-/usr/include/boost/mpl/quote.hpp:
+/usr/include/x86_64-linux-gnu/bits/types/__fpos64_t.h:
 
-/usr/include/eigen3/Eigen/src/Core/GeneralProduct.h:
+/usr/include/boost/date_time/microsec_time_clock.hpp:
 
-/usr/include/boost/numeric/conversion/detail/is_subranged.hpp:
+/usr/local/include/ur_rtde/rtde_export.h:
 
-/usr/include/boost/bind/placeholders.hpp:
+/usr/include/boost/type_traits/aligned_storage.hpp:
 
-/usr/include/boost/asio/detail/reactive_socket_recvfrom_op.hpp:
+/usr/include/boost/config/detail/select_platform_config.hpp:
 
-/usr/include/c++/11/bits/stl_heap.h:
+/opt/openrobots/include/pinocchio/container/aligned-vector.hpp:
 
-/usr/include/boost/date_time/adjust_functors.hpp:
+/usr/include/boost/mpl/aux_/config/nttp.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/stdio.h:
+/usr/include/boost/function_types/detail/encoding/undef.hpp:
 
-/usr/include/boost/current_function.hpp:
+/usr/include/boost/asio/detail/throw_exception.hpp:
 
-/usr/include/boost/iostreams/detail/buffer.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-common-operations.hpp:
 
-/usr/include/boost/core/use_default.hpp:
+/usr/include/boost/fusion/view/reverse_view/detail/value_of_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/EigenBase.h:
+/usr/include/boost/asio/execution/execute.hpp:
 
-/usr/include/boost/preprocessor/logical/bool.hpp:
+/usr/include/boost/serialization/force_include.hpp:
 
-/usr/include/boost/core/pointer_traits.hpp:
+/usr/include/boost/asio/detail/handler_cont_helpers.hpp:
 
-/usr/include/boost/asio/detail/chrono.hpp:
+/usr/include/boost/mpl/aux_/has_key_impl.hpp:
 
-/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_end.hpp:
+/usr/include/boost/core/first_scalar.hpp:
 
-/usr/include/boost/core/demangle.hpp:
+/usr/include/boost/fusion/algorithm/query/count.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/GeneralMatrixMatrixTriangular.h:
+/usr/include/eigen3/Eigen/src/Core/products/TriangularSolverVector.h:
 
-/usr/include/boost/smart_ptr/detail/spinlock.hpp:
+/usr/include/boost/asio/detail/array_fwd.hpp:
 
-/usr/include/boost/container/detail/std_fwd.hpp:
+/usr/include/boost/fusion/iterator/deref_data.hpp:
 
-/usr/include/boost/config/user.hpp:
+/usr/include/boost/asio/detail/eventfd_select_interrupter.hpp:
 
-/usr/include/boost/mpl/aux_/config/dmc_ambiguous_ctps.hpp:
+/usr/include/eigen3/Eigen/src/Core/PermutationMatrix.h:
 
-/usr/include/boost/fusion/iterator/key_of.hpp:
+/usr/include/boost/iostreams/concepts.hpp:
 
-/usr/include/boost/type_traits/is_nothrow_move_assignable.hpp:
+/usr/include/boost/archive/binary_oarchive.hpp:
 
-/usr/include/boost/mpl/aux_/full_lambda.hpp:
+/usr/include/boost/preprocessor/iteration/local.hpp:
 
-/usr/include/boost/config/no_tr1/memory.hpp:
+/usr/include/boost/mpl/aux_/na.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/MatrixBase.h:
+/usr/include/eigen3/Eigen/src/Core/IO.h:
 
-/usr/include/boost/mpl/push_back_fwd.hpp:
+/usr/include/boost/mpl/aux_/msvc_eti_base.hpp:
 
-/usr/include/boost/config/no_tr1/complex.hpp:
+/usr/include/boost/mpl/size.hpp:
 
-/usr/include/boost/asio/detail/is_buffer_sequence.hpp:
+/opt/openrobots/include/pinocchio/spatial/se3-base.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/fwd.hpp:
+/opt/openrobots/include/pinocchio/spatial/force-ref.hpp:
 
-/usr/include/boost/config/no_tr1/utility.hpp:
+/usr/include/boost/fusion/adapted/mpl/detail/at_impl.hpp:
 
-/usr/include/boost/config/abi_prefix.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-free-flyer.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/stdint-uintn.h:
+/usr/include/boost/move/detail/config_end.hpp:
 
-/usr/include/boost/concept_check.hpp:
+/usr/include/boost/fusion/view/transform_view/detail/deref_impl.hpp:
 
-/usr/include/boost/concept/detail/backward_compatibility.hpp:
+/usr/include/c++/11/bits/memoryfwd.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorEvalTo.h:
+/usr/include/eigen3/Eigen/src/Eigenvalues/GeneralizedSelfAdjointEigenSolver.h:
 
-/usr/include/boost/mpl/bitand.hpp:
+/usr/include/boost/date_time/special_defs.hpp:
 
-/usr/include/boost/cerrno.hpp:
+/opt/openrobots/include/pinocchio/eigen-macros.hpp:
 
-/usr/include/unistd.h:
+/usr/include/boost/mpl/aux_/config/integral.hpp:
 
-/usr/include/boost/bind/storage.hpp:
+/usr/include/boost/asio/impl/system_executor.hpp:
 
-/usr/include/boost/type_traits/has_virtual_destructor.hpp:
+/usr/include/boost/bind/bind.hpp:
 
-/usr/include/boost/iostreams/detail/ios.hpp:
+/opt/openrobots/include/pinocchio/algorithm/joint-configuration.hpp:
 
-/usr/include/boost/bind/mem_fn.hpp:
+/usr/include/c++/11/iostream:
 
-/usr/include/boost/preprocessor/config/config.hpp:
+/usr/include/c++/11/streambuf:
 
-/usr/include/boost/bind/bind_cc.hpp:
+/usr/include/boost/fusion/support/category_of.hpp:
 
-/usr/include/boost/asio/traits/bulk_execute_free.hpp:
+/usr/include/boost/asio/basic_deadline_timer.hpp:
 
-/usr/include/boost/container_hash/hash_fwd.hpp:
+/usr/include/boost/asio/detail/pop_options.hpp:
 
-/usr/include/boost/core/noinit_adaptor.hpp:
+/usr/include/boost/iostreams/detail/iostream.hpp:
 
-/usr/include/boost/asio/detail/resolver_service_base.hpp:
+/opt/openrobots/include/pinocchio/spatial/fwd.hpp:
 
-/usr/include/boost/mpl/or.hpp:
+/usr/include/boost/iostreams/detail/buffer.hpp:
 
-/usr/include/boost/core/checked_delete.hpp:
+/usr/include/boost/current_function.hpp:
 
-/usr/include/boost/asio/traits/static_query.hpp:
+/opt/openrobots/include/hpp/fcl/BV/kIOS.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/struct_sigstack.h:
+/opt/openrobots/include/hpp/fcl/mesh_loader/assimp.h:
 
-/usr/include/c++/11/cmath:
+/usr/include/c++/11/ext/concurrence.h:
 
-/usr/include/boost/mpl/size_t.hpp:
+/usr/include/boost/fusion/algorithm/iteration/fold.hpp:
 
-/opt/openrobots/include/pinocchio/serialization/archive.hpp:
+/opt/openrobots/include/pinocchio/algorithm/joint-configuration.hxx:
 
-/usr/include/boost/numeric/conversion/detail/numeric_cast_traits.hpp:
+/usr/include/c++/11/cstring:
 
-/usr/include/boost/iterator/iterator_facade.hpp:
+/opt/openrobots/include/pinocchio/deprecation.hpp:
 
-/usr/include/boost/preprocessor/iteration/detail/iter/forward1.hpp:
+/opt/openrobots/include/hpp/fcl/shape/geometric_shapes.h:
 
-/usr/include/boost/preprocessor/facilities/overload.hpp:
+/usr/include/boost/math/special_functions/nonfinite_num_facets.hpp:
 
-/usr/include/boost/asio/traits/set_error_member.hpp:
+/usr/include/boost/move/detail/workaround.hpp:
 
-/usr/include/boost/asio/traits/set_done_free.hpp:
+/usr/include/boost/preprocessor/control/deduce_d.hpp:
 
-/usr/include/boost/asio/traits/require_member.hpp:
+/usr/include/boost/type_traits/add_reference.hpp:
 
-/usr/include/boost/asio/traits/require_free.hpp:
+/usr/include/boost/type_traits/is_copy_assignable.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/distance_impl.hpp:
+/usr/include/boost/preprocessor/arithmetic/sub.hpp:
 
-/usr/include/boost/move/detail/config_begin.hpp:
+/usr/include/boost/preprocessor/tuple/rem.hpp:
 
-/usr/include/boost/type_traits/remove_all_extents.hpp:
+/usr/include/boost/asio/detail/wrapped_handler.hpp:
 
-/usr/include/boost/asio/traits/execute_member.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/TriangularSolverMatrix.h:
 
-/usr/include/boost/predef/os/bsd/bsdi.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorMacros.h:
 
-/usr/include/boost/asio/system_context.hpp:
+/usr/include/boost/asio/detail/assert.hpp:
 
-/usr/include/boost/asio/require.hpp:
+/usr/include/asm-generic/int-ll64.h:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/ctype_inline.h:
+/usr/include/boost/blank_fwd.hpp:
 
-/usr/include/boost/asio/detail/null_event.hpp:
+/usr/include/boost/config/stdlib/libstdcpp3.hpp:
 
-/usr/include/boost/math/tools/real_cast.hpp:
+/opt/openrobots/include/hpp/fcl/BV/OBB.h:
 
-/usr/include/boost/cstdint.hpp:
+/usr/include/boost/lexical_cast/detail/is_character.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/explog.hpp:
+/usr/include/boost/fusion/view/filter_view/detail/value_of_impl.hpp:
 
-/usr/include/boost/fusion/adapted/mpl/detail/end_impl.hpp:
+/usr/include/boost/asio/basic_streambuf.hpp:
 
-/usr/include/boost/asio/prefer.hpp:
+/usr/include/boost/asio/detail/thread.hpp:
 
-/usr/include/boost/concept/detail/has_constraints.hpp:
+/usr/include/boost/asio/detail/impl/eventfd_select_interrupter.ipp:
 
-/usr/include/boost/system/detail/std_interoperability.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-prismatic.hpp:
 
-/usr/include/boost/date_time/compiler_config.hpp:
+/usr/include/boost/predef/architecture/x86/32.h:
 
-/usr/include/boost/iostreams/traits.hpp:
+/usr/include/boost/smart_ptr/detail/local_sp_deleter.hpp:
 
-/usr/include/boost/checked_delete.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-spherical-ZYX.hpp:
 
-/usr/include/boost/date_time/time_defs.hpp:
+/opt/openrobots/include/pinocchio/math/sincos.hpp:
 
-/usr/include/boost/fusion/view/single_view/detail/advance_impl.hpp:
+/usr/include/boost/mpl/O1_size_fwd.hpp:
 
-/usr/include/boost/mpl/sequence_tag.hpp:
+/usr/include/eigen3/Eigen/src/Householder/Householder.h:
 
-/usr/include/boost/archive/archive_exception.hpp:
+/opt/openrobots/include/pinocchio/warning.hpp:
 
-/usr/include/boost/asio/is_applicable_property.hpp:
+/usr/include/boost/asio/detail/impl/posix_event.ipp:
 
-/usr/include/boost/archive/basic_streambuf_locale_saver.hpp:
+/usr/include/boost/mpl/pop_back_fwd.hpp:
 
-/usr/include/boost/mpl/aux_/size_impl.hpp:
+/usr/include/boost/fusion/support/detail/is_native_fusion_sequence.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/equal_to_impl.hpp:
+/usr/include/boost/fusion/view/zip_view/detail/distance_impl.hpp:
 
-/usr/include/boost/mpl/transform.hpp:
+/usr/include/boost/preprocessor/control/detail/while.hpp:
 
-/usr/include/boost/fusion/iterator/advance.hpp:
+/usr/include/linux/errno.h:
 
-/usr/include/boost/preprocessor/repetition/repeat_from_to.hpp:
+/usr/include/eigen3/Eigen/SVD:
 
-/usr/include/boost/iostreams/read.hpp:
+/usr/include/boost/asio/detail/buffer_sequence_adapter.hpp:
 
-/usr/include/boost/date_time/gregorian/gregorian_types.hpp:
+/usr/include/boost/mpl/vector/aux_/pop_front.hpp:
 
-/usr/include/boost/asio/ip/impl/address_v6.ipp:
+/usr/include/boost/fusion/view/single_view/detail/equal_to_impl.hpp:
 
-/usr/include/boost/bind/arg.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/vector-space.hpp:
 
-/opt/openrobots/include/pinocchio/fwd.hpp:
+/usr/include/boost/asio/detail/handler_work.hpp:
 
-/usr/include/boost/asio/ip/impl/address.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/special-euclidean.hpp:
 
-/usr/include/boost/asio/ip/impl/address_v4.ipp:
+/usr/include/boost/mpl/insert_range_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/Memory.h:
+/usr/include/boost/fusion/algorithm/iteration/detail/for_each.hpp:
 
-/usr/include/boost/math/special_functions/sign.hpp:
+/usr/include/eigen3/Eigen/src/misc/Image.h:
 
-/usr/include/boost/mpl/integral_c.hpp:
+/usr/include/boost/asio/traits/set_done_member.hpp:
 
-/opt/openrobots/include/hpp/fcl/fwd.hh:
+/usr/include/boost/fusion/view/single_view/detail/size_impl.hpp:
 
-/usr/include/boost/fusion/support/detail/access.hpp:
+/usr/include/boost/lexical_cast/detail/converter_lexical_streams.hpp:
 
-/usr/include/boost/iostreams/stream.hpp:
+/usr/include/boost/archive/text_oarchive.hpp:
 
-/usr/include/boost/mpl/limits/vector.hpp:
+/opt/openrobots/include/hpp/fcl/BV/BV.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorConvolution.h:
+/usr/include/boost/mpl/aux_/config/typeof.hpp:
 
-/usr/include/boost/asio/basic_socket_iostream.hpp:
+/usr/include/boost/type_traits/disjunction.hpp:
 
-/usr/include/boost/asio/traits/submit_free.hpp:
+/usr/include/boost/asio/detail/impl/timer_queue_set.ipp:
 
-/usr/include/c++/11/bits/sstream.tcc:
+/opt/openrobots/include/pinocchio/deprecated-macros.hpp:
 
-/usr/include/boost/preprocessor/arithmetic/dec.hpp:
+/usr/include/c++/11/bits/algorithmfwd.h:
 
-/usr/include/boost/asio/ip/basic_resolver_iterator.hpp:
+/usr/include/boost/fusion/view/reverse_view/detail/value_of_data_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/BlasUtil.h:
+/usr/include/boost/fusion/algorithm/transformation/detail/preprocessed/zip10.hpp:
 
-/usr/include/boost/fusion/support/sequence_base.hpp:
+/opt/openrobots/include/pinocchio/math/tensor.hpp:
 
-/usr/include/boost/iostreams/detail/config/limits.hpp:
+/usr/include/boost/operators.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_has_sync_intrinsics.hpp:
+/usr/include/boost/asio/impl/post.hpp:
 
-/usr/include/boost/iostreams/detail/forward.hpp:
+/usr/include/boost/iostreams/detail/config/wide_streams.hpp:
 
-/usr/include/boost/type_traits/has_pre_increment.hpp:
+/usr/include/boost/mpl/remove.hpp:
 
-/usr/include/boost/asio/impl/multiple_exceptions.ipp:
+/opt/openrobots/include/pinocchio/algorithm/jacobian.hpp:
 
-/usr/include/boost/asio/impl/io_context.hpp:
+/usr/include/boost/type_traits/conversion_traits.hpp:
 
-/usr/include/boost/asio/impl/execution_context.ipp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContraction.h:
 
-/usr/include/c++/11/bits/hashtable_policy.h:
+/usr/include/c++/11/clocale:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-prismatic-unaligned.hpp:
+/usr/include/boost/config/helper_macros.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/force-tpl.hpp:
+/opt/openrobots/include/hpp/fcl/narrowphase/narrowphase.h:
 
-/usr/include/boost/asio/socket_base.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/Hyperplane.h:
 
-/usr/include/x86_64-linux-gnu/bits/ss_flags.h:
+/opt/openrobots/include/pinocchio/multibody/constraint-base.hpp:
 
-/usr/include/boost/serialization/type_info_implementation.hpp:
+/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp:
 
-/usr/include/boost/concept/detail/concept_def.hpp:
+/usr/include/boost/asio/detail/impl/timer_queue_ptime.ipp:
 
-/usr/include/boost/asio/impl/execution_context.hpp:
+/usr/include/boost/asio/detail/thread_info_base.hpp:
 
-/usr/include/boost/asio/impl/error.ipp:
+/usr/include/boost/mpl/aux_/front_impl.hpp:
 
-/usr/include/boost/preprocessor/seq/cat.hpp:
+/usr/include/boost/type_traits/promote.hpp:
 
-/usr/include/boost/asio/execution/sender.hpp:
+/usr/include/boost/bind/bind_mf_cc.hpp:
 
-/usr/include/boost/mpl/back_inserter.hpp:
+/usr/include/eigen3/Eigen/src/Core/DenseStorage.h:
 
-/usr/include/boost/asio/execution/receiver.hpp:
+/usr/include/boost/fusion/container/vector/detail/prior_impl.hpp:
 
-/usr/include/boost/asio/execution/outstanding_work.hpp:
+/usr/include/boost/mpl/list/aux_/size.hpp:
 
-/usr/include/boost/variant/bad_visit.hpp:
+/opt/openrobots/include/hpp/fcl/BVH/BVH_model.h:
 
-/usr/include/boost/type_traits/has_post_decrement.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-planar.hpp:
 
-/usr/include/boost/asio/traits/set_error_free.hpp:
+/usr/include/boost/core/addressof.hpp:
 
-/usr/include/boost/asio/execution/operation_state.hpp:
+/usr/include/boost/fusion/view/zip_view.hpp:
 
-/usr/include/boost/type_traits/conditional.hpp:
+/usr/include/boost/asio/detail/keyword_tss_ptr.hpp:
 
-/usr/include/boost/asio/execution/mapping.hpp:
+/usr/include/boost/serialization/strong_typedef.hpp:
 
-/usr/include/boost/archive/xml_iarchive.hpp:
+/usr/include/c++/11/locale:
 
-/usr/include/wctype.h:
+/usr/include/boost/lexical_cast/detail/inf_nan.hpp:
 
-/usr/include/boost/asio/execution/receiver_invocation_error.hpp:
+/usr/include/boost/fusion/view/joint_view/detail/key_of_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/struct_statx.h:
+/usr/include/boost/preprocessor/cat.hpp:
 
-/usr/include/boost/iterator/reverse_iterator.hpp:
+/opt/openrobots/include/pinocchio/spatial/motion-ref.hpp:
 
-/usr/include/boost/core/default_allocator.hpp:
+/usr/include/boost/fusion/view/single_view/detail/value_of_impl.hpp:
 
-/usr/include/boost/asio/impl/system_context.ipp:
+/usr/include/boost/asio/execution/scheduler.hpp:
 
-/usr/include/boost/function_types/parameter_types.hpp:
+/usr/include/boost/fusion/sequence/intrinsic/has_key.hpp:
 
-/opt/openrobots/include/pinocchio/config.hpp:
+/usr/include/boost/date_time/date.hpp:
 
-/usr/include/boost/archive/codecvt_null.hpp:
+/usr/include/boost/mpl/inherit.hpp:
 
-/usr/include/eigen3/Eigen/src/StlSupport/details.h:
+/opt/openrobots/include/hpp/fcl/distance_func_matrix.h:
 
-/usr/include/boost/asio/execution/detail/void_receiver.hpp:
+/opt/openrobots/include/pinocchio/utils/axis-label.hpp:
 
-/usr/include/boost/asio/detail/posix_mutex.hpp:
+/usr/include/boost/asio/execution/set_done.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/mathcalls-helper-functions.h:
+/opt/openrobots/include/pinocchio/algorithm/check.hxx:
 
-/usr/include/boost/type_traits/detail/is_function_cxx_11.hpp:
+/usr/include/c++/11/stdlib.h:
 
-/usr/include/boost/asio/execution/detail/submit_receiver.hpp:
+/opt/openrobots/include/pinocchio/math/matrix-block.hpp:
 
-/usr/include/boost/asio/execution/detail/as_receiver.hpp:
+/usr/include/boost/iostreams/detail/double_object.hpp:
 
-/usr/include/c++/11/cctype:
+/opt/openrobots/include/pinocchio/algorithm/kinematics.hpp:
 
-/usr/include/boost/preprocessor/detail/auto_rec.hpp:
+/usr/include/boost/iostreams/operations.hpp:
 
-/usr/include/boost/mpl/aux_/msvc_type.hpp:
+/usr/include/eigen3/Eigen/src/Core/Map.h:
 
-/opt/openrobots/include/hpp/fcl/deprecated.hh:
+/usr/include/boost/archive/detail/helper_collection.hpp:
 
-/usr/include/boost/mpl/aux_/preprocessor/default_params.hpp:
+/usr/include/boost/asio/detail/config.hpp:
 
-/usr/include/boost/asio/execution/detail/as_invocable.hpp:
+/usr/include/boost/call_traits.hpp:
 
-/usr/include/boost/asio/ip/impl/address.ipp:
+/usr/include/boost/integer_fwd.hpp:
 
-/usr/include/boost/asio/execution/blocking.hpp:
+/usr/include/eigen3/Eigen/src/Core/CwiseUnaryOp.h:
 
-/usr/include/boost/asio/execution/connect.hpp:
+/usr/include/boost/fusion/view/joint_view/detail/begin_impl.hpp:
 
-/usr/include/boost/date_time/date_duration_types.hpp:
+/opt/openrobots/include/hpp/fcl/mesh_loader/loader.h:
 
-/usr/include/boost/asio/execution/bad_executor.hpp:
+/usr/include/boost/asio/detail/reactive_socket_send_op.hpp:
 
-/usr/include/boost/asio/detail/variadic_templates.hpp:
+/usr/include/boost/archive/basic_binary_oprimitive.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/timerfd.h:
+/usr/include/boost/fusion/view/reverse_view/detail/deref_data_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/sigcontext.h:
+/usr/include/boost/iterator/iterator_facade.hpp:
 
-/usr/include/boost/asio/error.hpp:
+/usr/include/boost/numeric/conversion/detail/numeric_cast_traits.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/constraint-generic.hpp:
+/usr/include/boost/core/allocator_access.hpp:
 
-/usr/include/boost/asio/detail/timer_queue_set.hpp:
+/usr/include/boost/asio/ip/basic_resolver_entry.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/statx.h:
+/usr/include/eigen3/Eigen/src/SVD/SVDBase.h:
 
-/usr/include/boost/asio/detail/array.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup.hpp:
 
-/usr/include/c++/11/type_traits:
+/usr/include/boost/fusion/algorithm/query/find_if.hpp:
 
-/usr/include/boost/asio/detail/timer_queue_base.hpp:
+/usr/include/boost/preprocessor/repetition/repeat.hpp:
 
-/usr/include/boost/asio/detail/socket_holder.hpp:
+/usr/include/boost/asio/traits/connect_member.hpp:
 
-/usr/include/boost/asio/detail/timer_queue.hpp:
+/usr/include/asm-generic/socket.h:
 
-/usr/include/eigen3/Eigen/src/Core/DenseStorage.h:
+/usr/include/boost/preprocessor/list/adt.hpp:
 
-/usr/include/boost/bind/bind_mf_cc.hpp:
+/usr/include/boost/archive/detail/auto_link_archive.hpp:
 
-/usr/include/boost/type_traits/promote.hpp:
+/usr/include/eigen3/Eigen/src/Core/NumTraits.h:
 
-/usr/include/boost/fusion/view/joint_view/detail/value_of_impl.hpp:
+/usr/include/boost/archive/detail/basic_pointer_iserializer.hpp:
 
-/usr/include/boost/asio/detail/string_view.hpp:
+/usr/include/boost/integer/common_factor_ct.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/time.h:
+/usr/include/c++/11/bits/cpp_type_traits.h:
 
-/usr/include/x86_64-linux-gnu/bits/fp-logb.h:
+/usr/include/boost/fusion/iterator/detail/advance.hpp:
 
-/usr/include/c++/11/csignal:
+/opt/openrobots/include/pinocchio/math/quaternion.hpp:
 
-/usr/include/boost/asio/execution/occupancy.hpp:
+/opt/openrobots/include/pinocchio/multibody/constraint.hpp:
 
-/usr/include/boost/asio/detail/std_fenced_block.hpp:
+/usr/include/boost/mpl/aux_/find_if_pred.hpp:
 
-/usr/include/boost/archive/binary_oarchive_impl.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-translation.hpp:
 
-/usr/include/boost/asio/any_io_executor.hpp:
+/opt/openrobots/include/pinocchio/multibody/data.hpp:
 
-/usr/include/boost/fusion/support/tag_of_fwd.hpp:
+/usr/include/boost/mpl/aux_/arg_typedef.hpp:
 
-/usr/include/boost/asio/detail/socket_types.hpp:
+/usr/include/c++/11/bits/char_traits.h:
 
-/usr/include/boost/preprocessor/facilities/identity.hpp:
+/usr/include/boost/fusion/container/list/convert.hpp:
 
-/usr/include/boost/preprocessor/detail/is_binary.hpp:
+/usr/include/boost/archive/basic_xml_iarchive.hpp:
 
-/usr/include/boost/mpl/vector/aux_/begin_end.hpp:
+/usr/include/boost/lexical_cast/detail/widest_char.hpp:
 
-/usr/include/boost/asio/detail/socket_option.hpp:
+/usr/include/boost/fusion/container/vector/vector10.hpp:
 
-/usr/include/boost/mpl/push_front_fwd.hpp:
+/opt/openrobots/include/pinocchio/macros.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/SelfCwiseBinaryOp.h:
+/usr/include/boost/core/is_same.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Matrix.h:
+/usr/include/boost/predef/platform/android.h:
 
-/usr/include/boost/asio/detail/socket_ops.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsArrayAPI.h:
 
-/usr/include/x86_64-linux-gnu/bits/sockaddr.h:
+/opt/openrobots/include/pinocchio/parsers/urdf/geometry.hxx:
 
-/usr/include/boost/asio/detail/scoped_ptr.hpp:
+/usr/include/boost/asio/ip/basic_resolver_query.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorUInt128.h:
+/usr/include/boost/asio/detail/conditionally_enabled_event.hpp:
 
-/usr/include/boost/asio/detail/impl/reactive_socket_service_base.ipp:
+/usr/include/boost/preprocessor/seq/for_each_i.hpp:
 
-/usr/include/boost/config/platform/linux.hpp:
+/opt/openrobots/include/pinocchio/spatial/motion-base.hpp:
 
-/usr/include/boost/asio/detail/scoped_lock.hpp:
+/usr/include/boost/integer_traits.hpp:
 
-/usr/include/boost/fusion/view/iterator_range/detail/at_impl.hpp:
+/usr/include/boost/archive/text_iarchive.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/GeneralMatrixMatrix.h:
+/opt/openrobots/include/hpp/fcl/warning.hh:
 
-/usr/include/boost/asio/detail/scheduler_operation.hpp:
+/usr/include/boost/asio/execution/executor.hpp:
 
-/usr/include/boost/iostreams/positioning.hpp:
+/usr/include/eigen3/Eigen/src/Core/NestByValue.h:
 
-/usr/include/boost/asio/detail/impl/resolver_service_base.ipp:
+/usr/include/boost/asio/detail/cstdint.hpp:
 
-/usr/include/boost/lexical_cast/detail/lcast_char_constants.hpp:
+/opt/openrobots/include/pinocchio/multibody/visitor/fusion.hpp:
 
-/usr/include/c++/11/bits/parse_numbers.h:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-base.hpp:
 
-/usr/include/boost/mpl/aux_/clear_impl.hpp:
+/usr/include/boost/asio/detail/type_traits.hpp:
 
-/usr/include/boost/asio/detail/scheduler.hpp:
+/usr/include/boost/fusion/algorithm/iteration/for_each.hpp:
 
-/usr/include/boost/preprocessor/seq/elem.hpp:
+/usr/include/boost/mpl/vector/aux_/pop_back.hpp:
 
-/usr/include/boost/preprocessor/seq/detail/is_empty.hpp:
+/usr/include/boost/mpl/end.hpp:
 
-/usr/include/boost/date_time/posix_time/date_duration_operators.hpp:
+/usr/include/boost/fusion/support/tag_of.hpp:
 
-/usr/include/c++/11/fstream:
+/usr/include/boost/mpl/aux_/advance_forward.hpp:
 
-/usr/include/boost/asio/detail/resolver_service.hpp:
+/usr/include/boost/foreach.hpp:
 
-/usr/include/eigen3/Eigen/src/plugins/BlockMethods.h:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-revolute-unbounded.hpp:
 
-/usr/include/boost/fusion/support/detail/segmented_fold_until_impl.hpp:
+/usr/include/boost/asio/detail/thread_context.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDeviceGpu.h:
+/usr/include/boost/serialization/split_free.hpp:
 
-/usr/include/boost/mpl/insert.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-composite.hxx:
 
-/usr/include/boost/smart_ptr/detail/yield_k.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDeviceDefault.h:
 
-/usr/include/boost/mpl/pair_view.hpp:
+/usr/include/boost/fusion/container/set/set_fwd.hpp:
 
-/usr/include/boost/asio/execution/bulk_guarantee.hpp:
+/usr/include/boost/mpl/contains.hpp:
 
-/usr/include/eigen3/Eigen/src/Cholesky/LDLT.h:
+/opt/openrobots/include/pinocchio/serialization/fwd.hpp:
 
-/usr/include/boost/math/special_functions/fpclassify.hpp:
+/usr/include/boost/mpl/aux_/comparison_op.hpp:
 
-/usr/include/boost/asio/traits/start_member.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-basic-visitors.hxx:
 
-/usr/include/boost/asio/detail/resolve_query_op.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-generic.hpp:
 
-/usr/include/boost/asio/detail/resolve_endpoint_op.hpp:
+/usr/include/boost/asio/post.hpp:
 
-/usr/include/boost/type_traits/is_signed.hpp:
+/usr/include/eigen3/Eigen/src/Core/functors/AssignmentFunctors.h:
 
-/usr/include/boost/asio/detail/reactor_fwd.hpp:
+/opt/openrobots/include/pinocchio/multibody/visitor.hpp:
 
-/usr/include/boost/asio/detail/reactor.hpp:
+/opt/openrobots/include/hpp/fcl/config.hh:
 
-/usr/include/x86_64-linux-gnu/bits/unistd.h:
+/usr/include/boost/asio/basic_waitable_timer.hpp:
 
-/usr/include/boost/asio/detail/reactive_wait_op.hpp:
+/usr/include/boost/type_traits/has_less_equal.hpp:
 
-/usr/include/boost/mpl/at_fwd.hpp:
+/usr/include/boost/date_time/posix_time/posix_time_duration.hpp:
 
-/usr/include/boost/asio/execution/submit.hpp:
+/usr/include/asm-generic/errno-base.h:
 
-/usr/include/boost/system/detail/generic_category.hpp:
+/usr/include/boost/type_traits/has_equal_to.hpp:
 
-/usr/include/boost/asio/detail/executor_op.hpp:
+/opt/openrobots/include/pinocchio/spatial/force.hpp:
 
-/usr/include/boost/asio/detail/reactive_socket_service_base.hpp:
+/opt/openrobots/include/pinocchio/multibody/fcl.hpp:
 
-/usr/include/boost/serialization/level.hpp:
+/usr/include/boost/fusion/view/reverse_view/detail/begin_impl.hpp:
 
-/usr/include/boost/config/abi_suffix.hpp:
+/usr/include/boost/config/compiler/gcc.hpp:
 
-/usr/include/boost/bind/mem_fn_cc.hpp:
+/usr/include/boost/mpl/comparison.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/IndexedViewHelper.h:
+/usr/include/boost/asio/detail/wait_op.hpp:
 
-/usr/include/boost/mpl/aux_/push_front_impl.hpp:
+/usr/include/boost/type_traits/is_unscoped_enum.hpp:
 
-/usr/include/boost/asio/traits/schedule_free.hpp:
+/usr/include/boost/fusion/algorithm/transformation/zip.hpp:
 
-/usr/include/boost/asio/traits/prefer_free.hpp:
+/usr/include/boost/math/policies/error_handling.hpp:
 
-/usr/include/boost/asio/detail/reactive_socket_recv_op.hpp:
+/usr/include/boost/asio/traits/start_free.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/stdlib-float.h:
+/usr/include/boost/iostreams/flush.hpp:
 
-/usr/include/boost/asio/ip/address.hpp:
+/usr/include/boost/fusion/container/vector/vector.hpp:
 
-/usr/include/boost/asio/detail/reactive_socket_connect_op.hpp:
+/usr/include/c++/11/bits/stl_pair.h:
 
-/opt/openrobots/include/hpp/fcl/collision_data.h:
+/usr/include/boost/asio/impl/handler_alloc_hook.ipp:
 
-/usr/include/boost/asio/ip/impl/address_v4.hpp:
+/usr/include/asm-generic/ioctls.h:
 
-/usr/include/boost/iostreams/detail/template_params.hpp:
+/usr/include/boost/iterator/detail/facade_iterator_category.hpp:
 
-/usr/include/boost/asio/detail/reactive_socket_accept_op.hpp:
+/usr/include/boost/fusion/view/transform_view/detail/begin_impl.hpp:
 
-/usr/include/boost/core/alloc_construct.hpp:
+/usr/include/boost/type_traits/has_bit_and_assign.hpp:
 
-/usr/include/boost/type_traits/conjunction.hpp:
+/usr/include/linux/types.h:
 
-/usr/include/boost/smart_ptr/detail/sp_disable_deprecated.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-revolute-unbounded-unaligned.hpp:
 
-/usr/include/boost/asio/traits/static_require.hpp:
+/usr/include/boost/variant/variant_fwd.hpp:
 
-/usr/include/boost/asio/detail/posix_thread.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-algo.hxx:
 
-/usr/include/c++/11/bits/stl_iterator_base_funcs.h:
+/usr/include/boost/archive/basic_binary_oarchive.hpp:
 
-/usr/include/boost/date_time/constrained_value.hpp:
+/opt/openrobots/include/hpp/fcl/BV/AABB.h:
 
-/usr/include/boost/fusion/support/is_view.hpp:
+/usr/include/boost/asio/execution/impl/bad_executor.ipp:
 
-/usr/include/boost/type_traits/copy_reference.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-base.hxx:
 
-/usr/include/boost/asio/execution/impl/receiver_invocation_error.ipp:
+/usr/include/x86_64-linux-gnu/c++/11/bits/c++locale.h:
 
-/usr/include/boost/asio/detail/posix_signal_blocker.hpp:
+/opt/openrobots/include/pinocchio/spatial/fcl-pinocchio-conversions.hpp:
 
-/usr/include/boost/mpl/aux_/lambda_support.hpp:
+/usr/include/boost/asio/traits/query_static_constexpr_member.hpp:
 
-/usr/include/x86_64-linux-gnu/asm/posix_types.h:
+/usr/include/boost/core/enable_if.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorInflation.h:
+/usr/include/boost/asio/detail/select_interrupter.hpp:
 
-/usr/include/boost/noncopyable.hpp:
+/opt/openrobots/include/pinocchio/serialization/eigen.hpp:
 
-/usr/include/boost/config.hpp:
+/usr/include/boost/range/iterator.hpp:
 
-/usr/include/boost/asio/detail/push_options.hpp:
+/usr/include/boost/fusion/view/filter_view/detail/key_of_impl.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joints.hpp:
+/usr/include/boost/mpl/aux_/fold_impl_body.hpp:
 
-/usr/include/boost/asio/detail/non_const_lvalue.hpp:
+/usr/include/boost/fusion/view/transform_view/detail/at_impl.hpp:
 
-/usr/include/boost/asio/execution/start.hpp:
+/usr/include/boost/core/ref.hpp:
 
-/usr/include/boost/date_time/date_iterator.hpp:
+/opt/openrobots/include/hpp/fcl/narrowphase/gjk.h:
 
-/usr/include/boost/variant/recursive_wrapper.hpp:
+/usr/include/boost/asio/detail/signal_blocker.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_noexcept.hpp:
+/usr/include/boost/fusion/adapted/mpl/detail/category_of_impl.hpp:
 
-/usr/include/boost/mpl/min_max.hpp:
+/opt/openrobots/include/pinocchio/serialization/static-buffer.hpp:
 
-/usr/include/c++/11/bits/postypes.h:
+/usr/include/boost/asio/buffer.hpp:
 
-/usr/include/boost/blank.hpp:
+/usr/include/boost/serialization/smart_cast.hpp:
 
-/usr/include/boost/asio/detail/impl/handler_tracking.ipp:
+/usr/include/boost/mpl/aux_/reverse_fold_impl_body.hpp:
 
-/usr/include/time.h:
+/opt/openrobots/include/hpp/fcl/math/transform.h:
 
-/usr/include/boost/asio/detail/thread_group.hpp:
+/usr/include/boost/mem_fn.hpp:
 
-/usr/include/boost/mpl/vector/vector20.hpp:
+/usr/include/c++/11/bits/basic_string.tcc:
 
-/usr/include/boost/asio/traits/query_member.hpp:
+/usr/include/boost/fusion/view/filter_view/detail/size_impl.hpp:
 
-/usr/include/boost/date_time/time_system_split.hpp:
+/usr/include/boost/fusion/view/zip_view/zip_view_iterator_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Transpose.h:
+/usr/include/boost/config/detail/suffix.hpp:
 
-/usr/include/boost/asio/detail/service_registry.hpp:
+/usr/include/boost/fusion/view/filter_view/filter_view.hpp:
 
-/usr/include/boost/fusion/support/detail/is_mpl_sequence.hpp:
+/usr/include/boost/asio/ip/basic_resolver.hpp:
 
-/usr/include/boost/asio/detail/operation.hpp:
+/usr/include/boost/system/system_error.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:
+/usr/include/boost/fusion/adapted/mpl/detail/is_view_impl.hpp:
 
-/usr/include/boost/asio/ip/address_v6.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/cartesian-product.hpp:
 
-/usr/include/boost/asio/detail/object_pool.hpp:
+/usr/include/boost/mpl/limits/unrolling.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorCustomOp.h:
+/usr/include/boost/smart_ptr/detail/spinlock_pool.hpp:
 
-/usr/include/boost/asio/executor_work_guard.hpp:
+/usr/include/boost/mpl/multiplies.hpp:
 
-/usr/include/boost/mpl/advance.hpp:
+/usr/include/c++/11/bits/basic_string.h:
 
-/usr/include/boost/asio/detail/mutex.hpp:
+/usr/include/boost/archive/basic_text_oarchive.hpp:
 
-/usr/include/stdint.h:
+/usr/include/boost/iostreams/imbue.hpp:
 
-/usr/include/boost/type_traits/is_enum.hpp:
+/usr/include/boost/preprocessor/logical/not.hpp:
 
-/usr/include/boost/asio/detail/winsock_init.hpp:
+/usr/include/boost/asio/detail/handler_invoke_helpers.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/locale_t.h:
+/usr/lib/gcc/x86_64-linux-gnu/11/include/xmmintrin.h:
 
-/usr/include/boost/asio/detail/limits.hpp:
+/usr/include/boost/bind/bind_mf2_cc.hpp:
 
-/opt/openrobots/include/hpp/fcl/BV/BV_node.h:
+/usr/include/boost/range/has_range_iterator.hpp:
 
-/usr/include/boost/variant/detail/variant_io.hpp:
+/usr/lib/gcc/x86_64-linux-gnu/11/include/limits.h:
 
-/usr/include/boost/asio/detail/io_control.hpp:
+/usr/include/boost/iterator/distance.hpp:
 
-/usr/include/c++/11/bits/random.tcc:
+/usr/include/boost/iostreams/detail/bool_trait_def.hpp:
 
-/usr/include/boost/concept/detail/general.hpp:
+/usr/include/boost/asio/detail/reactive_socket_sendto_op.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorMap.h:
+/usr/include/boost/mpl/aux_/config/gcc.hpp:
 
-/usr/include/boost/mpl/vector/aux_/item.hpp:
+/usr/include/boost/mpl/clear_fwd.hpp:
 
-/usr/include/boost/asio/detail/atomic_count.hpp:
+/usr/include/boost/io_fwd.hpp:
 
-/usr/include/boost/asio/detail/impl/throw_error.ipp:
+/usr/include/boost/asio/detail/impl/posix_thread.ipp:
 
-/usr/include/boost/fusion/container/list/detail/next_impl.hpp:
+/usr/include/x86_64-linux-gnu/bits/ioctl-types.h:
 
-/usr/include/x86_64-linux-gnu/bits/socket.h:
+/opt/openrobots/include/pinocchio/core/binary-op.hpp:
 
-/usr/include/boost/type_traits/has_complement.hpp:
+/usr/include/boost/asio/detail/impl/scheduler.ipp:
 
-/usr/include/boost/preprocessor/repetition/for.hpp:
+/usr/include/boost/asio/traits/submit_member.hpp:
 
-/opt/openrobots/include/pinocchio/utils/string-generator.hpp:
+/usr/include/boost/function_types/detail/components_impl/arity10_1.hpp:
 
-/usr/include/boost/array.hpp:
+/usr/include/boost/asio/ip/basic_endpoint.hpp:
 
-/usr/include/boost/iostreams/detail/streambuf/direct_streambuf.hpp:
+/usr/include/boost/asio/detail/impl/service_registry.ipp:
+
+/usr/include/boost/fusion/algorithm/iteration/fold_fwd.hpp:
 
 /usr/include/boost/asio/detail/impl/socket_ops.ipp:
 
-/usr/include/boost/asio/detail/impl/service_registry.ipp:
+/usr/include/boost/iostreams/detail/streambuf/direct_streambuf.hpp:
 
-/usr/include/boost/asio/ip/basic_endpoint.hpp:
+/usr/include/boost/array.hpp:
 
-/usr/include/boost/function_types/detail/components_impl/arity10_1.hpp:
+/opt/openrobots/include/pinocchio/utils/string-generator.hpp:
 
-/usr/include/boost/asio/traits/submit_member.hpp:
+/usr/include/boost/preprocessor/repetition/for.hpp:
 
-/usr/include/boost/asio/detail/impl/scheduler.ipp:
+/usr/include/boost/fusion/container/list/detail/next_impl.hpp:
 
-/usr/include/boost/mpl/push_back.hpp:
+/usr/include/boost/asio/traits/bulk_execute_member.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/motion-base.hpp:
+/usr/include/boost/asio/detail/impl/throw_error.ipp:
 
-/usr/include/boost/asio/handler_continuation_hook.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/ForwardDeclarations.h:
 
-/usr/include/boost/archive/detail/iserializer.hpp:
+/usr/include/boost/asio/detail/atomic_count.hpp:
 
-/usr/include/boost/mpl/list/aux_/push_back.hpp:
+/usr/include/boost/mpl/vector/aux_/item.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/force.hpp:
+/usr/include/boost/mpl/insert_range.hpp:
 
-/usr/include/boost/type_traits/has_equal_to.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorMap.h:
 
-/usr/include/asm-generic/errno-base.h:
+/usr/include/boost/concept/detail/general.hpp:
 
-/usr/include/boost/date_time/posix_time/posix_time_duration.hpp:
+/usr/include/c++/11/bits/random.tcc:
 
-/usr/include/boost/type_traits/is_unscoped_enum.hpp:
+/usr/include/boost/asio/detail/limits.hpp:
 
-/usr/include/boost/range/detail/misc_concept.hpp:
+/usr/include/boost/mpl/advance.hpp:
 
-/usr/include/boost/asio/impl/handler_alloc_hook.ipp:
+/usr/include/boost/asio/executor_work_guard.hpp:
 
-/usr/include/boost/mpl/arg.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorCustomOp.h:
 
-/opt/openrobots/include/pinocchio/spatial/force-ref.hpp:
+/usr/include/boost/fusion/view/zip_view/detail/value_at_impl.hpp:
 
-/usr/include/boost/asio/detail/memory.hpp:
+/usr/include/boost/asio/detail/object_pool.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/inertia.hpp:
+/usr/include/boost/asio/ip/address_v6.hpp:
 
-/usr/include/boost/config/detail/select_platform_config.hpp:
+/usr/include/boost/asio/detail/operation.hpp:
 
-/usr/include/boost/asio/ip/resolver_query_base.hpp:
+/usr/include/boost/fusion/support/detail/is_mpl_sequence.hpp:
 
-/usr/include/boost/lexical_cast.hpp:
+/usr/include/eigen3/Eigen/src/Core/Transpose.h:
 
-/usr/include/boost/preprocessor/tuple/eat.hpp:
+/usr/include/boost/asio/detail/impl/handler_tracking.ipp:
 
-/opt/openrobots/include/pinocchio/spatial/force-dense.hpp:
+/usr/include/boost/blank.hpp:
 
-/usr/include/boost/fusion/container/list/detail/reverse_cons.hpp:
+/usr/include/c++/11/bits/postypes.h:
 
-/usr/include/boost/mpl/list/aux_/item.hpp:
+/usr/include/boost/asio/execution/start.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/sigval_t.h:
+/usr/include/boost/asio/detail/non_const_lvalue.hpp:
 
-/opt/openrobots/include/pinocchio/serialization/serializable.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joints.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/ReenableStupidWarnings.h:
+/usr/include/boost/asio/detail/push_options.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/cartesian-product.hpp:
+/usr/include/boost/config.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/log.hpp:
+/usr/include/boost/noncopyable.hpp:
 
-/usr/include/boost/config/detail/suffix.hpp:
+/usr/include/boost/asio/detail/timer_scheduler.hpp:
 
-/usr/include/c++/11/bits/basic_string.tcc:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorInflation.h:
 
-/usr/include/boost/mem_fn.hpp:
+/usr/include/boost/fusion/algorithm/transformation/detail/replace_if.hpp:
 
-/usr/include/boost/mpl/bind.hpp:
+/usr/include/boost/preprocessor/iteration/detail/local.hpp:
 
-/opt/openrobots/include/hpp/fcl/math/transform.h:
+/usr/include/x86_64-linux-gnu/asm/posix_types.h:
 
-/opt/openrobots/include/pinocchio/spatial/act-on-set.hpp:
+/usr/include/boost/asio/detail/posix_signal_blocker.hpp:
 
-/usr/include/boost/serialization/smart_cast.hpp:
+/usr/include/boost/fusion/view/iterator_range/detail/is_segmented_impl.hpp:
 
-/usr/include/boost/asio/buffer.hpp:
+/usr/include/boost/asio/execution/impl/receiver_invocation_error.ipp:
 
-/opt/openrobots/include/pinocchio/serialization/static-buffer.hpp:
+/usr/include/boost/type_traits/copy_reference.hpp:
 
-/usr/include/c++/11/bits/stl_iterator_base_types.h:
+/usr/include/boost/asio/detail/posix_thread.hpp:
 
-/usr/include/boost/mpl/O1_size.hpp:
+/usr/include/boost/asio/traits/static_require.hpp:
 
-/usr/include/boost/asio/detail/signal_blocker.hpp:
+/usr/include/boost/smart_ptr/detail/sp_disable_deprecated.hpp:
 
-/opt/openrobots/include/hpp/fcl/narrowphase/gjk.h:
+/usr/include/boost/type_traits/conjunction.hpp:
 
-/usr/include/boost/core/ref.hpp:
+/usr/include/boost/core/alloc_construct.hpp:
 
-/usr/include/boost/range/iterator.hpp:
+/usr/include/boost/asio/detail/reactive_socket_accept_op.hpp:
 
-/usr/include/boost/asio/detail/select_interrupter.hpp:
+/usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:
 
-/usr/include/boost/core/enable_if.hpp:
+/usr/include/boost/iostreams/detail/template_params.hpp:
 
-/usr/include/boost/asio/traits/query_static_constexpr_member.hpp:
+/usr/include/boost/type_traits/has_complement.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/fcl-pinocchio-conversions.hpp:
+/usr/include/boost/fusion/mpl/back.hpp:
 
-/opt/openrobots/include/pinocchio/parsers/urdf.hpp:
+/usr/include/boost/asio/ip/impl/address_v4.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/SolverBase.h:
+/opt/openrobots/include/hpp/fcl/collision_data.h:
 
-/usr/include/c++/11/string:
+/usr/include/boost/asio/detail/reactive_socket_connect_op.hpp:
 
-/usr/include/c++/11/atomic:
+/usr/include/boost/asio/detail/reactive_socket_recv_op.hpp:
 
-/usr/include/boost/function_types/detail/encoding/aliases_undef.hpp:
+/usr/include/boost/config/detail/select_stdlib_config.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-base.hxx:
+/usr/include/boost/asio/traits/prefer_free.hpp:
 
-/usr/include/boost/asio/execution/impl/bad_executor.ipp:
+/usr/include/boost/asio/traits/schedule_free.hpp:
 
-/opt/openrobots/include/hpp/fcl/BV/AABB.h:
+/usr/include/boost/config/abi_suffix.hpp:
 
-/usr/include/boost/asio/execution/schedule.hpp:
+/usr/include/boost/serialization/level.hpp:
 
-/usr/include/boost/config/detail/select_compiler_config.hpp:
+/usr/include/boost/asio/detail/reactive_socket_service_base.hpp:
 
-/usr/include/boost/archive/basic_binary_oarchive.hpp:
+/usr/include/boost/asio/detail/executor_op.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-algo.hxx:
+/usr/include/boost/system/detail/generic_category.hpp:
 
-/usr/include/boost/variant/variant_fwd.hpp:
+/usr/include/boost/asio/execution/submit.hpp:
 
-/usr/include/boost/type_traits/has_unary_minus.hpp:
+/usr/include/boost/mpl/at_fwd.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-revolute-unbounded-unaligned.hpp:
+/usr/include/boost/asio/detail/impl/epoll_reactor.ipp:
 
-/usr/include/boost/iterator/detail/facade_iterator_category.hpp:
+/usr/include/boost/asio/detail/reactive_wait_op.hpp:
 
-/usr/include/boost/mpl/is_sequence.hpp:
+/usr/include/boost/asio/detail/reactor.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/wordsize.h:
+/usr/include/boost/asio/detail/reactor_fwd.hpp:
 
-/usr/include/boost/mpl/vector/aux_/numbered.hpp:
+/usr/include/boost/type_traits/is_signed.hpp:
 
-/usr/include/asm-generic/ioctls.h:
+/usr/include/boost/fusion/view/transform_view/detail/distance_impl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/socket2.h:
+/usr/include/boost/fusion/algorithm/transformation/remove_if.hpp:
 
-/usr/include/c++/11/bits/stl_pair.h:
+/usr/include/boost/asio/detail/resolve_endpoint_op.hpp:
 
-/usr/include/boost/iostreams/flush.hpp:
+/usr/include/boost/date_time/posix_time/posix_time_config.hpp:
 
-/usr/include/boost/math/policies/error_handling.hpp:
+/opt/openrobots/include/pinocchio/algorithm/kinematics.hxx:
 
-/opt/openrobots/include/pinocchio/serialization/eigen.hpp:
+/usr/include/boost/asio/detail/resolve_query_op.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Reverse.h:
+/usr/include/boost/asio/traits/start_member.hpp:
 
-/usr/include/boost/type_traits/has_less_equal.hpp:
+/usr/include/eigen3/Eigen/src/Cholesky/LDLT.h:
 
-/usr/include/boost/asio/detail/timer_scheduler.hpp:
+/usr/include/boost/asio/execution/bulk_guarantee.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/ForwardDeclarations.h:
+/usr/include/boost/fusion/support/detail/segmented_fold_until_impl.hpp:
 
-/usr/include/boost/asio/basic_waitable_timer.hpp:
+/usr/include/eigen3/Eigen/src/plugins/BlockMethods.h:
 
-/opt/openrobots/include/hpp/fcl/config.hh:
+/usr/include/boost/asio/detail/thread_group.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/visitor.hpp:
+/usr/include/boost/asio/detail/resolver_service.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/functors/AssignmentFunctors.h:
+/usr/include/c++/11/fstream:
 
-/usr/include/boost/asio/post.hpp:
+/usr/include/boost/preprocessor/seq/detail/is_empty.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-generic.hpp:
+/usr/include/boost/preprocessor/seq/elem.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/waitflags.h:
+/usr/include/boost/asio/detail/scheduler.hpp:
 
-/usr/include/boost/asio/detail/reactive_socket_service.hpp:
+/usr/include/boost/mpl/aux_/clear_impl.hpp:
 
-/usr/include/boost/mpl/aux_/config/pp_counter.hpp:
+/usr/include/c++/11/bits/stl_tree.h:
 
-/usr/include/x86_64-linux-gnu/bits/sigthread.h:
+/usr/include/c++/11/bits/parse_numbers.h:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-basic-visitors.hxx:
+/usr/include/boost/lexical_cast/detail/lcast_char_constants.hpp:
 
-/usr/include/boost/mpl/aux_/comparison_op.hpp:
+/usr/include/boost/archive/detail/basic_serializer.hpp:
 
-/opt/openrobots/include/pinocchio/serialization/fwd.hpp:
+/usr/include/boost/fusion/sequence/comparison/detail/equal_to.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDeviceDefault.h:
+/usr/include/boost/asio/detail/impl/resolver_service_base.ipp:
 
-/usr/include/eigen3/Eigen/src/Geometry/Quaternion.h:
+/usr/include/boost/iostreams/positioning.hpp:
 
-/usr/include/boost/preprocessor/inc.hpp:
+/usr/include/boost/asio/detail/scheduler_operation.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-composite.hxx:
+/usr/include/boost/fusion/view/iterator_range/detail/at_impl.hpp:
 
-/usr/include/boost/asio/detail/thread_context.hpp:
+/opt/openrobots/include/pinocchio/spatial/act-on-set.hxx:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-revolute-unbounded.hpp:
+/usr/include/boost/asio/detail/scoped_lock.hpp:
 
-/usr/include/boost/foreach.hpp:
+/usr/include/boost/config/platform/linux.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/xopen_lim.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorVolumePatch.h:
 
-/usr/include/boost/mpl/aux_/advance_forward.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorUInt128.h:
 
-/usr/include/boost/mpl/vector/aux_/pop_back.hpp:
+/usr/include/x86_64-linux-gnu/sys/eventfd.h:
 
-/usr/include/boost/asio/detail/type_traits.hpp:
+/usr/include/boost/asio/detail/scoped_ptr.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-base.hpp:
+/usr/include/boost/asio/detail/reactive_socket_recvfrom_op.hpp:
 
-/usr/include/boost/date_time/wrapping_int.hpp:
+/usr/include/boost/bind/placeholders.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/special-orthogonal.hpp:
+/usr/include/boost/numeric/conversion/detail/is_subranged.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/visitor/fusion.hpp:
+/usr/include/eigen3/Eigen/src/Core/GeneralProduct.h:
 
-/usr/include/boost/asio/detail/cstdint.hpp:
+/opt/openrobots/include/pinocchio/parsers/sample-models.hxx:
 
-/usr/include/boost/smart_ptr/detail/sp_counted_base_gcc_atomic.hpp:
+/usr/include/boost/asio/detail/socket_ops.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/geometry.hxx:
+/usr/include/eigen3/Eigen/src/Core/Matrix.h:
 
-/usr/include/eigen3/Eigen/src/Core/NestByValue.h:
+/usr/include/eigen3/Eigen/src/Core/SelfCwiseBinaryOp.h:
 
-/usr/include/boost/asio/execution/executor.hpp:
+/usr/include/boost/asio/detail/socket_option.hpp:
 
-/opt/openrobots/include/hpp/fcl/warning.hh:
+/usr/include/boost/mpl/vector/aux_/begin_end.hpp:
 
-/usr/include/boost/archive/text_iarchive.hpp:
+/usr/include/boost/preprocessor/detail/is_binary.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/NumTraits.h:
+/usr/include/boost/preprocessor/facilities/identity.hpp:
 
-/usr/include/boost/range/detail/has_member_size.hpp:
+/usr/include/boost/asio/detail/socket_types.hpp:
 
-/usr/include/boost/archive/detail/auto_link_archive.hpp:
+/usr/include/boost/fusion/support/tag_of_fwd.hpp:
 
-/usr/include/boost/preprocessor/list/adt.hpp:
+/usr/include/boost/mpl/aux_/is_msvc_eti_arg.hpp:
 
-/usr/include/asm-generic/socket.h:
+/usr/include/boost/asio/any_io_executor.hpp:
 
-/usr/include/boost/asio/traits/connect_member.hpp:
+/usr/include/boost/archive/binary_oarchive_impl.hpp:
 
-/usr/include/boost/mpl/aux_/yes_no.hpp:
+/opt/openrobots/include/pinocchio/multibody/data.hxx:
 
-/usr/include/eigen3/Eigen/src/Core/BooleanRedux.h:
+/opt/openrobots/include/pinocchio/multibody/model.hxx:
 
-/usr/include/boost/asio/query.hpp:
+/usr/include/boost/asio/detail/std_fenced_block.hpp:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/GeneralizedSelfAdjointEigenSolver.h:
+/usr/include/x86_64-linux-gnu/bits/iscanonical.h:
 
-/usr/include/boost/asio/detail/impl/posix_mutex.ipp:
+/usr/include/eigen3/Eigen/src/Core/products/GeneralMatrixMatrix.h:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup.hpp:
+/usr/include/boost/asio/execution/occupancy.hpp:
 
-/usr/include/boost/mpl/vector/vector0.hpp:
+/usr/include/x86_64-linux-gnu/bits/fp-logb.h:
 
-/usr/include/boost/asio/execution/set_error.hpp:
+/usr/include/boost/asio/detail/string_view.hpp:
 
-/usr/include/eigen3/Eigen/src/SVD/SVDBase.h:
+/usr/include/boost/asio/detail/timer_queue.hpp:
 
-/usr/include/boost/asio/ip/basic_resolver_entry.hpp:
+/usr/include/boost/fusion/algorithm/transformation/replace.hpp:
 
-/usr/include/boost/core/allocator_access.hpp:
+/usr/include/boost/fusion/view/filter_view/detail/deref_data_impl.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/fwd.hpp:
+/usr/include/boost/asio/detail/socket_holder.hpp:
 
-/usr/include/boost/asio/basic_socket_streambuf.hpp:
+/usr/include/boost/asio/detail/timer_queue_base.hpp:
 
-/opt/openrobots/include/hpp/fcl/mesh_loader/loader.h:
+/usr/include/boost/fusion/view/iterator_range/detail/end_impl.hpp:
 
-/usr/include/c++/11/stdexcept:
+/usr/include/c++/11/type_traits:
 
-/usr/include/boost/mpl/bool.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-mimic.hpp:
 
-/usr/include/boost/call_traits.hpp:
+/usr/include/boost/asio/detail/array.hpp:
 
-/usr/include/boost/asio/detail/noncopyable.hpp:
+/usr/include/boost/asio/detail/timer_queue_set.hpp:
 
-/usr/include/boost/archive/detail/helper_collection.hpp:
+/usr/include/boost/fusion/view/zip_view/detail/deref_impl.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Map.h:
+/opt/openrobots/include/pinocchio/multibody/constraint-generic.hpp:
 
-/usr/include/boost/iostreams/operations.hpp:
+/usr/include/boost/fusion/algorithm/transformation/push_front.hpp:
 
-/opt/openrobots/include/hpp/fcl/distance_func_matrix.h:
+/usr/include/boost/asio/error.hpp:
 
-/usr/include/boost/asio/execution/scheduler.hpp:
+/usr/include/x86_64-linux-gnu/bits/sigcontext.h:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-revolute.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/Quaternion.h:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-translation.hpp:
+/usr/include/boost/asio/detail/variadic_templates.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/constraint.hpp:
+/usr/include/boost/asio/execution/bad_executor.hpp:
 
-/usr/include/boost/fusion/iterator/detail/advance.hpp:
+/usr/include/boost/date_time/date_duration_types.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsHalf.h:
+/usr/include/boost/asio/execution/connect.hpp:
 
-/usr/include/c++/11/bits/cpp_type_traits.h:
+/usr/include/boost/asio/execution/blocking.hpp:
 
-/usr/include/boost/integer/common_factor_ct.hpp:
+/usr/include/boost/asio/execution/detail/as_invocable.hpp:
 
-/usr/include/boost/archive/detail/basic_pointer_iserializer.hpp:
+/usr/include/boost/date_time/posix_time/posix_time_types.hpp:
 
-/usr/include/boost/date_time/date_defs.hpp:
+/opt/openrobots/include/hpp/fcl/deprecated.hh:
 
-/opt/openrobots/include/pinocchio/multibody/model.hxx:
+/usr/include/x86_64-linux-gnu/bits/types/struct_FILE.h:
 
-/usr/include/boost/preprocessor/cat.hpp:
+/usr/include/boost/mpl/aux_/msvc_type.hpp:
 
-/usr/include/boost/fusion/view/joint_view/detail/key_of_impl.hpp:
+/usr/include/boost/preprocessor/detail/auto_rec.hpp:
 
-/usr/include/boost/lexical_cast/detail/inf_nan.hpp:
+/usr/include/c++/11/cctype:
 
-/usr/include/c++/11/locale:
+/usr/include/boost/asio/execution/detail/as_receiver.hpp:
 
-/usr/include/boost/type_traits/has_divides.hpp:
+/usr/include/boost/type_traits/detail/is_function_cxx_11.hpp:
 
-/usr/include/boost/asio/detail/keyword_tss_ptr.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/params.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/Hyperplane.h:
+/usr/include/x86_64-linux-gnu/bits/mathcalls-helper-functions.h:
 
-/opt/openrobots/include/hpp/fcl/narrowphase/narrowphase.h:
+/usr/include/x86_64-linux-gnu/bits/stdio2.h:
 
-/usr/include/boost/config/helper_macros.hpp:
+/usr/include/boost/asio/execution/detail/void_receiver.hpp:
 
-/usr/include/boost/asio/execution/set_done.hpp:
+/usr/include/boost/fusion/view/reverse_view/detail/advance_impl.hpp:
 
-/usr/include/boost/fusion/container/list/list_fwd.hpp:
+/usr/include/eigen3/Eigen/src/StlSupport/details.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContraction.h:
+/usr/include/boost/archive/codecvt_null.hpp:
 
-/opt/openrobots/include/pinocchio/core/binary-op.hpp:
+/opt/openrobots/include/pinocchio/config.hpp:
 
-/usr/include/boost/asio/detail/handler_invoke_helpers.hpp:
+/usr/include/boost/function_types/parameter_types.hpp:
 
-/usr/include/boost/preprocessor/logical/not.hpp:
+/usr/include/boost/asio/impl/system_context.ipp:
 
-/usr/include/boost/archive/basic_text_oarchive.hpp:
+/usr/include/boost/fusion/container/list/cons_fwd.hpp:
 
-/home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp:
+/usr/include/boost/core/default_allocator.hpp:
 
-/usr/include/boost/fusion/iterator/equal_to.hpp:
+/usr/include/boost/iterator/reverse_iterator.hpp:
 
-/usr/include/boost/date_time/time_resolution_traits.hpp:
+/usr/include/boost/asio/detail/recycling_allocator.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-collection.hpp:
+/usr/include/boost/math/special_functions/detail/fp_traits.hpp:
 
-/usr/include/boost/fusion/view/single_view/detail/size_impl.hpp:
+/usr/include/boost/asio/execution/receiver_invocation_error.hpp:
 
-/usr/include/eigen3/Eigen/src/misc/Image.h:
+/usr/include/wctype.h:
 
-/usr/include/boost/archive/detail/oserializer.hpp:
+/usr/include/boost/archive/xml_iarchive.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/wchar.h:
+/usr/include/boost/asio/execution/mapping.hpp:
 
-/usr/include/boost/mpl/aux_/empty_impl.hpp:
+/usr/include/boost/asio/execution/operation_state.hpp:
 
-/usr/include/boost/fusion/view/joint_view/joint_view_fwd.hpp:
+/usr/include/boost/asio/traits/set_error_free.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/fcntl2.h:
+/usr/include/boost/type_traits/has_post_decrement.hpp:
 
-/usr/include/boost/mpl/less.hpp:
+/usr/include/x86_64-linux-gnu/bits/types/sigval_t.h:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/special-euclidean.hpp:
+/usr/include/boost/asio/execution/outstanding_work.hpp:
 
-/usr/include/boost/asio/detail/handler_work.hpp:
+/usr/include/x86_64-linux-gnu/bits/typesizes.h:
 
-/usr/include/boost/date_time/time_duration.hpp:
+/usr/include/boost/asio/execution/sender.hpp:
 
-/usr/include/net/if.h:
+/usr/include/boost/preprocessor/seq/cat.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/vector-space.hpp:
+/usr/include/boost/asio/impl/error.ipp:
 
-/usr/include/boost/mpl/vector/aux_/pop_front.hpp:
+/usr/include/boost/asio/impl/execution_context.hpp:
 
-/usr/include/boost/asio/detail/buffer_sequence_adapter.hpp:
+/usr/include/boost/concept/detail/concept_def.hpp:
 
-/usr/include/x86_64-linux-gnu/sys/single_threaded.h:
+/usr/include/boost/fusion/sequence/intrinsic/begin.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/environments.h:
+/usr/include/boost/fusion/view/flatten_view.hpp:
 
-/usr/include/boost/mpl/max_element.hpp:
+/usr/include/boost/preprocessor/inc.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorReverse.h:
+/usr/include/boost/serialization/type_info_implementation.hpp:
 
-/usr/include/boost/asio/traits/set_done_member.hpp:
+/usr/include/boost/fusion/iterator/iterator_adapter.hpp:
 
-/opt/openrobots/include/pinocchio/math/sincos.hpp:
+/usr/include/boost/asio/socket_base.hpp:
 
-/usr/include/boost/asio/handler_alloc_hook.hpp:
+/usr/include/boost/asio/detail/mutex.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-spherical-ZYX.hpp:
+/opt/openrobots/include/pinocchio/spatial/force-tpl.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/flt-eval-method.h:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-prismatic-unaligned.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/NoAlias.h:
+/usr/include/x86_64-linux-gnu/bits/types/stack_t.h:
 
-/usr/include/boost/asio/detail/epoll_reactor.hpp:
+/usr/include/c++/11/bits/hashtable_policy.h:
 
-/usr/include/boost/smart_ptr/detail/local_sp_deleter.hpp:
+/usr/include/boost/asio/impl/execution_context.ipp:
 
-/usr/include/boost/predef/architecture/x86/32.h:
+/usr/include/boost/fusion/algorithm/query/detail/count.hpp:
 
-/usr/include/boost/config/detail/posix_features.hpp:
+/usr/include/boost/numeric/conversion/detail/sign_mixture.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-prismatic.hpp:
+/usr/include/boost/asio/impl/io_context.hpp:
 
-/usr/include/boost/core/noncopyable.hpp:
+/usr/include/boost/asio/impl/multiple_exceptions.ipp:
 
-/usr/include/asm-generic/sockios.h:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsImpl.h:
 
-/usr/include/boost/serialization/collections_load_imp.hpp:
+/usr/include/boost/type_traits/has_pre_increment.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/constraint-base.hpp:
+/usr/include/boost/iostreams/detail/forward.hpp:
 
-/usr/include/boost/asio/detail/impl/eventfd_select_interrupter.ipp:
+/usr/include/boost/smart_ptr/detail/sp_has_sync_intrinsics.hpp:
 
-/usr/include/boost/asio/detail/thread.hpp:
+/usr/include/boost/iostreams/detail/config/limits.hpp:
 
-/usr/include/boost/asio/basic_streambuf.hpp:
+/usr/include/boost/asio/ip/bad_address_cast.hpp:
 
-/usr/include/boost/lexical_cast/detail/is_character.hpp:
+/usr/include/boost/mpl/eval_if.hpp:
 
-/usr/include/boost/core/no_exceptions_support.hpp:
+/usr/include/x86_64-linux-gnu/bits/types/time_t.h:
 
-/opt/openrobots/include/hpp/fcl/BV/OBB.h:
+/usr/include/eigen3/Eigen/src/Core/util/BlasUtil.h:
 
-/usr/include/boost/mpl/size.hpp:
+/opt/openrobots/include/pinocchio/parsers/sample-models.hpp:
 
-/usr/include/boost/fusion/support/tag_of.hpp:
+/usr/include/boost/preprocessor/arithmetic/dec.hpp:
 
-/usr/include/asm-generic/int-ll64.h:
+/usr/include/c++/11/bits/sstream.tcc:
 
-/usr/include/boost/mpl/aux_/insert_range_impl.hpp:
+/usr/include/boost/mpl/prior.hpp:
 
-/usr/include/boost/mpl/aux_/msvc_eti_base.hpp:
+/usr/include/boost/asio/traits/submit_free.hpp:
 
-/opt/openrobots/include/hpp/fcl/data_types.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorConvolution.h:
 
-/usr/include/boost/iostreams/concepts.hpp:
+/usr/include/boost/asio/ip/detail/endpoint.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/PermutationMatrix.h:
+/usr/include/boost/asio/is_executor.hpp:
 
-/usr/include/boost/asio/detail/eventfd_select_interrupter.hpp:
+/usr/include/boost/mpl/aux_/has_begin.hpp:
 
-/usr/include/boost/fusion/iterator/deref_data.hpp:
+/usr/include/boost/asio/ip/address.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-planar.hpp:
+/usr/include/boost/iostreams/stream.hpp:
 
-/usr/include/boost/core/addressof.hpp:
+/usr/include/boost/fusion/support/detail/access.hpp:
 
-/opt/openrobots/include/pinocchio/macros.hpp:
+/opt/openrobots/include/hpp/fcl/timings.h:
 
-/usr/include/boost/lexical_cast/detail/widest_char.hpp:
+/opt/openrobots/include/hpp/fcl/fwd.hh:
 
-/usr/include/boost/preprocessor/seq/for_each_i.hpp:
+/usr/include/boost/math/special_functions/sign.hpp:
 
-/usr/include/boost/asio/detail/conditionally_enabled_event.hpp:
+/usr/include/boost/asio/ip/impl/address_v4.ipp:
 
-/usr/include/boost/asio/ip/basic_resolver_query.hpp:
+/usr/include/boost/asio/detail/handler_type_requirements.hpp:
 
-/opt/openrobots/include/pinocchio/parsers/urdf/geometry.hxx:
+/usr/include/boost/mpl/aux_/config/use_preprocessed.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsArrayAPI.h:
+/usr/include/boost/asio/ip/impl/address.hpp:
 
-/usr/include/boost/predef/platform/android.h:
+/opt/openrobots/include/pinocchio/fwd.hpp:
 
-/usr/include/boost/mpl/void_fwd.hpp:
+/usr/include/boost/bind/arg.hpp:
 
-/usr/include/boost/core/is_same.hpp:
+/usr/include/boost/fusion/view/zip_view/detail/begin_impl.hpp:
 
-/usr/include/boost/archive/xml_oarchive.hpp:
+/usr/include/boost/preprocessor/logical/and.hpp:
 
-/usr/include/boost/asio/detail/assert.hpp:
+/usr/include/boost/asio/ip/impl/address_v6.ipp:
 
-/usr/include/boost/math/special_functions/nonfinite_num_facets.hpp:
+/usr/include/boost/date_time/gregorian/gregorian_types.hpp:
 
-/opt/openrobots/include/hpp/fcl/shape/geometric_shapes.h:
+/usr/include/boost/iostreams/read.hpp:
 
-/opt/openrobots/include/pinocchio/deprecation.hpp:
+/usr/include/boost/mpl/transform.hpp:
 
-/usr/include/boost/asio/detail/impl/timer_queue_ptime.ipp:
+/usr/include/boost/fusion/container/vector/detail/equal_to_impl.hpp:
 
-/usr/include/c++/11/cstring:
+/usr/include/boost/core/nvp.hpp:
 
-/opt/openrobots/include/pinocchio/algorithm/joint-configuration.hxx:
+/usr/include/boost/mpl/aux_/nttp_decl.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorMacros.h:
+/opt/openrobots/include/pinocchio/multibody/model.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/TriangularSolverMatrix.h:
+/usr/include/boost/asio/is_applicable_property.hpp:
 
-/usr/include/boost/asio/detail/wrapped_handler.hpp:
+/usr/include/boost/fusion/view/transform_view/detail/value_at_impl.hpp:
 
-/usr/include/boost/preprocessor/tuple/rem.hpp:
+/usr/include/boost/archive/archive_exception.hpp:
 
-/opt/openrobots/include/hpp/fcl/BVH/BVH_model.h:
+/usr/include/boost/mpl/sequence_tag.hpp:
 
-/usr/include/boost/preprocessor/arithmetic/sub.hpp:
+/usr/include/boost/function_types/detail/pp_loop.hpp:
 
-/usr/include/boost/asio/detail/wait_op.hpp:
+/usr/include/boost/date_time/time_defs.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/struct_timeval.h:
+/usr/include/boost/checked_delete.hpp:
 
-/usr/include/boost/type_traits/is_copy_assignable.hpp:
+/usr/include/boost/iostreams/traits.hpp:
 
-/usr/include/boost/type_traits/add_reference.hpp:
+/usr/include/boost/date_time/compiler_config.hpp:
 
-/usr/include/boost/preprocessor/control/deduce_d.hpp:
+/usr/include/boost/fusion/iterator/detail/segmented_next_impl.hpp:
 
-/usr/include/boost/fusion/support/detail/is_native_fusion_sequence.hpp:
+/usr/include/boost/system/detail/std_interoperability.hpp:
 
-/usr/include/boost/mpl/pair.hpp:
+/usr/include/boost/concept/detail/has_constraints.hpp:
 
-/opt/openrobots/include/hpp/fcl/BV/kIOS.h:
+/usr/include/boost/iostreams/char_traits.hpp:
 
-/usr/include/c++/11/bits/algorithmfwd.h:
+/usr/include/boost/mpl/push_front.hpp:
 
-/opt/openrobots/include/pinocchio/deprecated-macros.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsBFloat16.h:
 
-/usr/include/boost/type_traits/disjunction.hpp:
+/usr/include/boost/preprocessor/seq/subseq.hpp:
 
-/opt/openrobots/include/hpp/fcl/BV/BV.h:
+/usr/include/boost/type_traits/is_fundamental.hpp:
 
-/usr/include/boost/lexical_cast/detail/converter_lexical_streams.hpp:
+/usr/include/boost/fusion/adapted/mpl/detail/end_impl.hpp:
 
-/usr/include/boost/asio/execution/prefer_only.hpp:
+/usr/include/boost/cstdint.hpp:
 
-/usr/include/boost/asio/detail/pop_options.hpp:
+/usr/include/boost/math/tools/real_cast.hpp:
 
-/usr/include/boost/asio/basic_deadline_timer.hpp:
+/usr/include/boost/predef/library/c/_prefix.h:
 
-/usr/include/c++/11/streambuf:
+/usr/include/boost/asio/detail/null_event.hpp:
 
-/opt/openrobots/include/pinocchio/algorithm/joint-configuration.hpp:
+/opt/openrobots/include/hpp/fcl/data_types.h:
 
-/usr/include/boost/mpl/aux_/preprocessor/repeat.hpp:
+/usr/include/boost/asio/require.hpp:
 
-/usr/include/boost/bind/bind.hpp:
+/usr/include/boost/asio/system_context.hpp:
 
-/usr/include/signal.h:
+/usr/include/boost/asio/detail/impl/posix_mutex.ipp:
 
-/usr/include/boost/mpl/aux_/iter_apply.hpp:
+/usr/include/boost/predef/os/bsd/bsdi.h:
 
-/usr/include/boost/asio/impl/system_executor.hpp:
+/usr/include/boost/asio/traits/execute_member.hpp:
 
-/usr/include/boost/date_time/special_defs.hpp:
+/usr/include/boost/type_traits/remove_all_extents.hpp:
 
-/usr/include/boost/move/detail/config_end.hpp:
+/usr/include/boost/move/detail/config_begin.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-free-flyer.hpp:
+/usr/include/boost/fusion/algorithm/iteration/accumulate_fwd.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/TriangularSolverVector.h:
+/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_begin_impl.hpp:
 
-/usr/include/boost/core/first_scalar.hpp:
+/usr/include/boost/asio/traits/require_member.hpp:
 
-/usr/include/boost/asio/detail/handler_cont_helpers.hpp:
+/usr/include/boost/asio/traits/set_done_free.hpp:
 
-/usr/include/boost/serialization/force_include.hpp:
+/usr/include/boost/asio/traits/set_error_member.hpp:
 
-/usr/include/boost/asio/execution/execute.hpp:
+/usr/include/boost/preprocessor/iteration/detail/iter/forward1.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-common-operations.hpp:
+/opt/openrobots/include/pinocchio/serialization/archive.hpp:
 
-/usr/include/boost/asio/detail/throw_exception.hpp:
+/usr/include/boost/function_types/detail/pp_arity_loop.hpp:
 
-/usr/include/boost/function_types/detail/encoding/undef.hpp:
+/usr/include/boost/mpl/size_t.hpp:
 
-/usr/include/boost/type_traits/aligned_storage.hpp:
+/usr/include/boost/serialization/vector.hpp:
 
-/usr/include/boost/date_time/microsec_time_clock.hpp:
+/usr/include/c++/11/cmath:
 
-/usr/include/eigen3/Eigen/src/Core/util/ReshapedHelper.h:
+/usr/include/net/if.h:
 
-/usr/include/boost/preprocessor/repetition/enum_params_with_a_default.hpp:
+/usr/include/boost/asio/traits/static_query.hpp:
 
-/usr/include/boost/fusion/mpl/begin.hpp:
+/usr/include/boost/date_time/wrapping_int.hpp:
 
-/usr/include/netinet/tcp.h:
+/usr/include/boost/date_time/posix_time/date_duration_operators.hpp:
 
-/usr/include/boost/serialization/split_free.hpp:
+/usr/include/boost/core/checked_delete.hpp:
 
-/usr/include/boost/fusion/support/detail/and.hpp:
+/usr/include/boost/asio/detail/resolver_service_base.hpp:
 
-/usr/include/boost/utility/identity_type.hpp:
+/usr/include/boost/core/noinit_adaptor.hpp:
 
-/usr/include/boost/fusion/view/single_view/detail/equal_to_impl.hpp:
+/usr/include/boost/container_hash/hash_fwd.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/struct___jmp_buf_tag.h:
+/usr/include/boost/date_time/int_adapter.hpp:
 
-/usr/include/boost/config/no_tr1/cmath.hpp:
+/usr/include/boost/asio/traits/bulk_execute_free.hpp:
 
-/opt/openrobots/include/pinocchio/container/boost-container-limits.hpp:
+/usr/include/boost/bind/bind_cc.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/act-on-set.hxx:
+/usr/include/boost/preprocessor/config/config.hpp:
 
-/usr/include/boost/archive/detail/check.hpp:
+/usr/include/boost/iostreams/detail/ios.hpp:
 
-/usr/include/boost/detail/reference_content.hpp:
+/usr/include/boost/type_traits/has_virtual_destructor.hpp:
 
-/usr/include/boost/mpl/aux_/pop_front_impl.hpp:
+/usr/include/boost/bind/storage.hpp:
 
-/usr/include/string.h:
+/usr/include/unistd.h:
 
-/opt/openrobots/include/pinocchio/core/unary-op.hpp:
+/usr/include/boost/iostreams/detail/select.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/force-base.hpp:
+/usr/include/boost/fusion/container/map/map_fwd.hpp:
 
-/usr/include/boost/preprocessor/seq/first_n.hpp:
+/usr/include/c++/11/bits/exception_defines.h:
 
-/usr/include/boost/asio/execution/any_executor.hpp:
+/usr/include/boost/core/swap.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-algo.hpp:
+/usr/include/boost/mpl/find_if.hpp:
 
-/usr/include/x86_64-linux-gnu/sys/uio.h:
+/usr/include/boost/preprocessor/facilities/empty.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/IO.h:
+/usr/include/boost/concept_check.hpp:
 
-/usr/include/boost/archive/binary_oarchive.hpp:
+/usr/include/boost/config/abi_prefix.hpp:
 
-/usr/include/boost/mpl/aux_/na.hpp:
+/usr/include/boost/config/no_tr1/utility.hpp:
 
-/usr/include/c++/11/complex:
+/usr/include/eigen3/Eigen/src/LU/arch/InverseSize4.h:
 
-/usr/include/boost/archive/detail/basic_iarchive.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/fwd.hpp:
 
-/opt/openrobots/include/pinocchio/deprecated-namespaces.hpp:
+/usr/include/boost/function_types/detail/encoding/aliases_undef.hpp:
 
-/usr/include/boost/serialization/strong_typedef.hpp:
+/usr/include/x86_64-linux-gnu/bits/types/error_t.h:
 
-/opt/openrobots/include/pinocchio/multibody/fcl.hxx:
+/usr/include/c++/11/string:
 
-/usr/include/boost/config/workaround.hpp:
+/usr/include/eigen3/Eigen/src/Core/Swap.h:
 
-/opt/openrobots/include/pinocchio/deprecated.hpp:
+/usr/include/eigen3/Eigen/src/Core/SolverBase.h:
 
-/opt/openrobots/include/pinocchio/math/comparison-operators.hpp:
+/opt/openrobots/include/pinocchio/parsers/urdf.hpp:
 
-/usr/include/boost/asio/detail/reactive_socket_send_op.hpp:
+/usr/include/boost/asio/execution.hpp:
 
-/usr/include/boost/iostreams/detail/bool_trait_def.hpp:
+/usr/include/boost/asio/detail/is_buffer_sequence.hpp:
 
-/usr/include/boost/iterator/distance.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/special-orthogonal.hpp:
 
-/usr/include/boost/range/has_range_iterator.hpp:
+/usr/include/time.h:
 
-/usr/include/boost/fusion/view/iterator_range/detail/is_segmented_impl.hpp:
+/usr/include/boost/config/no_tr1/memory.hpp:
 
-/usr/include/boost/type_traits/is_arithmetic.hpp:
+/usr/include/boost/fusion/iterator/key_of.hpp:
 
-/usr/include/boost/mpl/long_fwd.hpp:
+/usr/include/boost/mpl/aux_/config/dmc_ambiguous_ctps.hpp:
 
-/usr/include/boost/asio/detail/impl/null_event.ipp:
+/usr/include/boost/config/user.hpp:
 
-/usr/include/boost/function_types/is_function.hpp:
+/usr/include/boost/container/detail/std_fwd.hpp:
 
-/usr/include/linux/stat.h:
+/usr/include/boost/smart_ptr/detail/spinlock.hpp:
 
-/usr/include/alloca.h:
+/usr/include/boost/limits.hpp:
 
-/usr/include/boost/date_time/posix_time/posix_time_system.hpp:
+/usr/include/boost/core/demangle.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsImpl.h:
+/usr/include/boost/asio/detail/chrono.hpp:
 
-/usr/include/boost/mpl/aux_/has_apply.hpp:
+/usr/include/boost/fusion/support/detail/pp_round.hpp:
 
-/usr/include/boost/asio/execution/detail/bulk_sender.hpp:
+/usr/include/boost/mpl/arg.hpp:
 
-/usr/include/c++/11/bits/list.tcc:
+/usr/include/asm-generic/ioctl.h:
 
-/usr/include/boost/utility/result_of.hpp:
+/usr/include/boost/mpl/clear.hpp:
 
-/usr/include/boost/type_traits/has_divides_assign.hpp:
+/usr/include/boost/preprocessor/logical/bool.hpp:
 
-/usr/include/boost/fusion/view/single_view/detail/value_of_impl.hpp:
+/usr/include/eigen3/Eigen/src/Core/EigenBase.h:
 
-/usr/include/boost/asio/detail/deadline_timer_service.hpp:
+/usr/include/boost/core/use_default.hpp:
 
-/usr/include/boost/mpl/less_equal.hpp:
+/usr/include/boost/date_time/adjust_functors.hpp:
 
-/usr/include/boost/asio/wait_traits.hpp:
+/usr/include/c++/11/bits/stl_heap.h:
 
-/usr/include/boost/function_types/detail/components_impl/arity20_0.hpp:
+/usr/include/boost/mpl/aux_/config/has_xxx.hpp:
 
-/usr/include/boost/asio/traits/set_value_member.hpp:
+/usr/include/boost/throw_exception.hpp:
 
-/usr/include/boost/mpl/aux_/config/static_constant.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContractionGpu.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/clock_t.h:
+/usr/include/boost/mpl/aux_/config/intel.hpp:
 
-/usr/include/boost/preprocessor/repetition/enum_params.hpp:
+/usr/include/boost/smart_ptr/shared_ptr.hpp:
 
-/usr/include/boost/mpl/aux_/preprocessor/add.hpp:
+/usr/include/boost/mpl/aux_/config/msvc.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsImpl.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorConversion.h:
 
-/opt/openrobots/include/pinocchio/spatial/motion-tpl.hpp:
+/usr/include/boost/mpl/aux_/config/msvc_typename.hpp:
 
-/usr/include/boost/mpl/same_as.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/enum.hpp:
 
-/usr/include/boost/exception/exception.hpp:
+/usr/include/boost/type_traits/is_float.hpp:
 
-/usr/include/boost/preprocessor/control/expr_if.hpp:
+/usr/include/x86_64-linux-gnu/bits/mathcalls.h:
 
-/usr/include/boost/mpl/list/aux_/clear.hpp:
+/usr/include/boost/fusion/view/transform_view/detail/next_impl.hpp:
 
-/usr/include/boost/asio/execution/context_as.hpp:
+/usr/include/boost/mpl/aux_/config/pp_counter.hpp:
 
-/usr/include/boost/mpl/long.hpp:
+/usr/include/boost/mpl/aux_/config/preprocessor.hpp:
 
-/usr/include/boost/type_traits/is_stateless.hpp:
+/usr/lib/gcc/x86_64-linux-gnu/11/include/quadmath.h:
 
-/opt/openrobots/include/hpp/fcl/timings.h:
+/usr/include/boost/iostreams/detail/config/overload_resolution.hpp:
 
-/opt/openrobots/include/pinocchio/math/quaternion.hpp:
+/usr/include/boost/mpl/aux_/config/static_constant.hpp:
 
-/usr/include/boost/mpl/apply.hpp:
+/usr/include/boost/mpl/aux_/config/ttp.hpp:
 
-/usr/include/boost/smart_ptr/detail/shared_count.hpp:
+/usr/include/boost/fusion/algorithm/transformation/clear.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/symmetric3.hpp:
+/usr/include/eigen3/Eigen/src/Core/Solve.h:
 
-/usr/include/boost/iostreams/operations_fwd.hpp:
+/usr/include/boost/mpl/aux_/config/workaround.hpp:
 
-/usr/include/boost/asio/detail/impl/service_registry.hpp:
+/usr/include/eigen3/Eigen/src/Core/Reverse.h:
 
-/usr/include/boost/asio/multiple_exceptions.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/util/EmulateArray.h:
 
-/usr/include/eigen3/Eigen/Cholesky:
+/usr/include/boost/range/detail/has_member_size.hpp:
 
-/usr/include/boost/asio/impl/system_context.hpp:
+/usr/include/boost/mpl/aux_/contains_impl.hpp:
 
-/usr/include/boost/iterator/iterator_traits.hpp:
+/usr/include/eigen3/Eigen/src/Core/DiagonalProduct.h:
 
-/usr/include/boost/preprocessor/enum_shifted_params.hpp:
+/usr/include/boost/fusion/view/single_view/single_view_iterator.hpp:
 
-/usr/include/boost/asio/execution/relationship.hpp:
+/usr/include/boost/mpl/aux_/empty_impl.hpp:
 
-/opt/openrobots/include/hpp/fcl/collision_func_matrix.h:
+/usr/include/boost/type_traits/has_right_shift_assign.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/visitor/joint-unary-visitor.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorShuffling.h:
 
-/usr/include/c++/11/limits:
+/usr/include/x86_64-linux-gnu/bits/signal_ext.h:
 
-/usr/include/boost/mpl/front_inserter.hpp:
+/usr/include/boost/mpl/aux_/full_lambda.hpp:
 
-/opt/openrobots/include/pinocchio/math/matrix-block.hpp:
+/usr/include/boost/type_traits/is_nothrow_move_assignable.hpp:
 
-/usr/include/boost/mpl/remove.hpp:
+/usr/include/boost/mpl/aux_/has_size.hpp:
 
-/usr/include/boost/asio/impl/post.hpp:
+/usr/include/boost/mpl/aux_/insert_impl.hpp:
 
-/usr/include/boost/operators.hpp:
+/usr/include/eigen3/Eigen/src/QR/HouseholderQR.h:
 
-/opt/openrobots/include/pinocchio/math/tensor.hpp:
+/usr/include/boost/fusion/container/vector/detail/distance_impl.hpp:
 
-/usr/include/boost/archive/detail/basic_oserializer.hpp:
+/usr/include/signal.h:
 
-/usr/include/boost/asio/detail/throw_error.hpp:
+/usr/include/boost/mpl/aux_/iter_fold_if_impl.hpp:
 
-/usr/include/boost/asio/detail/call_stack.hpp:
+/usr/include/boost/range/end.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/motion.hpp:
+/usr/include/boost/mpl/aux_/iter_fold_impl.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/se3-base.hpp:
+/usr/include/boost/iostreams/stream_buffer.hpp:
 
-/usr/include/boost/asio/traits/equality_comparable.hpp:
+/usr/include/boost/core/pointer_traits.hpp:
 
-/usr/include/asm-generic/types.h:
+/usr/include/boost/mpl/aux_/preprocessor/sub.hpp:
 
-/usr/include/boost/asio/execution/allocator.hpp:
+/usr/include/boost/numeric/conversion/converter.hpp:
 
-/usr/include/boost/archive/detail/interface_oarchive.hpp:
+/usr/include/boost/mpl/aux_/iter_push_front.hpp:
 
-/usr/include/boost/fusion/functional/invocation/invoke.hpp:
+/usr/include/boost/mpl/aux_/joint_iter.hpp:
 
-/usr/include/boost/archive/detail/common_oarchive.hpp:
+/usr/include/boost/mpl/aux_/lambda_arity_param.hpp:
 
-/usr/include/boost/date_time/posix_time/posix_time_config.hpp:
+/usr/include/boost/mpl/aux_/lambda_support.hpp:
 
-/opt/openrobots/include/pinocchio/parsers/urdf/model.hxx:
+/usr/include/boost/mpl/aux_/largest_int.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/SelfadjointMatrixVector.h:
+/usr/include/boost/mpl/aux_/na_assert.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/se3.hpp:
+/opt/openrobots/include/pinocchio/multibody/liegroup/fwd.hpp:
 
-/usr/include/c++/11/bits/exception.h:
+/usr/include/boost/mpl/aux_/na_fwd.hpp:
 
-/usr/include/boost/asio/detail/op_queue.hpp:
+/usr/include/c++/11/iosfwd:
 
-/usr/include/boost/asio/ip/address_v4.hpp:
+/usr/include/boost/mpl/aux_/na_spec.hpp:
 
-/usr/include/boost/fusion/support/detail/as_fusion_element.hpp:
+/usr/include/boost/mpl/aux_/nested_type_wknd.hpp:
 
-/usr/include/boost/predef/os/bsd.h:
+/usr/include/boost/mpl/aux_/pop_back_impl.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-base.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/add.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/skew.hpp:
+/usr/include/boost/fusion/container/vector.hpp:
 
-/usr/include/c++/11/stdlib.h:
+/usr/include/boost/preprocessor/repetition/enum_params.hpp:
 
-/usr/include/boost/asio/ip/impl/address_v6.hpp:
+/usr/include/x86_64-linux-gnu/bits/socket2.h:
 
-/usr/include/boost/asio/detail/config.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/def_params_tail.hpp:
 
-/usr/include/boost/mpl/aux_/reverse_fold_impl_body.hpp:
+/usr/include/boost/asio/traits/require_free.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/spatial-axis.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/default_params.hpp:
 
-/usr/include/boost/archive/detail/abi_prefix.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/partial_spec_params.hpp:
 
-/opt/openrobots/include/pinocchio/utils/axis-label.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/range.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Visitor.h:
+/usr/include/boost/config/detail/posix_features.hpp:
 
-/opt/openrobots/include/pinocchio/utils/eigen-fix.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/repeat.hpp:
 
-/usr/include/boost/fusion/view/joint_view/detail/value_of_data_impl.hpp:
+/usr/include/boost/mpl/aux_/push_back_impl.hpp:
 
-/usr/include/boost/asio/detail/wait_handler.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/IndexedViewHelper.h:
 
-/usr/include/boost/fusion/container/list/cons.hpp:
+/usr/include/boost/mpl/aux_/sequence_wrapper.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/prior_impl.hpp:
+/usr/include/boost/type_traits/intrinsics.hpp:
 
-/usr/include/boost/mpl/list/aux_/size.hpp:
+/usr/include/boost/mpl/aux_/single_element_iter.hpp:
 
-/usr/include/boost/asio/execution/blocking_adaptation.hpp:
+/usr/include/boost/mpl/aux_/size_impl.hpp:
 
-/usr/include/boost/asio/detail/impl/buffer_sequence_adapter.ipp:
+/usr/include/boost/mpl/aux_/static_cast.hpp:
 
-/opt/openrobots/include/hpp/fcl/collision_object.h:
+/usr/include/boost/mpl/aux_/template_arity.hpp:
 
-/opt/openrobots/include/pinocchio/utils/static-if.hpp:
+/usr/include/boost/mpl/aux_/template_arity_fwd.hpp:
 
-/usr/include/boost/visit_each.hpp:
+/usr/include/eigen3/Eigen/src/Core/arch/Default/Half.h:
 
-/usr/include/boost/type_traits/is_member_object_pointer.hpp:
+/usr/include/boost/mpl/aux_/transform_iter.hpp:
 
-/usr/include/asm-generic/bitsperlong.h:
+/usr/include/boost/type_traits/is_noncopyable.hpp:
 
-/usr/include/boost/assert/source_location.hpp:
+/usr/include/boost/mpl/aux_/type_wrapper.hpp:
 
-/usr/include/boost/mpl/always.hpp:
+/usr/include/boost/type_traits/has_bit_and.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-basic-visitors.hpp:
+/usr/include/boost/mpl/aux_/value_wknd.hpp:
 
-/usr/include/boost/asio/ip/detail/impl/endpoint.ipp:
+/usr/include/boost/mpl/back.hpp:
 
-/usr/include/boost/asio/execution/set_value.hpp:
+/usr/include/boost/mpl/back_fwd.hpp:
 
-/usr/include/boost/archive/basic_archive.hpp:
+/usr/include/boost/mpl/back_inserter.hpp:
 
-/usr/include/boost/mpl/greater.hpp:
+/usr/include/boost/core/no_exceptions_support.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsBFloat16.h:
+/usr/include/boost/mpl/begin_end.hpp:
 
-/usr/include/c++/11/experimental/bits/lfts_config.h:
+/usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/reverse_iter_fold.hpp:
 
-/usr/include/boost/mpl/reverse_fold.hpp:
+/usr/include/boost/mpl/limits/arity.hpp:
 
-/usr/include/boost/asio/ip/basic_resolver.hpp:
+/usr/include/boost/fusion/algorithm/iteration/detail/segmented_fold.hpp:
 
-/usr/include/boost/mpl/aux_/config/arrays.hpp:
+/usr/include/boost/mpl/bind.hpp:
 
-/usr/include/asm-generic/errno.h:
+/usr/include/boost/mpl/bitand.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/SpecialFunctions:
+/usr/include/x86_64-linux-gnu/bits/timex.h:
 
-/usr/include/boost/asio/detail/reactor_op.hpp:
+/usr/include/boost/type_traits/is_default_constructible.hpp:
 
-/usr/include/boost/date_time/time_iterator.hpp:
+/usr/include/boost/fusion/algorithm.hpp:
 
-/usr/include/boost/smart_ptr/shared_ptr.hpp:
+/usr/include/boost/mpl/bool.hpp:
 
-/usr/include/boost/mpl/aux_/config/intel.hpp:
+/usr/include/c++/11/stdexcept:
 
-/usr/local/include/ur_rtde/rtde_control_interface.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContractionMapper.h:
 
-/usr/include/assert.h:
+/opt/openrobots/include/pinocchio/container/boost-container-limits.hpp:
 
-/usr/include/boost/asio/execution/context.hpp:
+/usr/include/boost/mpl/bool_fwd.hpp:
 
-/opt/openrobots/include/pinocchio/math/rotation.hpp:
+/usr/include/boost/mpl/contains_fwd.hpp:
 
-/usr/include/boost/aligned_storage.hpp:
+/usr/include/boost/serialization/item_version_type.hpp:
 
-/usr/include/boost/iostreams/detail/adapter/non_blocking_adapter.hpp:
+/usr/include/boost/mpl/deref.hpp:
 
-/usr/include/boost/archive/basic_binary_iarchive.hpp:
+/usr/include/boost/mpl/distance.hpp:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/time_members.h:
+/usr/include/boost/mpl/distance_fwd.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/timesize.h:
+/usr/include/boost/range/config.hpp:
 
-/usr/include/boost/archive/basic_binary_iprimitive.hpp:
+/usr/include/c++/11/bits/ostream_insert.h:
 
-/usr/include/boost/iterator/iterator_concepts.hpp:
+/usr/include/boost/mpl/empty_base.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorExecutor.h:
+/usr/include/boost/mpl/empty_fwd.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/visitor/joint-binary-visitor.hpp:
+/usr/include/boost/mpl/equal.hpp:
 
-/usr/include/boost/asio/traits/schedule_member.hpp:
+/usr/include/x86_64-linux-gnu/c++/11/bits/atomic_word.h:
 
-/usr/include/boost/mpl/void.hpp:
+/usr/include/x86_64-linux-gnu/bits/fp-fast.h:
 
-/usr/include/boost/asio/detail/handler_alloc_helpers.hpp:
+/usr/include/boost/mpl/equal_to.hpp:
 
-/usr/include/boost/archive/basic_binary_oprimitive.hpp:
+/usr/include/boost/iostreams/detail/adapter/concept_adapter.hpp:
 
-/usr/include/boost/mpl/begin_end_fwd.hpp:
+/usr/include/boost/mpl/erase_fwd.hpp:
 
-/usr/include/boost/asio/basic_stream_socket.hpp:
+/usr/include/boost/type_traits/is_pod.hpp:
 
-/usr/include/boost/fusion/view/iterator_range/iterator_range.hpp:
+/usr/include/boost/mpl/find.hpp:
 
-/usr/include/boost/archive/basic_text_iarchive.hpp:
+/usr/include/boost/mpl/front_fwd.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/atomic_wide_counter.h:
+/usr/include/boost/mpl/front_inserter.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/DisableStupidWarnings.h:
+/usr/include/c++/11/limits:
 
-/usr/include/boost/archive/basic_text_iprimitive.hpp:
+/opt/openrobots/include/pinocchio/serialization/serializable.hpp:
 
-/usr/include/c++/11/iostream:
+/usr/include/boost/mpl/greater.hpp:
 
-/usr/include/boost/date_time/dst_rules.hpp:
+/usr/include/boost/mpl/greater_equal.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/string_fortified.h:
+/usr/include/boost/mpl/has_key.hpp:
 
-/usr/include/boost/archive/basic_text_oprimitive.hpp:
+/usr/include/x86_64-linux-gnu/bits/getopt_posix.h:
 
-/usr/include/boost/archive/basic_xml_iarchive.hpp:
+/usr/include/boost/mpl/identity.hpp:
 
-/usr/include/boost/utility/base_from_member.hpp:
+/usr/include/boost/mpl/if.hpp:
 
-/usr/include/boost/asio/time_traits.hpp:
+/usr/include/boost/mpl/insert.hpp:
 
-/usr/include/boost/asio/ip/resolver_base.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDeviceGpu.h:
 
-/usr/include/boost/fusion/view/joint_view/detail/deref_impl.hpp:
+/usr/include/boost/mpl/inserter.hpp:
 
-/usr/include/boost/archive/basic_xml_oarchive.hpp:
+/usr/include/boost/mpl/int_fwd.hpp:
 
-/usr/include/boost/range/difference_type.hpp:
+/usr/include/boost/fusion/view/joint_view/joint_view_iterator.hpp:
 
-/usr/include/boost/preprocessor/punctuation/comma.hpp:
+/usr/include/boost/preprocessor/comparison/less.hpp:
 
-/usr/include/boost/preprocessor/comparison/less_equal.hpp:
+/usr/include/c++/11/bits/predefined_ops.h:
 
-/usr/include/boost/asio/basic_socket_acceptor.hpp:
+/usr/include/boost/mpl/integral_c.hpp:
 
-/usr/include/boost/mpl/aux_/numeric_op.hpp:
+/usr/include/boost/detail/templated_streams.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/fwd.hpp:
+/usr/include/boost/mpl/integral_c_fwd.hpp:
 
-/usr/include/boost/date_time/gregorian/greg_month.hpp:
+/usr/include/x86_64-linux-gnu/c++/11/bits/cpu_defines.h:
 
-/usr/include/boost/archive/binary_iarchive.hpp:
+/usr/include/boost/mpl/is_sequence.hpp:
 
-/usr/include/boost/fusion/support/is_segmented.hpp:
+/usr/include/boost/mpl/fold.hpp:
 
-/usr/include/boost/asio/traits/query_free.hpp:
+/usr/include/boost/mpl/iter_fold.hpp:
 
-/opt/openrobots/include/pinocchio/eigen-macros.hpp:
+/usr/include/boost/mpl/assert.hpp:
 
-/usr/include/boost/mpl/aux_/config/integral.hpp:
+/usr/include/boost/mpl/iterator_category.hpp:
 
-/usr/include/boost/predef/os/bsd/open.h:
+/usr/include/boost/type_traits/copy_cv.hpp:
 
-/usr/include/boost/archive/detail/archive_serializer_map.hpp:
+/usr/include/boost/type_traits/common_type.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/floatn-common.h:
+/usr/include/eigen3/Eigen/src/Core/GenericPacketMath.h:
 
-/usr/include/boost/type_traits/is_rvalue_reference.hpp:
+/opt/openrobots/include/pinocchio/spatial/inertia.hpp:
 
-/usr/include/boost/asio/io_service.hpp:
+/usr/include/boost/mpl/iterator_range.hpp:
 
-/usr/include/boost/iostreams/detail/streambuf/indirect_streambuf.hpp:
+/usr/include/boost/mpl/lambda.hpp:
 
-/usr/include/boost/asio/detail/handler_tracking.hpp:
+/usr/include/c++/11/functional:
 
-/usr/include/boost/serialization/wrapper.hpp:
+/usr/include/eigen3/Eigen/src/misc/RealSvd2x2.h:
 
-/opt/openrobots/include/pinocchio/spatial/log.hxx:
+/usr/include/boost/ref.hpp:
 
-/usr/include/boost/core/typeinfo.hpp:
+/usr/include/boost/iostreams/detail/enable_if_stream.hpp:
 
-/usr/include/boost/math/special_functions/detail/fp_traits.hpp:
+/usr/include/boost/mpl/less.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorChipping.h:
+/usr/include/x86_64-linux-gnu/bits/fcntl2.h:
 
-/usr/include/boost/mpl/iter_fold_if.hpp:
+/usr/include/boost/mpl/limits/list.hpp:
 
-/usr/include/boost/math/special_functions/trunc.hpp:
+/usr/include/boost/mpl/vector/aux_/clear.hpp:
 
-/usr/include/boost/mpl/empty_base.hpp:
+/usr/include/boost/mpl/limits/vector.hpp:
 
-/usr/include/c++/11/bits/predefined_ops.h:
+/usr/include/boost/mpl/list/aux_/front.hpp:
 
-/usr/include/boost/preprocessor/comparison/less.hpp:
+/usr/include/boost/mpl/list/aux_/item.hpp:
 
-/usr/include/boost/mpl/int_fwd.hpp:
+/usr/include/boost/mpl/list/aux_/iterator.hpp:
 
-/usr/include/boost/asio/detail/posix_event.hpp:
+/usr/include/boost/mpl/aux_/preprocessor/ext_params.hpp:
 
-/usr/include/boost/archive/detail/basic_iserializer.hpp:
+/usr/include/boost/config/no_tr1/complex.hpp:
 
-/usr/include/boost/fusion/iterator/mpl/fusion_iterator.hpp:
+/usr/include/boost/mpl/list/aux_/push_back.hpp:
 
-/usr/include/boost/date_time/date_duration.hpp:
+/usr/include/boost/mpl/list/aux_/push_front.hpp:
 
-/usr/include/boost/function_types/detail/pp_loop.hpp:
+/usr/include/x86_64-linux-gnu/sys/ioctl.h:
 
-/usr/include/boost/type_traits/detail/is_member_function_pointer_cxx_11.hpp:
+/usr/include/boost/mpl/list/aux_/tag.hpp:
 
-/usr/include/boost/concept/assert.hpp:
+/usr/include/boost/mpl/list/list0.hpp:
 
-/usr/include/boost/archive/detail/basic_oarchive.hpp:
+/usr/include/boost/mpl/list/list30.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/frame.hpp:
+/usr/include/boost/mpl/logical.hpp:
 
-/usr/include/boost/mpl/integral_c_fwd.hpp:
+/usr/include/boost/mpl/long_fwd.hpp:
 
-/usr/include/boost/archive/detail/basic_serializer.hpp:
+/usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/reverse_fold.hpp:
 
-/usr/include/boost/mpl/aux_/advance_backward.hpp:
+/usr/include/boost/type_traits/is_arithmetic.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/ParametrizedLine.h:
+/usr/include/boost/mpl/max_element.hpp:
 
-/usr/include/boost/asio/detail/cstddef.hpp:
+/usr/include/x86_64-linux-gnu/bits/environments.h:
 
-/usr/include/boost/asio/detail/chrono_time_traits.hpp:
+/usr/include/boost/archive/basic_streambuf_locale_saver.hpp:
 
-/usr/include/boost/type_traits/detail/has_prefix_operator.hpp:
+/usr/include/boost/mpl/min.hpp:
 
-/usr/include/boost/asio/detail/concurrency_hint.hpp:
+/usr/include/boost/mpl/min_max.hpp:
 
-/usr/include/boost/mpl/end.hpp:
+/usr/include/boost/mpl/negate.hpp:
 
-/usr/include/boost/archive/detail/decl.hpp:
+/usr/include/boost/mpl/next.hpp:
 
-/usr/include/boost/asio/execution/detail/as_operation.hpp:
+/usr/include/boost/mpl/next_prior.hpp:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/messages_members.h:
+/usr/include/eigen3/Eigen/src/Core/MapBase.h:
 
-/usr/include/boost/archive/detail/interface_iarchive.hpp:
+/usr/include/boost/mpl/list.hpp:
 
-/usr/include/boost/archive/text_oarchive.hpp:
+/usr/include/boost/mpl/not_equal_to.hpp:
 
-/usr/include/boost/mpl/aux_/config/preprocessor.hpp:
+/usr/include/eigen3/Eigen/src/Core/ArrayBase.h:
 
-/usr/include/c++/11/bits/functional_hash.h:
+/usr/include/boost/mpl/or.hpp:
 
-/opt/openrobots/include/hpp/fcl/BV/OBBRSS.h:
+/usr/include/boost/mpl/pair.hpp:
 
-/usr/include/boost/range/iterator_range_core.hpp:
+/usr/include/boost/mpl/pair_view.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/geometry.hpp:
+/usr/include/boost/smart_ptr/detail/yield_k.hpp:
 
-/opt/openrobots/include/pinocchio/math/taylor-expansion.hpp:
+/usr/include/boost/mpl/plus.hpp:
 
-/usr/include/boost/fusion/iterator/distance.hpp:
+/usr/include/boost/mpl/pop_front.hpp:
 
-/usr/include/boost/asio/associated_allocator.hpp:
+/usr/include/boost/asio/execution/context_as.hpp:
 
-/usr/include/boost/asio/detail/scheduler_thread_info.hpp:
+/usr/include/eigen3/Eigen/src/Core/Block.h:
 
-/usr/include/boost/asio/traits/execute_free.hpp:
+/usr/include/boost/mpl/pop_front_fwd.hpp:
 
-/usr/include/boost/variant/detail/enable_recursive_fwd.hpp:
+/usr/include/boost/mpl/print.hpp:
 
-/usr/include/boost/fusion/view/joint_view/joint_view.hpp:
+/usr/include/eigen3/Eigen/src/Eigenvalues/EigenSolver.h:
 
-/usr/include/boost/mpl/list/aux_/O1_size.hpp:
+/usr/include/boost/mpl/protect.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/products/SelfadjointProduct.h:
+/usr/include/c++/11/bits/range_access.h:
 
-/usr/include/c++/11/typeinfo:
+/usr/include/boost/mpl/push_back.hpp:
 
-/usr/include/boost/asio/execution_context.hpp:
+/usr/include/boost/mpl/push_back_fwd.hpp:
 
-/usr/include/boost/mpl/aux_/value_wknd.hpp:
+/usr/include/eigen3/Eigen/src/Core/MatrixBase.h:
 
-/usr/include/boost/asio/basic_socket.hpp:
+/usr/include/boost/mpl/push_front_fwd.hpp:
 
-/usr/include/boost/iostreams/output_sequence.hpp:
+/usr/include/boost/mpl/quote.hpp:
 
-/usr/include/boost/archive/detail/register_archive.hpp:
+/usr/include/boost/fusion/view/filter_view/detail/value_of_data_impl.hpp:
 
-/usr/include/boost/mpl/find.hpp:
+/usr/include/c++/11/memory:
 
-/usr/include/boost/asio/detail/reactive_socket_recvmsg_op.hpp:
+/usr/include/boost/mpl/remove_if.hpp:
 
-/opt/openrobots/include/hpp/fcl/collision.h:
+/usr/include/boost/fusion/container/list/list_fwd.hpp:
 
-/usr/include/boost/iostreams/detail/enable_if_stream.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-revolute.hpp:
 
-/usr/include/boost/fusion/view/iterator_range/detail/begin_impl.hpp:
+/usr/include/c++/11/bits/enable_special_members.h:
 
-/opt/openrobots/include/pinocchio/spatial/motion-zero.hpp:
+/usr/include/boost/asio/ip/resolver_base.hpp:
 
-/opt/openrobots/include/pinocchio/utils/cast.hpp:
+/usr/include/boost/mpl/sequence_tag_fwd.hpp:
 
-/usr/include/boost/detail/indirect_traits.hpp:
+/usr/lib/gcc/x86_64-linux-gnu/11/include/stdarg.h:
 
-/usr/include/boost/asio/detail/event.hpp:
+/usr/include/boost/mpl/size_fwd.hpp:
 
-/usr/include/boost/asio/basic_streambuf_fwd.hpp:
+/usr/include/boost/mpl/size_t_fwd.hpp:
 
-/usr/include/boost/date_time/gregorian/greg_duration.hpp:
+/usr/include/boost/asio/detail/conditionally_enabled_mutex.hpp:
 
-/usr/include/boost/asio/detail/bind_handler.hpp:
+/usr/include/boost/mpl/sizeof.hpp:
 
-/usr/include/x86_64-linux-gnu/sys/timerfd.h:
+/usr/include/boost/mpl/tag.hpp:
 
-/usr/include/boost/asio/impl/io_context.ipp:
+/usr/include/boost/mpl/times.hpp:
 
-/usr/include/boost/asio/traits/connect_free.hpp:
+/usr/include/boost/type_traits/has_logical_or.hpp:
 
-/usr/include/boost/asio/detail/completion_handler.hpp:
+/opt/openrobots/include/hpp/fcl/collision.h:
 
-/usr/include/boost/concept/detail/concept_undef.hpp:
+/usr/include/boost/mpl/transform_view.hpp:
 
-/usr/include/boost/archive/detail/common_iarchive.hpp:
+/usr/include/boost/type_traits/detail/config.hpp:
 
-/usr/include/c++/11/bits/basic_string.h:
+/usr/include/boost/numeric/conversion/cast.hpp:
 
-/usr/include/boost/asio/detail/impl/epoll_reactor.hpp:
+/usr/include/boost/mpl/unpack_args.hpp:
 
-/usr/include/boost/mpl/aux_/arithmetic_op.hpp:
+/usr/include/boost/mpl/vector.hpp:
 
-/usr/include/boost/asio/detail/executor_function.hpp:
+/usr/include/boost/mpl/vector/aux_/O1_size.hpp:
 
-/usr/include/boost/asio/detail/global.hpp:
+/usr/include/x86_64-linux-gnu/bits/sched.h:
 
-/usr/include/boost/type_traits/has_plus.hpp:
+/usr/include/boost/mpl/vector/aux_/at.hpp:
 
-/usr/include/boost/asio/system_executor.hpp:
+/usr/include/boost/mpl/vector/aux_/back.hpp:
 
-/usr/include/boost/iterator/detail/config_def.hpp:
+/opt/openrobots/include/pinocchio/spatial/motion-tpl.hpp:
 
-/usr/include/eigen3/Eigen/src/LU/FullPivLU.h:
+/usr/include/boost/mpl/vector/aux_/empty.hpp:
 
-/usr/include/boost/mpl/aux_/joint_iter.hpp:
+/usr/include/boost/mpl/aux_/arity.hpp:
 
-/opt/openrobots/include/pinocchio/math/matrix.hpp:
+/usr/include/boost/mpl/vector/aux_/front.hpp:
 
-/usr/include/boost/bind/mem_fn_template.hpp:
+/usr/include/boost/mpl/vector/aux_/push_back.hpp:
 
-/usr/include/boost/fusion/sequence/intrinsic/size.hpp:
+/usr/include/boost/mpl/vector/aux_/size.hpp:
 
-/usr/include/boost/integer.hpp:
+/usr/include/boost/fusion/container/vector/convert.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/time64.h:
+/usr/include/boost/iterator/iterator_categories.hpp:
 
-/usr/include/boost/mpl/empty_fwd.hpp:
+/usr/include/boost/mpl/vector/aux_/vector0.hpp:
 
-/usr/include/boost/asio/detail/impl/epoll_reactor.ipp:
+/usr/include/boost/fusion/view/zip_view/detail/prior_impl.hpp:
 
-/usr/include/boost/type_traits/has_left_shift_assign.hpp:
+/usr/include/boost/mpl/vector/vector10.hpp:
 
-/usr/include/boost/function_types/property_tags.hpp:
+/usr/include/boost/mpl/vector/vector30.hpp:
 
-/usr/include/boost/bind/bind_mf2_cc.hpp:
+/usr/include/boost/mpl/zip_view.hpp:
 
-/usr/include/eigen3/Eigen/SVD:
+/usr/include/boost/type_index/stl_type_index.hpp:
 
-/usr/include/boost/asio/execution.hpp:
+/usr/include/boost/type_traits/is_volatile.hpp:
 
-/usr/include/boost/predef/detail/_cassert.h:
+/usr/include/eigen3/Eigen/src/Core/util/DisableStupidWarnings.h:
 
-/opt/openrobots/include/pinocchio/warning.hpp:
+/usr/include/boost/numeric/conversion/bounds.hpp:
 
-/usr/include/boost/predef/library/c/_prefix.h:
+/usr/include/boost/numeric/conversion/conversion_traits.hpp:
 
-/usr/include/boost/date_time/int_adapter.hpp:
+/usr/include/boost/numeric/conversion/converter_policies.hpp:
 
-/usr/include/eigen3/Eigen/src/Householder/Householder.h:
+/usr/include/boost/type_traits/is_nothrow_move_constructible.hpp:
 
-/usr/include/boost/mpl/O1_size_fwd.hpp:
+/usr/include/boost/serialization/access.hpp:
 
-/usr/include/boost/asio/detail/impl/posix_event.ipp:
+/usr/include/boost/asio/execution/allocator.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/ioctl-types.h:
+/usr/include/boost/numeric/conversion/detail/bounds.hpp:
 
-/usr/include/boost/asio/detail/impl/posix_thread.ipp:
+/usr/include/boost/utility/binary.hpp:
 
-/usr/include/boost/asio/traits/set_value_free.hpp:
+/usr/include/boost/numeric/conversion/detail/conversion_traits.hpp:
 
-/usr/include/boost/io_fwd.hpp:
+/usr/include/eigen3/Eigen/src/plugins/MatrixCwiseUnaryOps.h:
 
-/usr/include/boost/date_time/gregorian/greg_date.hpp:
+/usr/include/wchar.h:
 
-/usr/include/boost/iostreams/detail/is_iterator_range.hpp:
+/usr/include/boost/numeric/conversion/detail/converter.hpp:
 
-/opt/openrobots/include/hpp/fcl/BV/kDOP.h:
+/usr/include/boost/numeric/conversion/detail/int_float_mixture.hpp:
 
-/usr/include/boost/move/detail/std_ns_end.hpp:
+/usr/include/boost/date_time/posix_time/time_period.hpp:
 
-/usr/include/boost/date_time/gregorian/greg_duration_types.hpp:
+/usr/include/boost/numeric/conversion/detail/meta.hpp:
 
-/usr/include/boost/asio/deadline_timer.hpp:
+/opt/openrobots/include/pinocchio/utils/static-if.hpp:
 
-/usr/include/boost/fusion/view/iterator_range/detail/end_impl.hpp:
+/usr/include/boost/numeric/conversion/detail/preprocessed/numeric_cast_traits_common.hpp:
 
-/usr/include/boost/iostreams/detail/wrap_unwrap.hpp:
+/usr/include/boost/range/detail/common.hpp:
 
-/usr/include/locale.h:
+/usr/include/boost/numeric/conversion/detail/preprocessed/numeric_cast_traits_long_long.hpp:
 
-/usr/include/errno.h:
+/usr/include/boost/numeric/conversion/detail/udt_builtin_mixture.hpp:
 
-/usr/include/boost/date_time/gregorian/greg_weekday.hpp:
+/usr/include/boost/asio/wait_traits.hpp:
 
-/usr/include/boost/date_time/gregorian/greg_year.hpp:
+/usr/include/boost/numeric/conversion/int_float_mixture_enum.hpp:
 
-/usr/include/boost/mpl/equal_to.hpp:
+/usr/include/c++/11/bits/atomic_base.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorForcedEval.h:
+/usr/include/boost/numeric/conversion/sign_mixture_enum.hpp:
 
-/usr/include/boost/type_traits/same_traits.hpp:
+/usr/include/boost/numeric/conversion/udt_builtin_mixture_enum.hpp:
 
-/usr/include/boost/fusion/container/list/detail/value_at_impl.hpp:
+/usr/include/boost/predef/architecture/x86.h:
 
-/usr/include/boost/mpl/iterator_tags.hpp:
+/usr/include/boost/fusion/view/zip_view/detail/advance_impl.hpp:
 
-/usr/include/boost/date_time/gregorian_calendar.hpp:
+/usr/include/boost/predef/architecture/x86/64.h:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-composite.hpp:
+/usr/include/x86_64-linux-gnu/bits/types/struct_tm.h:
 
-/usr/include/boost/date_time/gregorian_calendar.ipp:
+/usr/include/boost/predef/detail/test.h:
 
-/usr/include/eigen3/Eigen/src/LU/arch/InverseSize4.h:
+/usr/include/boost/predef/make.h:
 
-/usr/include/boost/date_time/posix_time/posix_time_types.hpp:
+/usr/include/boost/predef/os/bsd/dragonfly.h:
 
-/usr/include/boost/mpl/back_fwd.hpp:
+/usr/include/boost/predef/os/bsd/free.h:
 
-/usr/include/boost/date_time/posix_time/ptime.hpp:
+/usr/include/boost/function_types/config/config.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/util/ConfigureVectorization.h:
+/usr/include/boost/predef/os/bsd/net.h:
 
-/usr/include/boost/fusion/functional/invocation/detail/that_ptr.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-collection.hpp:
 
-/usr/include/c++/11/bits/unique_lock.h:
+/usr/include/boost/predef/os/ios.h:
 
-/usr/include/boost/date_time/time.hpp:
+/opt/openrobots/include/pinocchio/spatial/explog.hpp:
 
-/usr/include/boost/date_time/time_clock.hpp:
+/usr/include/boost/predef/other/endian.h:
 
-/usr/include/boost/date_time/time_system_counted.hpp:
+/usr/include/boost/detail/basic_pointerbuf.hpp:
 
-/usr/include/boost/date_time/year_month_day.hpp:
+/usr/include/boost/type_traits/add_const.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/iscanonical.h:
+/usr/include/boost/asio/execution/detail/submit_receiver.hpp:
 
-/usr/include/boost/asio/traits/bulk_execute_member.hpp:
+/usr/include/boost/type_traits/is_member_pointer.hpp:
 
-/usr/include/boost/detail/basic_pointerbuf.hpp:
+/usr/include/boost/predef/version_number.h:
 
-/usr/include/boost/concept/usage.hpp:
+/usr/include/boost/smart_ptr/detail/sp_convertible.hpp:
 
-/usr/include/boost/mpl/empty.hpp:
+/usr/include/boost/preprocessor/arithmetic/add.hpp:
 
-/usr/include/boost/function_types/result_type.hpp:
+/usr/include/boost/preprocessor/arithmetic/detail/div_base.hpp:
 
-/usr/include/boost/detail/call_traits.hpp:
+/usr/include/boost/preprocessor/arithmetic/inc.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/motion-ref.hpp:
+/usr/include/boost/preprocessor/arithmetic/mod.hpp:
 
-/usr/include/boost/asio/io_context.hpp:
+/usr/include/boost/preprocessor/array/data.hpp:
 
-/usr/include/boost/mpl/aux_/config/overload_resolution.hpp:
+/usr/include/boost/preprocessor/array/elem.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/cpu-set.h:
+/usr/include/c++/11/ios:
 
-/usr/include/boost/detail/is_incrementable.hpp:
+/usr/include/eigen3/Eigen/src/Core/arch/Default/TypeCasting.h:
 
-/usr/include/boost/detail/lcast_precision.hpp:
+/usr/include/boost/preprocessor/array/size.hpp:
 
-/usr/include/boost/detail/select_type.hpp:
+/usr/include/boost/preprocessor/comma_if.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/uio-ext.h:
+/usr/include/boost/preprocessor/control/iif.hpp:
 
-/usr/include/boost/detail/templated_streams.hpp:
+/usr/include/boost/type_traits/remove_reference.hpp:
 
-/usr/include/boost/foreach_fwd.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorIntDiv.h:
 
-/usr/include/boost/function_types/components.hpp:
+/usr/include/boost/preprocessor/debug/error.hpp:
 
-/usr/include/c++/11/bits/ostream_insert.h:
+/usr/include/boost/asio/handler_continuation_hook.hpp:
 
-/usr/include/boost/range/config.hpp:
+/usr/include/boost/numeric/conversion/numeric_cast_traits.hpp:
 
-/usr/include/boost/mpl/distance_fwd.hpp:
+/usr/include/c++/11/bits/this_thread_sleep.h:
 
-/usr/include/boost/variant/detail/hash_variant.hpp:
+/usr/include/boost/preprocessor/detail/check.hpp:
 
-/usr/include/boost/asio/detail/fenced_block.hpp:
+/usr/include/boost/serialization/collections_save_imp.hpp:
 
-/usr/include/boost/fusion/algorithm/transformation/push_front.hpp:
+/usr/include/boost/preprocessor/empty.hpp:
 
-/usr/include/boost/function_types/config/compiler.hpp:
+/usr/include/boost/iostreams/detail/adapter/output_iterator_adapter.hpp:
 
-/usr/include/boost/function_types/detail/class_transform.hpp:
+/usr/include/boost/fusion/algorithm/iteration/reverse_fold.hpp:
 
-/usr/include/boost/config/pragma_message.hpp:
+/usr/include/boost/preprocessor/enum.hpp:
 
-/usr/include/boost/function_types/detail/components_as_mpl_sequence.hpp:
+/usr/include/boost/fusion/view/single_view/detail/distance_impl.hpp:
 
-/usr/include/boost/mpl/contains.hpp:
+/usr/include/boost/preprocessor/enum_params_with_a_default.hpp:
 
-/usr/include/boost/function_types/detail/components_impl/arity10_0.hpp:
+/usr/include/boost/preprocessor/facilities/expand.hpp:
 
-/usr/include/boost/function_types/detail/retag_default_cc.hpp:
+/usr/include/boost/range/iterator_range.hpp:
 
-/usr/include/boost/function_types/detail/components_impl/arity20_1.hpp:
+/usr/include/assert.h:
 
-/usr/include/boost/function_types/detail/encoding/aliases_def.hpp:
+/usr/include/boost/preprocessor/facilities/intercept.hpp:
 
-/usr/include/boost/mpl/aux_/push_back_impl.hpp:
+/usr/include/boost/preprocessor/iterate.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorFixedSize.h:
+/usr/include/boost/preprocessor/iteration/detail/bounds/lower1.hpp:
 
-/usr/include/boost/asio/traits/prefer_member.hpp:
+/usr/include/boost/preprocessor/iteration/detail/bounds/lower2.hpp:
 
-/usr/include/boost/function_types/detail/encoding/def.hpp:
+/usr/include/boost/fusion/container/list/cons.hpp:
 
-/usr/include/c++/11/bits/stl_relops.h:
+/usr/include/boost/preprocessor/iteration/detail/bounds/upper1.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/cartesian-axis.hpp:
+/usr/include/boost/preprocessor/iteration/detail/bounds/upper2.hpp:
 
-/usr/include/boost/function_types/detail/pp_arity_loop.hpp:
+/usr/include/boost/preprocessor/iteration/detail/iter/forward2.hpp:
 
-/opt/openrobots/include/hpp/fcl/distance.h:
+/usr/include/boost/type_traits/is_member_function_pointer.hpp:
 
-/usr/include/boost/function_types/detail/pp_cc_loop/preprocessed.hpp:
+/usr/include/boost/fusion/container/list/detail/end_impl.hpp:
 
-/usr/include/boost/mpl/iter_fold.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorBase.h:
 
-/usr/include/boost/type_traits/remove_const.hpp:
+/usr/include/boost/preprocessor/iteration/detail/iter/reverse1.hpp:
 
-/usr/include/boost/function_types/detail/pp_retag_default_cc/preprocessed.hpp:
+/usr/include/boost/version.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/select2.h:
+/usr/include/c++/11/exception:
 
-/usr/include/c++/11/bits/stl_iterator.h:
+/usr/include/boost/range/detail/misc_concept.hpp:
 
-/usr/include/boost/function_types/detail/pp_tags/cc_tag.hpp:
+/usr/include/boost/preprocessor/list/detail/fold_right.hpp:
 
-/usr/include/boost/iostreams/optimal_buffer_size.hpp:
+/usr/include/boost/preprocessor/list/fold_left.hpp:
 
-/usr/include/boost/function_types/detail/pp_tags/preprocessed.hpp:
+/usr/include/boost/preprocessor/list/fold_right.hpp:
 
-/usr/include/boost/serialization/array_wrapper.hpp:
+/usr/include/boost/preprocessor/list/reverse.hpp:
 
-/usr/include/boost/function_types/detail/pp_variate_loop/preprocessed.hpp:
+/usr/include/boost/smart_ptr/detail/sp_thread_pause.hpp:
 
-/usr/include/boost/core/nvp.hpp:
+/usr/include/boost/preprocessor/logical/bitand.hpp:
 
-/usr/include/boost/mpl/aux_/nttp_decl.hpp:
+/usr/include/boost/preprocessor/logical/compl.hpp:
 
-/usr/local/include/urcl/tcp_server.h:
+/usr/include/boost/preprocessor/punctuation/comma_if.hpp:
 
-/usr/include/boost/function_types/is_callable_builtin.hpp:
+/usr/include/boost/preprocessor/punctuation/paren.hpp:
 
-/usr/include/boost/type_traits/has_trivial_destructor.hpp:
+/usr/include/boost/preprocessor/repetition/enum.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/model.hpp:
+/usr/include/boost/preprocessor/repetition/enum_binary_params.hpp:
 
-/usr/include/boost/fusion/include/invoke.hpp:
+/usr/include/boost/archive/binary_iarchive_impl.hpp:
 
-/usr/include/boost/move/adl_move_swap.hpp:
+/usr/include/boost/preprocessor/repetition/enum_shifted.hpp:
 
-/usr/include/boost/function_types/is_member_function_pointer.hpp:
+/usr/include/boost/preprocessor/repetition/enum_trailing_params.hpp:
 
-/usr/include/boost/function_types/is_member_pointer.hpp:
+/usr/include/boost/preprocessor/seq/detail/split.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/Block.h:
+/usr/include/boost/preprocessor/seq/enum.hpp:
 
-/usr/include/boost/mpl/pop_front.hpp:
+/usr/include/boost/fusion/sequence/intrinsic/front.hpp:
 
-/usr/include/boost/fusion/adapted/mpl/detail/begin_impl.hpp:
+/usr/include/boost/serialization/detail/is_default_constructible.hpp:
 
-/usr/include/eigen3/Eigen/src/QR/HouseholderQR.h:
+/usr/include/boost/preprocessor/seq/fold_left.hpp:
 
-/usr/include/boost/mpl/aux_/insert_impl.hpp:
+/usr/include/boost/preprocessor/seq/seq.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/CwiseUnaryView.h:
+/usr/include/boost/preprocessor/seq/size.hpp:
 
-/usr/include/boost/fusion/adapted/mpl/mpl_iterator.hpp:
+/usr/include/boost/preprocessor/seq/transform.hpp:
 
-/usr/include/boost/fusion/algorithm/transformation/push_back.hpp:
+/usr/include/boost/type_traits/has_logical_and.hpp:
 
-/usr/include/boost/fusion/container/generation/make_vector.hpp:
+/usr/include/boost/mpl/aux_/yes_no.hpp:
 
-/usr/include/boost/iostreams/close.hpp:
+/usr/include/boost/preprocessor/slot/detail/shared.hpp:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/gthr-default.h:
+/usr/include/boost/preprocessor/slot/slot.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorVolumePatch.h:
+/usr/include/boost/mpl/aux_/lambda_spec.hpp:
 
-/usr/include/boost/fusion/container/list/cons_fwd.hpp:
+/usr/include/c++/11/bits/functexcept.h:
 
-/usr/include/boost/fusion/container/list/cons_iterator.hpp:
+/usr/include/boost/preprocessor/stringize.hpp:
 
-/usr/include/boost/fusion/container/list/detail/begin_impl.hpp:
+/usr/include/boost/preprocessor/variadic/elem.hpp:
 
-/usr/include/boost/mpl/aux_/na_assert.hpp:
+/usr/include/boost/range/algorithm/equal.hpp:
 
-/usr/include/arpa/inet.h:
+/usr/include/boost/range/begin.hpp:
 
-/usr/include/boost/fusion/container/list/detail/deref_impl.hpp:
+/usr/include/eigen3/Eigen/src/Core/CoreEvaluators.h:
 
-/usr/include/boost/variant/detail/cast_storage.hpp:
+/usr/include/boost/range/concepts.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/explog-quaternion.hpp:
+/usr/include/boost/range/const_iterator.hpp:
 
-/usr/include/boost/fusion/container/list/detail/empty_impl.hpp:
+/usr/include/c++/11/ext/atomicity.h:
 
-/usr/include/boost/fusion/container/list/detail/end_impl.hpp:
+/usr/include/boost/range/detail/extract_optional_type.hpp:
 
-/usr/include/boost/fusion/container/list/detail/value_of_impl.hpp:
+/usr/include/x86_64-linux-gnu/c++/11/bits/gthr.h:
 
-/usr/include/boost/fusion/sequence/intrinsic/segments.hpp:
+/usr/include/eigen3/Eigen/src/Eigenvalues/HessenbergDecomposition.h:
 
-/usr/include/boost/variant/detail/substitute_fwd.hpp:
+/usr/include/boost/range/detail/implementation_help.hpp:
 
-/usr/include/boost/preprocessor/control/expr_iif.hpp:
+/usr/include/boost/range/detail/msvc_has_iterator_workaround.hpp:
 
-/usr/include/boost/asio/steady_timer.hpp:
+/usr/include/boost/range/detail/safe_bool.hpp:
 
-/usr/include/boost/fusion/container/list/nil.hpp:
+/usr/include/boost/range/distance.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/advance_impl.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsPacketMath.h:
 
-/usr/include/c++/11/cwctype:
+/usr/include/boost/fusion/algorithm/query/any.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/at_impl.hpp:
+/usr/include/boost/range/empty.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/begin_impl.hpp:
+/usr/include/boost/variant/recursive_variant.hpp:
 
-/usr/include/boost/fusion/iterator/detail/segmented_iterator.hpp:
+/usr/include/boost/range/functions.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/config.hpp:
+/usr/include/boost/range/iterator_range_io.hpp:
 
-/usr/include/boost/mpl/aux_/begin_end_impl.hpp:
+/usr/include/boost/bind/mem_fn_cc.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/next_impl.hpp:
+/usr/include/boost/type_traits/is_bounded_array.hpp:
 
-/usr/include/x86_64-linux-gnu/sys/un.h:
+/usr/include/c++/11/bits/unique_ptr.h:
 
-/usr/include/boost/iostreams/detail/dispatch.hpp:
+/usr/include/boost/range/range_fwd.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/value_at_impl.hpp:
+/usr/include/eigen3/Eigen/src/QR/ColPivHouseholderQR.h:
 
-/usr/include/eigen3/Eigen/src/Core/SelfAdjointView.h:
+/usr/include/boost/range/rend.hpp:
 
-/usr/include/boost/fusion/container/vector/detail/value_of_impl.hpp:
+/usr/include/boost/range/size.hpp:
 
-/usr/include/boost/fusion/container/vector/vector.hpp:
+/usr/include/boost/fusion/iterator/detail/adapt_deref_traits.hpp:
 
-/usr/include/boost/fusion/container/vector/vector_fwd.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/Translation.h:
 
-/usr/include/boost/fusion/container/vector/vector_iterator.hpp:
+/usr/include/boost/range/size_type.hpp:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/mm_malloc.h:
+/opt/openrobots/include/hpp/fcl/BV/BV_node.h:
 
-/usr/include/boost/fusion/functional/invocation/limits.hpp:
+/usr/include/boost/smart_ptr/bad_weak_ptr.hpp:
 
-/usr/include/boost/smart_ptr/detail/sp_nullptr_t.hpp:
+/opt/openrobots/include/pinocchio/spatial/motion.hpp:
 
-/usr/include/boost/serialization/detail/is_default_constructible.hpp:
+/usr/include/boost/mpl/lambda_fwd.hpp:
 
-/usr/include/boost/fusion/view/single_view/detail/prior_impl.hpp:
+/usr/include/boost/range/value_type.hpp:
 
-/usr/include/boost/fusion/iterator/deref.hpp:
+/usr/include/boost/scoped_ptr.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/arch/Default/Half.h:
+/usr/include/boost/serialization/array.hpp:
 
-/usr/include/boost/mpl/aux_/template_arity_fwd.hpp:
+/usr/include/boost/serialization/array_optimization.hpp:
 
-/usr/include/boost/date_time/date.hpp:
+/usr/include/boost/serialization/base_object.hpp:
 
-/usr/include/boost/mpl/inherit.hpp:
+/usr/include/boost/fusion/container/deque/deque_fwd.hpp:
 
-/usr/include/boost/utility/addressof.hpp:
+/usr/include/boost/serialization/collection_size_type.hpp:
 
-/usr/include/boost/fusion/iterator/detail/adapt_deref_traits.hpp:
+/usr/include/x86_64-linux-gnu/bits/posix_opt.h:
 
-/usr/include/boost/fusion/iterator/detail/adapt_value_traits.hpp:
+/usr/include/boost/serialization/collection_traits.hpp:
 
-/usr/include/rpc/netdb.h:
+/usr/include/boost/serialization/config.hpp:
 
-/usr/include/boost/iostreams/detail/select.hpp:
+/usr/include/c++/11/ostream:
 
-/usr/include/boost/fusion/iterator/detail/distance.hpp:
+/usr/include/x86_64-linux-gnu/bits/socket.h:
 
-/usr/include/boost/preprocessor/enum_params.hpp:
+/usr/include/boost/mpl/insert_fwd.hpp:
 
-/usr/include/boost/mpl/inserter.hpp:
+/usr/include/boost/serialization/detail/stack_constructor.hpp:
 
-/usr/include/c++/11/new:
+/usr/include/boost/type_traits/is_convertible.hpp:
 
-/usr/include/boost/asio/detail/reactive_null_buffers_op.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsHalf.h:
 
-/usr/include/boost/mpl/apply_fwd.hpp:
+/opt/openrobots/include/pinocchio/spatial/act-on-set.hpp:
 
-/usr/include/boost/fusion/iterator/detail/segmented_equal_to.hpp:
+/usr/include/boost/serialization/extended_type_info.hpp:
 
-/usr/include/boost/asio/detail/handler_type_requirements.hpp:
+/usr/include/boost/fusion/view/iterator_range/detail/segments_impl.hpp:
 
-/usr/include/boost/mpl/aux_/config/use_preprocessed.hpp:
+/usr/include/eigen3/Eigen/src/Core/Dot.h:
 
-/usr/include/boost/fusion/iterator/detail/segmented_next_impl.hpp:
+/usr/include/boost/asio/detail/impl/reactive_socket_service_base.ipp:
 
-/usr/include/boost/fusion/iterator/next.hpp:
+/usr/include/boost/serialization/extended_type_info_typeid.hpp:
 
-/usr/include/boost/archive/binary_iarchive_impl.hpp:
+/usr/include/boost/fusion/support/sequence_base.hpp:
 
-/usr/include/boost/mpl/aux_/lambda_spec.hpp:
+/usr/include/boost/serialization/factory.hpp:
 
-/usr/include/c++/11/backward/auto_ptr.h:
+/usr/include/boost/predef/detail/_cassert.h:
 
-/usr/include/boost/asio/detail/posix_global.hpp:
+/usr/include/boost/serialization/is_bitwise_serializable.hpp:
 
-/usr/include/boost/fusion/iterator/prior.hpp:
+/usr/include/boost/serialization/level_enum.hpp:
 
-/usr/include/boost/asio/detail/timer_queue_ptime.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/GeneralMatrixVector.h:
 
-/usr/include/boost/fusion/iterator/value_of.hpp:
+/usr/include/boost/serialization/library_version_type.hpp:
 
-/usr/include/boost/fusion/iterator/value_of_data.hpp:
+/usr/include/boost/serialization/nvp.hpp:
 
-/usr/include/boost/asio/ip/basic_resolver_results.hpp:
+/usr/include/boost/mpl/bitxor.hpp:
 
-/usr/include/boost/fusion/sequence/intrinsic/at.hpp:
+/usr/include/endian.h:
 
-/usr/include/boost/fusion/sequence/intrinsic/begin.hpp:
+/usr/include/boost/serialization/serialization.hpp:
 
-/usr/include/boost/serialization/vector.hpp:
+/usr/include/boost/serialization/singleton.hpp:
 
-/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_begin.hpp:
+/usr/include/c++/11/bits/stl_numeric.h:
 
-/usr/include/boost/preprocessor/slot/detail/def.hpp:
+/usr/include/c++/11/bits/stl_relops.h:
 
-/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_begin_impl.hpp:
+/usr/include/boost/serialization/static_warning.hpp:
 
-/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_end_impl.hpp:
+/usr/include/boost/system/detail/config.hpp:
 
-/usr/include/boost/type_traits/is_class.hpp:
+/usr/include/boost/serialization/string.hpp:
 
-/usr/include/boost/asio/detail/resolve_op.hpp:
+/usr/include/c++/11/ctime:
 
-/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_size.hpp:
+/usr/include/boost/asio/detail/timer_scheduler_fwd.hpp:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/c++allocator.h:
+/usr/include/boost/serialization/throw_exception.hpp:
 
-/usr/include/c++/11/unordered_map:
+/usr/include/x86_64-linux-gnu/bits/math-vector.h:
 
-/usr/include/boost/date_time/gregorian/greg_ymd.hpp:
+/usr/include/stdio.h:
 
-/usr/include/boost/math/constants/calculate_constants.hpp:
+/usr/include/boost/serialization/tracking_enum.hpp:
 
-/usr/include/boost/fusion/sequence/intrinsic/empty.hpp:
+/usr/include/eigen3/Eigen/src/Core/Random.h:
 
-/usr/include/boost/lexical_cast/detail/converter_lexical.hpp:
+/usr/include/boost/serialization/traits.hpp:
 
-/usr/include/boost/move/detail/meta_utils_core.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorConcatenation.h:
 
-/usr/include/c++/11/cfloat:
+/usr/include/boost/fusion/view/zip_view/zip_view.hpp:
 
-/usr/include/boost/move/detail/std_ns_begin.hpp:
+/usr/include/boost/serialization/void_cast.hpp:
 
-/usr/include/boost/fusion/sequence/intrinsic/end.hpp:
+/usr/include/boost/fusion/container/vector/detail/convert_impl.hpp:
 
-/usr/include/boost/preprocessor/control/if.hpp:
+/usr/include/boost/serialization/void_cast_fwd.hpp:
 
-/usr/include/boost/fusion/iterator/iterator_facade.hpp:
+/usr/include/boost/fusion/container/list/detail/begin_impl.hpp:
 
-/usr/include/boost/fusion/sequence/intrinsic/front.hpp:
+/usr/include/c++/11/bits/locale_conv.h:
 
-/usr/include/boost/fusion/sequence/intrinsic/value_at.hpp:
+/usr/include/c++/11/bits/locale_facets_nonio.tcc:
 
-/usr/include/boost/fusion/sequence/intrinsic_fwd.hpp:
+/usr/include/boost/shared_ptr.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/MapBase.h:
+/usr/include/boost/smart_ptr/allocate_shared_array.hpp:
 
-/usr/include/boost/mpl/not.hpp:
+/usr/include/boost/smart_ptr/detail/operator_bool.hpp:
 
-/usr/include/boost/fusion/support/category_of.hpp:
+/usr/include/boost/smart_ptr/detail/sp_counted_base.hpp:
 
-/usr/include/boost/iostreams/constants.hpp:
+/usr/include/boost/fusion/iterator/next.hpp:
 
-/usr/include/boost/fusion/support/config.hpp:
+/usr/include/boost/smart_ptr/detail/sp_counted_impl.hpp:
+
+/usr/include/boost/iostreams/detail/is_dereferenceable.hpp:
+
+/usr/include/boost/smart_ptr/detail/sp_forward.hpp:
+
+/usr/include/boost/fusion/view/reverse_view/reverse_view_iterator.hpp:
+
+/usr/include/boost/type_traits/has_modulus.hpp:
+
+/usr/include/boost/archive/basic_text_iarchive.hpp:
+
+/usr/include/boost/variant/visitor_ptr.hpp:
+
+/usr/include/boost/smart_ptr/detail/sp_has_gcc_intrinsics.hpp:
+
+/usr/include/boost/smart_ptr/detail/sp_thread_sleep.hpp:
+
+/usr/include/boost/smart_ptr/detail/sp_typeinfo_.hpp:
+
+/usr/include/x86_64-linux-gnu/sys/types.h:
+
+/usr/include/boost/smart_ptr/detail/spinlock_gcc_atomic.hpp:
+
+/usr/include/poll.h:
+
+/usr/include/boost/asio/io_context.hpp:
+
+/usr/include/boost/smart_ptr/make_shared.hpp:
+
+/usr/include/eigen3/Eigen/src/Core/functors/NullaryFunctors.h:
+
+/usr/include/boost/smart_ptr/scoped_ptr.hpp:
+
+/usr/include/eigen3/Eigen/src/Core/PartialReduxEvaluator.h:
+
+/usr/include/boost/preprocessor/enum_params.hpp:
+
+/usr/include/boost/static_assert.hpp:
+
+/usr/include/boost/asio/query.hpp:
+
+/usr/include/boost/swap.hpp:
+
+/usr/include/x86_64-linux-gnu/bits/mathcalls-narrow.h:
+
+/usr/include/boost/system/api_config.hpp:
+
+/usr/include/boost/system/detail/system_category_posix.hpp:
+
+/usr/include/boost/system/error_code.hpp:
+
+/usr/include/boost/type.hpp:
+
+/usr/include/boost/mpl/erase_key_fwd.hpp:
+
+/usr/include/boost/type_index.hpp:
+
+/usr/include/boost/type_traits/add_cv.hpp:
+
+/usr/include/boost/type_traits/is_union.hpp:
+
+/usr/include/boost/type_traits/add_pointer.hpp:
+
+/usr/include/eigen3/Eigen/src/Core/arch/Default/ConjHelper.h:
+
+/usr/include/boost/type_traits/add_volatile.hpp:
+
+/usr/include/boost/type_traits/alignment_of.hpp:
+
+/usr/include/boost/type_traits/decay.hpp:
+
+/usr/include/boost/mpl/numeric_cast.hpp:
+
+/usr/include/c++/11/chrono:
+
+/usr/include/boost/type_traits/declval.hpp:
+
+/usr/include/c++/11/cstddef:
+
+/usr/include/x86_64-linux-gnu/bits/types/clock_t.h:
+
+/usr/include/boost/type_traits/detail/has_binary_operator.hpp:
+
+/usr/include/eigen3/Eigen/src/Core/Redux.h:
+
+/usr/include/boost/asio/detail/cstddef.hpp:
+
+/usr/include/boost/mpl/vector/aux_/iterator.hpp:
+
+/usr/include/boost/type_traits/detail/mp_defer.hpp:
+
+/usr/include/x86_64-linux-gnu/bits/pthreadtypes.h:
+
+/usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/iter_fold.hpp:
+
+/usr/include/boost/type_traits/detail/yes_no_type.hpp:
+
+/usr/include/c++/11/cstdint:
+
+/usr/include/boost/type_traits/floating_point_promotion.hpp:
+
+/usr/include/boost/asio/traits/set_value_free.hpp:
+
+/usr/include/boost/type_traits/function_traits.hpp:
+
+/usr/include/boost/mpl/aux_/push_front_impl.hpp:
+
+/usr/include/boost/type_traits/has_bit_or.hpp:
+
+/usr/include/boost/iostreams/write.hpp:
+
+/usr/include/boost/type_traits/has_bit_or_assign.hpp:
+
+/usr/include/boost/type_traits/has_bit_xor.hpp:
+
+/usr/include/boost/type_traits/has_bit_xor_assign.hpp:
+
+/usr/include/boost/type_traits/has_dereference.hpp:
+
+/usr/include/boost/utility/result_of.hpp:
+
+/usr/include/boost/type_traits/has_greater.hpp:
+
+/usr/include/x86_64-linux-gnu/bits/types/__mbstate_t.h:
+
+/usr/include/eigen3/Eigen/src/Core/CwiseBinaryOp.h:
+
+/usr/include/boost/type_traits/has_greater_equal.hpp:
+
+/usr/include/c++/11/bits/unordered_map.h:
+
+/usr/include/boost/type_traits/has_left_shift.hpp:
+
+/usr/include/boost/type_traits/has_logical_not.hpp:
+
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorPatch.h:
+
+/usr/include/boost/type_traits/has_minus.hpp:
+
+/usr/include/boost/preprocessor/facilities/overload.hpp:
+
+/usr/include/boost/type_traits/has_minus_assign.hpp:
+
+/usr/include/boost/iostreams/detail/optional.hpp:
+
+/usr/include/c++/11/csignal:
+
+/usr/include/boost/variant/detail/substitute.hpp:
+
+/usr/include/c++/11/atomic:
+
+/usr/include/boost/type_traits/has_modulus_assign.hpp:
+
+/usr/include/boost/date_time/year_month_day.hpp:
+
+/usr/include/boost/type_traits/has_multiplies.hpp:
+
+/usr/include/boost/type_traits/has_multiplies_assign.hpp:
+
+/usr/include/boost/variant/bad_visit.hpp:
+
+/usr/include/boost/mpl/erase.hpp:
+
+/usr/include/boost/type_traits/has_negate.hpp:
+
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorEvalTo.h:
+
+/usr/include/x86_64-linux-gnu/asm/sockios.h:
+
+/usr/include/boost/type_traits/has_new_operator.hpp:
+
+/usr/include/boost/type_traits/has_not_equal_to.hpp:
+
+/usr/include/boost/type_traits/has_nothrow_assign.hpp:
+
+/usr/include/asm-generic/sockios.h:
+
+/usr/include/eigen3/Eigen/src/Core/BooleanRedux.h:
+
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorStriding.h:
 
 /usr/include/boost/mpl/integral_c_tag.hpp:
 
-/usr/include/boost/type_traits/copy_cv_ref.hpp:
+/usr/include/boost/variant/detail/std_hash.hpp:
 
-/usr/include/boost/fusion/support/detail/index_sequence.hpp:
+/usr/include/boost/type_traits/has_nothrow_constructor.hpp:
 
-/usr/include/boost/fusion/support/detail/mpl_iterator_category.hpp:
+/usr/include/c++/11/bits/charconv.h:
 
-/usr/include/boost/fusion/support/is_iterator.hpp:
+/usr/include/boost/mpl/aux_/integral_wrapper.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContractionGpu.h:
+/usr/include/boost/preprocessor/dec.hpp:
 
-/usr/include/boost/fusion/support/is_sequence.hpp:
+/usr/include/c++/11/bits/ostream.tcc:
 
-/usr/include/boost/mpl/aux_/fold_impl_body.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/Macros.h:
+
+/usr/include/boost/type_traits/has_nothrow_copy.hpp:
+
+/usr/include/boost/type_traits/remove_extent.hpp:
+
+/usr/include/eigen3/Eigen/src/Core/arch/SSE/TypeCasting.h:
+
+/usr/include/boost/type_traits/has_nothrow_destructor.hpp:
+
+/usr/include/boost/type_traits/has_post_increment.hpp:
+
+/usr/include/boost/type_traits/has_trivial_assign.hpp:
+
+/usr/include/boost/type_traits/has_trivial_copy.hpp:
+
+/usr/include/boost/fusion/iterator/detail/adapt_value_traits.hpp:
+
+/usr/include/boost/mpl/vector/aux_/numbered.hpp:
+
+/usr/include/boost/type_traits/has_trivial_move_assign.hpp:
+
+/usr/include/boost/type_traits/has_trivial_move_constructor.hpp:
+
+/usr/include/x86_64-linux-gnu/bits/locale.h:
+
+/usr/include/boost/type_traits/has_unary_plus.hpp:
+
+/usr/include/boost/type_traits/integral_promotion.hpp:
+
+/usr/include/boost/asio/basic_socket_streambuf.hpp:
+
+/usr/include/boost/type_traits/is_abstract.hpp:
+
+/usr/include/boost/type_traits/is_array.hpp:
+
+/usr/include/c++/11/vector:
+
+/usr/include/boost/type_traits/is_base_and_derived.hpp:
+
+/usr/include/boost/type_traits/is_complete.hpp:
+
+/usr/include/boost/fusion/view/iterator_range/detail/segmented_iterator_range.hpp:
+
+/usr/include/boost/type_traits/is_complex.hpp:
+
+/usr/include/boost/fusion/algorithm/query/count_if.hpp:
+
+/usr/include/boost/mpl/not.hpp:
+
+/usr/include/boost/type_traits/is_compound.hpp:
+
+/usr/include/x86_64-linux-gnu/bits/stdint-uintn.h:
+
+/usr/include/boost/type_traits/is_copy_constructible.hpp:
+
+/usr/include/eigen3/Eigen/src/Core/products/GeneralMatrixMatrixTriangular.h:
+
+/usr/include/boost/type_traits/is_destructible.hpp:
+
+/usr/include/boost/type_traits/is_empty.hpp:
+
+/usr/include/x86_64-linux-gnu/sys/cdefs.h:
+
+/usr/include/c++/11/bits/vector.tcc:
+
+/usr/include/boost/type_traits/is_final.hpp:
+
+/usr/include/x86_64-linux-gnu/bits/stdlib.h:
+
+/usr/include/boost/type_traits/is_floating_point.hpp:
+
+/usr/include/eigen3/Eigen/src/Core/util/ReenableStupidWarnings.h:
+
+/usr/include/eigen3/Eigen/src/Core/arch/Default/Settings.h:
+
+/usr/include/boost/type_traits/is_integral.hpp:
+
+/usr/include/boost/fusion/iterator/distance.hpp:
+
+/usr/include/x86_64-linux-gnu/asm/socket.h:
+
+/usr/include/boost/type_traits/is_list_constructible.hpp:
+
+/usr/include/boost/math/special_functions/trunc.hpp:
+
+/usr/include/boost/type_traits/is_lvalue_reference.hpp:
+
+/usr/include/boost/asio/execution/detail/bulk_sender.hpp:
+
+/usr/include/boost/type_traits/is_nothrow_swappable.hpp:
+
+/usr/include/boost/type_traits/is_object.hpp:
+
+/usr/include/boost/serialization/version.hpp:
+
+/usr/include/boost/type_traits/is_pointer.hpp:
+
+/usr/include/boost/type_traits/is_polymorphic.hpp:
+
+/usr/include/boost/type_traits/is_reference.hpp:
+
+/usr/include/boost/fusion/container/vector/vector_iterator.hpp:
+
+/usr/include/boost/type_traits/is_same.hpp:
+
+/usr/include/boost/type_traits/is_scalar.hpp:
+
+/usr/include/c++/11/bits/fstream.tcc:
+
+/usr/include/boost/type_traits/is_scoped_enum.hpp:
+
+/usr/include/boost/type_traits/is_trivially_copyable.hpp:
+
+/usr/include/c++/11/bits/stream_iterator.h:
+
+/usr/include/c++/11/new:
+
+/usr/include/boost/type_traits/is_unbounded_array.hpp:
+
+/usr/include/boost/type_traits/is_unsigned.hpp:
+
+/usr/lib/gcc/x86_64-linux-gnu/11/include/stddef.h:
+
+/usr/include/boost/type_traits/is_virtual_base_of.hpp:
+
+/usr/include/boost/type_traits/is_void.hpp:
+
+/usr/include/boost/type_traits/make_signed.hpp:
+
+/usr/include/boost/type_traits/make_unsigned.hpp:
+
+/usr/include/boost/type_traits/make_void.hpp:
+
+/usr/include/boost/type_traits/negation.hpp:
+
+/usr/include/c++/11/bits/istream.tcc:
+
+/usr/include/boost/type_traits/rank.hpp:
+
+/usr/include/boost/date_time/time_duration.hpp:
+
+/usr/include/boost/type_traits/remove_bounds.hpp:
+
+/usr/include/boost/math/special_functions/fpclassify.hpp:
+
+/usr/include/boost/type_traits/remove_cv.hpp:
+
+/usr/include/boost/preprocessor/comparison/greater.hpp:
+
+/usr/include/boost/type_traits/remove_cv_ref.hpp:
+
+/usr/include/boost/type_traits/remove_pointer.hpp:
+
+/usr/include/boost/type_traits/remove_volatile.hpp:
+
+/usr/include/boost/type_traits/type_identity.hpp:
+
+/usr/include/eigen3/Eigen/src/Core/products/Parallelizer.h:
+
+/opt/openrobots/include/pinocchio/multibody/fcl.hxx:
+
+/usr/include/boost/type_traits/type_with_alignment.hpp:
+
+/usr/include/boost/utility/declval.hpp:
+
+/usr/include/boost/utility/detail/result_of_iterate.hpp:
+
+/usr/include/boost/type_traits/has_less.hpp:
+
+/usr/include/boost/utility/enable_if.hpp:
+
+/usr/include/boost/variant.hpp:
+
+/usr/include/boost/variant/apply_visitor.hpp:
+
+/usr/include/boost/variant/detail/apply_visitor_binary.hpp:
+
+/usr/include/boost/variant/detail/apply_visitor_unary.hpp:
+
+/usr/include/boost/variant/detail/element_index.hpp:
+
+/usr/include/boost/variant/detail/enable_recursive.hpp:
+
+/usr/include/boost/mpl/erase_key.hpp:
+
+/usr/include/boost/variant/detail/forced_return.hpp:
 
-/usr/include/boost/fusion/support/iterator_base.hpp:
+/usr/include/boost/variant/detail/has_result_type.hpp:
 
-/usr/include/x86_64-linux-gnu/asm/types.h:
+/usr/include/boost/type_traits/has_pre_decrement.hpp:
 
-/usr/include/boost/asio/handler_invoke_hook.hpp:
+/usr/include/boost/variant/detail/make_variant_list.hpp:
 
-/usr/include/boost/fusion/support/void.hpp:
+/usr/include/boost/variant/detail/over_sequence.hpp:
 
-/usr/include/boost/fusion/view/iterator_range.hpp:
+/usr/include/boost/type_traits/has_divides.hpp:
 
-/usr/include/boost/integer_traits.hpp:
+/usr/include/boost/variant/recursive_wrapper_fwd.hpp:
 
-/usr/local/include/ur_rtde/rtde_utility.h:
+/usr/include/eigen3/Eigen/Eigenvalues:
 
-/usr/include/boost/fusion/view/iterator_range/detail/segmented_iterator_range.hpp:
+/usr/include/boost/variant/static_visitor.hpp:
 
-/usr/include/boost/detail/workaround.hpp:
+/usr/include/c++/11/set:
 
-/usr/include/boost/fusion/view/iterator_range/detail/segments_impl.hpp:
+/usr/include/x86_64-linux-gnu/bits/statx.h:
 
-/usr/include/x86_64-linux-gnu/bits/sigstksz.h:
+/usr/include/boost/variant/variant.hpp:
 
-/usr/include/boost/fusion/view/iterator_range/detail/size_impl.hpp:
+/usr/include/c++/11/algorithm:
 
-/usr/include/linux/stddef.h:
+/usr/include/c++/11/backward/binders.h:
 
-/usr/include/boost/asio/associated_executor.hpp:
+/usr/include/c++/11/bit:
 
-/usr/include/boost/fusion/view/iterator_range/detail/value_at_impl.hpp:
+/usr/include/c++/11/bits/align.h:
 
-/usr/include/boost/iterator/detail/enable_if.hpp:
+/usr/include/boost/asio/detail/reactive_socket_service.hpp:
 
-/usr/include/boost/fusion/view/joint_view/detail/begin_impl.hpp:
+/usr/include/c++/11/bits/alloc_traits.h:
 
-/usr/lib/gcc/x86_64-linux-gnu/11/include/emmintrin.h:
+/usr/include/c++/11/bits/allocated_ptr.h:
 
-/usr/include/boost/fusion/container/vector/detail/deref_impl.hpp:
+/usr/include/c++/11/bits/allocator.h:
 
-/usr/include/boost/fusion/view/joint_view/detail/end_impl.hpp:
+/usr/include/c++/11/ext/alloc_traits.h:
 
-/usr/include/boost/mpl/plus.hpp:
+/usr/include/c++/11/bits/atomic_lockfree_defines.h:
 
-/usr/include/boost/fusion/view/joint_view/detail/next_impl.hpp:
+/usr/include/c++/11/bits/codecvt.h:
 
-/usr/include/boost/asio/execution/invocable_archetype.hpp:
+/usr/include/c++/11/bits/std_function.h:
 
-/usr/include/boost/fusion/view/joint_view/joint_view_iterator.hpp:
+/usr/include/c++/11/bits/cxxabi_forced.h:
 
-/usr/include/boost/fusion/view/single_view/detail/at_impl.hpp:
+/usr/include/c++/11/bits/cxxabi_init_exception.h:
 
-/usr/include/boost/range/reverse_iterator.hpp:
+/usr/include/boost/fusion/mpl/pop_back.hpp:
 
-/usr/include/boost/fusion/view/single_view/detail/begin_impl.hpp:
+/usr/include/boost/mpl/vector/vector0.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorMorphing.h:
+/usr/include/c++/11/bits/exception_ptr.h:
 
-/usr/include/boost/fusion/view/single_view/detail/deref_impl.hpp:
+/usr/include/c++/11/bits/hash_bytes.h:
 
-/usr/include/boost/fusion/view/single_view/detail/distance_impl.hpp:
+/usr/include/boost/fusion/adapted/mpl/detail/begin_impl.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/se3-tpl.hpp:
+/usr/include/c++/11/bits/hashtable.h:
 
-/usr/include/boost/fusion/view/single_view/detail/end_impl.hpp:
+/usr/include/boost/asio/detail/noncopyable.hpp:
 
-/usr/include/boost/preprocessor/tuple/detail/is_single_return.hpp:
+/usr/include/c++/11/bits/invoke.h:
 
-/usr/include/boost/fusion/view/single_view/detail/next_impl.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/TriangularMatrixMatrix.h:
 
-/usr/include/boost/fusion/view/single_view/detail/value_at_impl.hpp:
+/usr/include/c++/11/bits/ios_base.h:
 
-/usr/include/boost/range/detail/sfinae.hpp:
+/usr/include/c++/11/bits/stl_multimap.h:
 
-/usr/include/boost/fusion/view/single_view/single_view.hpp:
+/usr/include/c++/11/bits/locale_classes.tcc:
 
-/usr/include/boost/mpl/aux_/config/has_apply.hpp:
+/usr/include/boost/variant/detail/visitation_impl.hpp:
 
-/usr/include/boost/fusion/view/single_view/single_view_iterator.hpp:
+/usr/include/c++/11/bits/locale_facets.h:
 
-/usr/include/boost/mpl/insert_fwd.hpp:
+/usr/include/boost/archive/detail/oserializer.hpp:
 
-/usr/include/eigen3/Eigen/src/Geometry/OrthoMethods.h:
+/usr/include/eigen3/Eigen/src/Core/arch/Default/BFloat16.h:
 
-/usr/include/boost/preprocessor/repeat.hpp:
+/usr/include/c++/11/bits/locale_facets.tcc:
 
-/usr/include/boost/date_time/date_clock_device.hpp:
+/usr/include/boost/smart_ptr/detail/sp_noexcept.hpp:
 
-/usr/include/boost/get_pointer.hpp:
+/usr/include/c++/11/bits/localefwd.h:
 
-/usr/include/boost/mpl/vector/aux_/push_front.hpp:
+/opt/openrobots/include/hpp/fcl/BVH/BVH_internal.h:
 
-/usr/include/boost/integer/static_min_max.hpp:
+/usr/include/c++/11/bits/move.h:
 
-/usr/include/boost/io/ios_state.hpp:
+/usr/include/boost/type_traits/detail/has_postfix_operator.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/strings_fortified.h:
+/usr/include/c++/11/bits/nested_exception.h:
 
-/usr/include/boost/variant/detail/backup_holder.hpp:
+/usr/include/eigen3/Eigen/Dense:
 
-/usr/include/boost/mpl/aux_/common_name_wknd.hpp:
+/usr/include/boost/fusion/iterator/advance.hpp:
 
-/usr/include/boost/iostreams/categories.hpp:
+/usr/include/boost/preprocessor/comparison/not_equal.hpp:
 
-/usr/include/boost/iostreams/checked_operations.hpp:
+/usr/include/c++/11/bits/ptr_traits.h:
 
-/usr/include/boost/preprocessor/repetition/detail/for.hpp:
+/usr/include/c++/11/bits/quoted_string.h:
 
-/usr/include/boost/iostreams/detail/adapter/concept_adapter.hpp:
+/usr/include/limits.h:
 
-/usr/include/boost/iostreams/detail/adapter/mode_adapter.hpp:
+/usr/include/c++/11/bits/random.h:
 
-/usr/include/eigen3/Eigen/src/Core/functors/TernaryFunctors.h:
+/usr/include/boost/fusion/view/reverse_view/detail/end_impl.hpp:
 
-/usr/include/boost/date_time/date_generators.hpp:
+/usr/include/c++/11/bits/ranges_base.h:
 
-/usr/include/boost/iostreams/detail/adapter/output_iterator_adapter.hpp:
+/usr/include/c++/11/bits/refwrap.h:
 
-/usr/include/boost/type_traits/is_float.hpp:
+/usr/include/eigen3/Eigen/src/Core/ReturnByValue.h:
 
-/usr/include/boost/asio/ip/impl/basic_endpoint.hpp:
+/usr/include/c++/11/bits/shared_ptr.h:
 
-/usr/include/boost/date_time/c_time.hpp:
+/usr/include/boost/asio/detail/event.hpp:
 
-/usr/include/boost/iostreams/detail/adapter/range_adapter.hpp:
+/usr/include/c++/11/bits/shared_ptr_atomic.h:
 
-/usr/include/boost/assert.hpp:
+/usr/include/boost/archive/basic_binary_iprimitive.hpp:
 
-/usr/include/boost/iostreams/detail/call_traits.hpp:
+/usr/include/c++/11/bits/shared_ptr_base.h:
 
-/usr/include/c++/11/bits/basic_ios.h:
+/usr/include/boost/next_prior.hpp:
 
-/usr/include/boost/iostreams/detail/char_traits.hpp:
+/usr/include/c++/11/cstdio:
 
-/usr/include/boost/iostreams/stream_buffer.hpp:
+/usr/include/features.h:
 
-/usr/include/boost/iostreams/detail/config/codecvt.hpp:
+/usr/include/c++/11/bits/std_abs.h:
 
-/usr/include/c++/11/cassert:
+/usr/include/c++/11/bits/std_thread.h:
 
-/usr/include/boost/iostreams/detail/config/disable_warnings.hpp:
+/usr/include/c++/11/bits/stl_algo.h:
 
-/usr/include/boost/iostreams/detail/config/enable_warnings.hpp:
+/usr/include/eigen3/Eigen/Core:
 
-/usr/include/boost/asio/is_executor.hpp:
+/usr/include/c++/11/bits/stl_algobase.h:
 
-/usr/include/boost/asio/ip/detail/endpoint.hpp:
+/usr/include/c++/11/bits/stl_bvector.h:
 
-/usr/include/boost/mpl/aux_/has_begin.hpp:
+/usr/include/c++/11/bits/stl_construct.h:
 
-/usr/include/boost/iostreams/detail/config/fpos.hpp:
+/usr/include/x86_64-linux-gnu/c++/11/bits/cxxabi_tweaks.h:
 
-/usr/include/eigen3/Eigen/src/Core/arch/Default/GenericPacketMathFunctionsFwd.h:
+/usr/include/eigen3/Eigen/src/Core/util/IntegralConstant.h:
 
-/usr/include/boost/type_traits/enable_if.hpp:
+/usr/include/boost/type_traits/is_function.hpp:
 
-/usr/include/boost/iostreams/detail/config/gcc.hpp:
+/usr/include/c++/11/bits/stl_function.h:
 
-/usr/include/boost/smart_ptr/detail/spinlock_pool.hpp:
+/usr/include/c++/11/bits/stl_list.h:
 
-/usr/include/boost/function_types/config/config.hpp:
+/usr/include/boost/variant/detail/initializer.hpp:
 
-/usr/include/boost/mpl/limits/unrolling.hpp:
+/usr/include/c++/11/bits/stl_map.h:
 
-/usr/include/boost/asio/traits/start_free.hpp:
+/usr/include/c++/11/bits/stl_multiset.h:
 
-/usr/include/boost/asio/ip/tcp.hpp:
+/usr/include/c++/11/bits/stl_raw_storage_iter.h:
 
-/usr/include/boost/iostreams/detail/config/overload_resolution.hpp:
+/usr/include/eigen3/Eigen/src/plugins/CommonCwiseUnaryOps.h:
 
-/usr/include/c++/11/bits/std_mutex.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorGenerator.h:
 
-/usr/include/boost/variant/detail/apply_visitor_delayed.hpp:
+/usr/include/boost/asio/ip/impl/address.ipp:
 
-/usr/include/boost/preprocessor/variadic/size.hpp:
+/usr/include/c++/11/bits/stl_uninitialized.h:
 
-/usr/include/boost/iostreams/detail/config/unreachable_return.hpp:
+/usr/include/boost/serialization/collections_load_imp.hpp:
 
-/usr/include/boost/mpl/aux_/config/lambda.hpp:
+/usr/include/eigen3/Eigen/src/Core/functors/UnaryFunctors.h:
 
-/usr/include/boost/iostreams/detail/config/wide_streams.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/Umeyama.h:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/gthr.h:
+/usr/include/boost/date_time/time_resolution_traits.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/ArrayBase.h:
+/usr/include/c++/11/bits/stl_vector.h:
 
-/usr/include/boost/mpl/not_equal_to.hpp:
+/usr/include/boost/fusion/view/zip_view/zip_view_iterator.hpp:
 
-/usr/include/boost/iostreams/detail/default_arg.hpp:
+/usr/include/c++/11/bits/streambuf.tcc:
 
-/usr/include/boost/iostreams/detail/double_object.hpp:
+/usr/include/c++/11/bits/streambuf_iterator.h:
 
-/usr/include/boost/asio/streambuf.hpp:
+/usr/include/c++/11/bits/stringfwd.h:
 
-/usr/include/boost/iostreams/write.hpp:
+/usr/include/c++/11/bits/uniform_int_dist.h:
 
-/usr/include/boost/iostreams/detail/error.hpp:
+/usr/include/c++/11/bits/uses_allocator.h:
 
-/usr/include/boost/iostreams/detail/execute.hpp:
+/usr/include/c++/11/cerrno:
 
-/usr/include/c++/11/bits/concept_check.h:
+/usr/include/c++/11/cinttypes:
 
-/usr/include/boost/iostreams/detail/functional.hpp:
+/usr/include/boost/variant/recursive_wrapper.hpp:
 
-/opt/openrobots/include/pinocchio/spatial/fwd.hpp:
+/usr/include/c++/11/climits:
 
-/usr/include/boost/iostreams/detail/iostream.hpp:
+/usr/include/c++/11/cstdarg:
 
-/usr/include/c++/11/bits/locale_classes.h:
+/usr/include/c++/11/cwchar:
 
-/opt/openrobots/include/pinocchio/utils/helpers.hpp:
+/usr/include/c++/11/initializer_list:
 
-/usr/include/boost/iostreams/detail/is_dereferenceable.hpp:
+/usr/include/c++/11/cxxabi.h:
 
-/usr/include/boost/iterator/interoperable.hpp:
+/usr/include/c++/11/debug/assertions.h:
 
-/usr/include/boost/asio/detail/impl/timer_queue_set.ipp:
+/usr/include/c++/11/debug/debug.h:
 
-/usr/include/boost/iostreams/detail/push.hpp:
+/usr/include/c++/11/experimental/bits/string_view.tcc:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-mimic.hpp:
+/usr/include/c++/11/experimental/string_view:
 
-/usr/include/boost/asio/detail/array_fwd.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorArgMax.h:
 
-/usr/include/boost/fusion/iterator/segmented_iterator.hpp:
+/usr/include/c++/11/ext/aligned_buffer.h:
 
-/usr/include/boost/mpl/list/aux_/pop_front.hpp:
+/usr/include/boost/mpl/pop_back.hpp:
 
-/usr/include/boost/iostreams/detail/push_params.hpp:
+/usr/include/c++/11/ext/new_allocator.h:
 
-/usr/include/boost/mpl/aux_/na_spec.hpp:
+/usr/include/c++/11/ext/numeric_traits.h:
 
-/usr/include/x86_64-linux-gnu/bits/mathcalls-narrow.h:
+/usr/include/c++/11/ext/string_conversions.h:
 
-/usr/include/boost/numeric/conversion/cast.hpp:
+/usr/include/eigen3/Eigen/src/Core/BandMatrix.h:
 
-/usr/include/boost/iostreams/detail/resolve.hpp:
+/usr/include/linux/close_range.h:
 
-/usr/include/asm-generic/posix_types.h:
+/usr/include/c++/11/ext/type_traits.h:
 
-/usr/include/boost/iterator/iterator_adaptor.hpp:
+/usr/include/eigen3/Eigen/src/SVD/UpperBidiagonalization.h:
 
-/usr/include/boost/asio/detail/is_executor.hpp:
+/usr/include/boost/iostreams/detail/execute.hpp:
 
-/usr/include/boost/iostreams/detail/select_by_size.hpp:
+/usr/include/c++/11/iomanip:
 
-/usr/include/boost/mpl/aux_/is_msvc_eti_arg.hpp:
+/usr/include/c++/11/istream:
 
-/usr/include/boost/iostreams/detail/streambuf/linked_streambuf.hpp:
+/usr/include/c++/11/iterator:
 
-/usr/include/boost/iostreams/device/array.hpp:
+/usr/include/boost/io/ios_state.hpp:
 
-/usr/include/boost/type_traits/add_lvalue_reference.hpp:
+/usr/include/c++/11/list:
 
-/usr/include/boost/iostreams/device/null.hpp:
+/usr/include/x86_64-linux-gnu/sys/select.h:
 
-/usr/include/boost/iostreams/put.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsPacketMath.h:
 
-/usr/include/boost/preprocessor/seq/rest_n.hpp:
+/usr/include/c++/11/map:
 
-/usr/include/boost/iostreams/get.hpp:
+/usr/include/boost/fusion/mpl/pop_front.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-model-base.hpp:
+/usr/include/c++/11/math.h:
 
-/usr/include/boost/fusion/container/list/detail/at_impl.hpp:
+/usr/include/c++/11/mutex:
 
-/usr/include/boost/mpl/insert_range.hpp:
+/usr/include/boost/lexical_cast/detail/converter_numeric.hpp:
 
-/usr/include/boost/config/detail/select_stdlib_config.hpp:
+/usr/include/c++/11/numeric:
 
-/usr/include/boost/iostreams/input_sequence.hpp:
+/usr/include/c++/11/ratio:
 
-/usr/include/boost/type_traits/common_type.hpp:
+/usr/include/c++/11/sstream:
 
-/usr/include/boost/ref.hpp:
+/usr/include/c++/11/system_error:
 
-/usr/include/boost/preprocessor/comparison/greater.hpp:
+/usr/include/c++/11/thread:
 
-/usr/include/boost/iostreams/pipeline.hpp:
+/usr/include/x86_64-linux-gnu/bits/wordsize.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/sigevent_t.h:
+/usr/include/c++/11/tuple:
 
-/usr/include/boost/iostreams/seek.hpp:
+/usr/include/eigen3/Eigen/Geometry:
 
-/usr/include/boost/mpl/placeholders.hpp:
+/usr/include/eigen3/Eigen/Householder:
 
-/usr/include/boost/iterator/detail/config_undef.hpp:
+/usr/include/boost/mpl/aux_/arithmetic_op.hpp:
 
-/usr/include/boost/mpl/begin.hpp:
+/usr/include/eigen3/Eigen/Jacobi:
 
-/usr/include/boost/iterator/iterator_categories.hpp:
+/usr/include/eigen3/Eigen/src/Core/Diagonal.h:
 
-/usr/include/boost/iostreams/detail/optional.hpp:
+/usr/include/boost/type_traits/has_plus_assign.hpp:
 
-/usr/include/boost/lexical_cast/bad_lexical_cast.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorExpr.h:
 
-/usr/include/boost/variant/detail/initializer.hpp:
+/usr/include/eigen3/Eigen/QR:
 
-/usr/include/boost/mpl/aux_/config/typeof.hpp:
+/usr/include/boost/fusion/view/transform_view/transform_view_iterator.hpp:
 
-/usr/include/boost/is_placeholder.hpp:
+/usr/include/eigen3/Eigen/StdVector:
 
-/usr/include/boost/lexical_cast/detail/converter_numeric.hpp:
+/usr/include/eigen3/Eigen/src/Cholesky/LLT.h:
 
-/usr/include/boost/lexical_cast/detail/lcast_unsigned_converters.hpp:
+/usr/include/boost/fusion/mpl/front.hpp:
 
-/usr/include/boost/lexical_cast/try_lexical_convert.hpp:
+/usr/include/eigen3/Eigen/src/Core/ArithmeticSequence.h:
 
-/usr/include/boost/limits.hpp:
+/usr/include/boost/mpl/advance_fwd.hpp:
 
-/usr/include/c++/11/bits/basic_ios.tcc:
+/usr/include/eigen3/Eigen/src/Core/ArrayWrapper.h:
 
-/usr/include/boost/math/constants/constants.hpp:
+/usr/include/eigen3/Eigen/src/Core/Assign.h:
 
-/usr/include/boost/smart_ptr/make_shared_array.hpp:
+/usr/include/eigen3/Eigen/src/Core/CommaInitializer.h:
 
-/usr/include/boost/math/policies/policy.hpp:
+/usr/include/eigen3/Eigen/src/Core/ConditionEstimator.h:
 
-/usr/include/boost/math/tools/user.hpp:
+/usr/include/boost/fusion/sequence/intrinsic/detail/segmented_end.hpp:
 
-/usr/include/boost/mpl/advance_fwd.hpp:
+/usr/include/eigen3/Eigen/src/Core/CoreIterators.h:
 
-/usr/include/boost/math/special_functions/math_fwd.hpp:
+/usr/include/eigen3/Eigen/src/Core/CwiseNullaryOp.h:
 
-/usr/include/boost/mpl/aux_/preprocessor/range.hpp:
+/usr/include/eigen3/Eigen/src/Core/CwiseTernaryOp.h:
 
-/usr/include/boost/math/tools/config.hpp:
+/usr/include/eigen3/Eigen/src/Core/DenseBase.h:
 
-/usr/include/boost/type_traits/is_assignable.hpp:
+/usr/include/boost/fusion/view/zip_view/detail/at_impl.hpp:
 
-/usr/include/boost/math/tools/convert_from_string.hpp:
+/usr/include/boost/range/mutable_iterator.hpp:
 
-/usr/include/boost/math/tools/cxx03_warn.hpp:
+/usr/include/eigen3/Eigen/src/Core/DenseCoeffsBase.h:
 
-/usr/include/asm-generic/ioctl.h:
+/usr/include/eigen3/Eigen/src/Core/DiagonalMatrix.h:
 
-/usr/include/boost/mpl/clear.hpp:
+/usr/include/boost/fusion/algorithm/query/none.hpp:
 
-/usr/include/boost/asio/detail/tss_ptr.hpp:
+/usr/include/boost/type_traits/is_member_object_pointer.hpp:
 
-/usr/include/boost/math/tools/precision.hpp:
+/usr/include/eigen3/Eigen/src/Core/Fuzzy.h:
 
-/usr/include/boost/mpl/bool_fwd.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/Meta.h:
 
-/usr/include/x86_64-linux-gnu/sys/ucontext.h:
+/usr/include/eigen3/Eigen/src/Core/GlobalFunctions.h:
 
-/usr/include/boost/serialization/access.hpp:
+/usr/include/eigen3/Eigen/src/Core/IndexedView.h:
 
-/usr/include/boost/mpl/has_xxx.hpp:
+/usr/include/eigen3/Eigen/src/Core/Inverse.h:
 
-/usr/include/c++/11/version:
+/usr/include/eigen3/Eigen/src/Core/MathFunctions.h:
 
-/usr/include/boost/math/tools/promotion.hpp:
+/usr/include/c++/11/bits/stl_tempbuf.h:
 
-/usr/include/x86_64-linux-gnu/c++/11/bits/c++io.h:
+/usr/include/eigen3/Eigen/src/Core/MathFunctionsImpl.h:
 
-/usr/include/boost/move/core.hpp:
+/usr/include/boost/fusion/algorithm/query/detail/segmented_find.hpp:
 
-/usr/include/x86_64-linux-gnu/sys/types.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContractionBlocking.h:
 
-/usr/include/boost/mpl/aux_/config/gpu.hpp:
+/usr/include/boost/fusion/view/single_view/single_view.hpp:
 
-/usr/include/boost/smart_ptr/detail/local_counted_base.hpp:
+/usr/include/boost/move/detail/std_ns_begin.hpp:
 
-/usr/include/boost/archive/detail/abi_suffix.hpp:
+/usr/include/eigen3/Eigen/src/Core/PlainObjectBase.h:
 
-/usr/include/boost/move/detail/meta_utils.hpp:
+/usr/include/eigen3/Eigen/src/Core/ProductEvaluators.h:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-revolute-unaligned.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorReverse.h:
 
-/usr/include/boost/mpl/arg_fwd.hpp:
+/usr/include/eigen3/Eigen/src/Core/Ref.h:
 
-/usr/include/boost/asio/detail/recycling_allocator.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/EulerAngles.h:
 
-/usr/include/boost/date_time/gregorian/greg_day.hpp:
+/usr/include/eigen3/Eigen/src/Core/Replicate.h:
 
-/usr/include/boost/move/detail/type_traits.hpp:
+/usr/include/eigen3/Eigen/src/Core/Reshaped.h:
 
-/usr/include/boost/move/detail/workaround.hpp:
+/usr/include/eigen3/Eigen/src/Core/Select.h:
 
-/usr/include/boost/move/traits.hpp:
+/usr/include/boost/mpl/aux_/fold_impl.hpp:
 
-/usr/include/boost/move/utility.hpp:
+/usr/include/eigen3/Eigen/src/LU/FullPivLU.h:
 
-/usr/include/boost/asio/async_result.hpp:
+/usr/include/eigen3/Eigen/src/Core/SolveTriangular.h:
 
-/usr/include/boost/move/utility_core.hpp:
+/usr/include/eigen3/Eigen/src/Core/StableNorm.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/error_t.h:
+/usr/include/boost/serialization/tracking.hpp:
 
-/usr/include/x86_64-linux-gnu/bits/types/clockid_t.h:
+/usr/include/eigen3/Eigen/src/Core/StlIterators.h:
 
-/usr/include/boost/predef/library/c/gnu.h:
+/usr/include/eigen3/Eigen/src/Core/Stride.h:
 
-/usr/include/boost/mpl/and.hpp:
+/usr/include/boost/fusion/view/joint_view.hpp:
 
-/usr/include/boost/iostreams/detail/streambuf.hpp:
+/usr/include/eigen3/Eigen/src/Core/Transpositions.h:
 
-/usr/include/boost/mpl/apply_wrap.hpp:
+/usr/include/eigen3/Eigen/src/Core/TriangularMatrix.h:
 
-/usr/include/boost/type_traits/is_constructible.hpp:
+/usr/include/eigen3/Eigen/src/Core/VectorBlock.h:
 
-/usr/include/boost/mpl/assert.hpp:
+/usr/include/eigen3/Eigen/src/Core/VectorwiseOp.h:
 
-/usr/include/boost/mpl/at.hpp:
+/usr/include/boost/asio/detail/work_dispatcher.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/Tensor.h:
+/usr/include/eigen3/Eigen/src/Core/arch/Default/GenericPacketMathFunctions.h:
 
-/usr/include/boost/type_index/type_index_facade.hpp:
+/usr/include/eigen3/Eigen/src/Core/arch/SSE/MathFunctions.h:
 
-/usr/include/boost/mpl/aux_/config/forwarding.hpp:
+/usr/include/eigen3/Eigen/src/Core/arch/SSE/PacketMath.h:
 
-/usr/include/boost/mpl/aux_/O1_size_impl.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorStorage.h:
 
-/usr/include/boost/fusion/mpl/end.hpp:
+/usr/include/eigen3/Eigen/src/Core/functors/StlFunctors.h:
 
-/usr/include/boost/mpl/aux_/adl_barrier.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/Memory.h:
 
-/usr/include/boost/date_time/period.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/GeneralBlockPanelKernel.h:
 
-/usr/include/boost/mpl/aux_/arg_typedef.hpp:
+/usr/include/c++/11/cstdlib:
 
-/usr/include/boost/mpl/joint_view.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/SelfadjointMatrixMatrix.h:
 
-/usr/include/boost/fusion/view/joint_view/detail/deref_data_impl.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/SelfadjointRank2Update.h:
 
-/usr/include/boost/mpl/aux_/arity.hpp:
+/usr/include/boost/type_traits/has_unary_minus.hpp:
 
-/usr/include/boost/mpl/aux_/arity_spec.hpp:
+/usr/include/x86_64-linux-gnu/bits/libm-simd-decl-stubs.h:
 
-/usr/include/boost/container/container_fwd.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/Constants.h:
 
-/usr/include/boost/mpl/aux_/at_impl.hpp:
+/usr/include/boost/math/tools/config.hpp:
 
-/usr/include/boost/mpl/aux_/config/adl.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/Homogeneous.h:
 
-/usr/include/boost/mpl/list/aux_/empty.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/MKL_support.h:
 
-/usr/include/boost/mpl/aux_/config/bcc.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/StaticAssert.h:
 
-/usr/include/boost/mpl/aux_/config/bind.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/SymbolicIndex.h:
 
-/usr/include/boost/mpl/aux_/has_tag.hpp:
+/usr/include/boost/fusion/view/transform_view/detail/advance_impl.hpp:
 
-/usr/include/boost/utility.hpp:
+/usr/include/eigen3/Eigen/src/Core/util/XprHelper.h:
 
-/usr/include/boost/mpl/aux_/config/ctps.hpp:
+/usr/include/boost/mpl/aux_/config/bcc.hpp:
 
-/usr/include/c++/11/bits/memoryfwd.h:
+/usr/include/eigen3/Eigen/src/Eigenvalues/ComplexEigenSolver.h:
 
-/usr/include/boost/variant/get.hpp:
+/usr/include/eigen3/Eigen/src/Eigenvalues/GeneralizedEigenSolver.h:
 
-/usr/include/boost/mpl/aux_/config/dtp.hpp:
+/usr/include/eigen3/Eigen/src/Eigenvalues/MatrixBaseEigenvalues.h:
 
-/usr/include/boost/preprocessor/tuple/elem.hpp:
+/usr/include/eigen3/Eigen/src/Eigenvalues/RealQZ.h:
 
-/usr/include/boost/mpl/aux_/config/eti.hpp:
+/usr/include/eigen3/Eigen/src/Eigenvalues/RealSchur.h:
 
-/usr/include/boost/serialization/assume_abstract.hpp:
+/usr/include/eigen3/Eigen/src/Eigenvalues/SelfAdjointEigenSolver.h:
 
-/usr/include/boost/mpl/aux_/config/gcc.hpp:
+/usr/include/eigen3/Eigen/src/Eigenvalues/Tridiagonalization.h:
 
-/usr/include/boost/throw_exception.hpp:
+/usr/include/boost/asio/basic_socket_iostream.hpp:
 
-/usr/include/boost/mpl/aux_/config/has_xxx.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/AlignedBox.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/struct_sched_param.h:
+/usr/include/boost/mpl/aux_/config/lambda.hpp:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorConversion.h:
+/usr/include/boost/mpl/aux_/has_tag.hpp:
 
-/usr/include/boost/mpl/aux_/config/msvc.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/AngleAxis.h:
 
-/usr/include/x86_64-linux-gnu/bits/mathcalls.h:
+/usr/include/eigen3/Eigen/src/Geometry/Rotation2D.h:
 
-/usr/include/boost/mpl/aux_/preprocessor/enum.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/RotationBase.h:
 
-/usr/include/boost/mpl/aux_/config/msvc_typename.hpp:
+/opt/openrobots/include/pinocchio/multibody/geometry.hxx:
 
-/opt/openrobots/include/pinocchio/container/aligned-vector.hpp:
+/usr/include/boost/fusion/view/joint_view/detail/value_of_impl.hpp:
 
-/usr/include/boost/mpl/aux_/config/nttp.hpp:
+/usr/include/eigen3/Eigen/src/Geometry/Transform.h:
 
-/usr/include/eigen3/Eigen/src/Core/Solve.h:
+/usr/include/eigen3/Eigen/src/Geometry/arch/Geometry_SIMD.h:
 
-/usr/include/boost/mpl/aux_/config/ttp.hpp:
+/usr/include/eigen3/Eigen/src/Householder/BlockHouseholder.h:
 
-/usr/include/boost/serialization/item_version_type.hpp:
+/usr/include/eigen3/Eigen/src/Householder/HouseholderSequence.h:
 
-/usr/include/boost/mpl/contains_fwd.hpp:
+/usr/include/eigen3/Eigen/src/Jacobi/Jacobi.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/util/EmulateArray.h:
+/usr/include/boost/date_time/gregorian/greg_duration_types.hpp:
 
-/usr/include/boost/mpl/aux_/config/workaround.hpp:
+/usr/include/eigen3/Eigen/src/LU/Determinant.h:
 
-/usr/include/eigen3/Eigen/src/Core/DiagonalProduct.h:
+/usr/include/eigen3/Eigen/src/LU/InverseImpl.h:
 
-/usr/include/boost/mpl/aux_/contains_impl.hpp:
+/usr/include/boost/variant/detail/move.hpp:
 
-/usr/include/eigen3/Eigen/src/Core/functors/BinaryFunctors.h:
+/usr/include/eigen3/Eigen/src/LU/PartialPivLU.h:
 
-/usr/include/boost/preprocessor/repetition/enum_shifted_params.hpp:
+/usr/include/eigen3/Eigen/src/QR/CompleteOrthogonalDecomposition.h:
 
-/usr/include/boost/math/special_functions/detail/round_fwd.hpp:
+/usr/include/boost/predef/library/c/gnu.h:
 
-/usr/include/boost/mpl/aux_/find_if_pred.hpp:
+/usr/include/eigen3/Eigen/src/QR/FullPivHouseholderQR.h:
 
-/usr/include/x86_64-linux-gnu/bits/signal_ext.h:
+/usr/include/eigen3/Eigen/src/Geometry/OrthoMethods.h:
 
-/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorShuffling.h:
+/usr/include/ctype.h:
 
-/usr/include/boost/type_traits/has_right_shift_assign.hpp:
+/usr/include/eigen3/Eigen/src/SVD/BDCSVD.h:
 
-/usr/include/boost/mpl/aux_/fold_impl.hpp:
+/usr/include/boost/mpl/void_fwd.hpp:
 
-/usr/include/boost/asio/detail/thread_info_base.hpp:
+/usr/include/boost/mpl/bind_fwd.hpp:
 
-/usr/include/boost/mpl/aux_/front_impl.hpp:
+/usr/include/eigen3/Eigen/src/SVD/JacobiSVD.h:
 
-/usr/include/boost/mpl/aux_/has_size.hpp:
+/usr/include/eigen3/Eigen/src/StlSupport/StdVector.h:
 
-/usr/include/boost/date_time/locale_config.hpp:
+/usr/include/boost/core/noncopyable.hpp:
 
-/usr/include/boost/functional/hash_fwd.hpp:
+/usr/include/boost/asio/execution/set_error.hpp:
 
-/usr/include/boost/fusion/iterator/detail/segment_sequence.hpp:
+/usr/include/eigen3/Eigen/src/plugins/ArrayCwiseBinaryOps.h:
 
-/usr/include/boost/mpl/aux_/has_type.hpp:
+/usr/include/boost/fusion/algorithm/iteration/iter_fold_fwd.hpp:
 
-/usr/include/boost/fusion/support/detail/enabler.hpp:
+/usr/include/eigen3/Eigen/src/plugins/ArrayCwiseUnaryOps.h:
 
-/usr/include/boost/mpl/aux_/inserter_algorithm.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDimensionList.h:
 
-/usr/include/boost/mpl/aux_/integral_wrapper.hpp:
+/usr/include/linux/posix_types.h:
 
-/usr/include/boost/range/end.hpp:
+/usr/include/boost/fusion/view/single_view/detail/advance_impl.hpp:
 
-/usr/include/boost/mpl/aux_/iter_fold_if_impl.hpp:
+/usr/include/boost/type_traits/extent.hpp:
 
-/usr/include/boost/mpl/aux_/iter_push_front.hpp:
+/usr/include/eigen3/Eigen/src/plugins/CommonCwiseBinaryOps.h:
 
-/usr/include/boost/config/stdlib/libstdcpp3.hpp:
+/usr/include/eigen3/Eigen/src/plugins/IndexedViewMethods.h:
 
-/usr/include/boost/blank_fwd.hpp:
+/usr/include/eigen3/Eigen/src/plugins/MatrixCwiseBinaryOps.h:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-spherical.hpp:
+/usr/include/eigen3/Eigen/src/plugins/ReshapedMethods.h:
 
-/usr/include/boost/mpl/numeric_cast.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/Tensor:
 
-/usr/include/boost/mpl/aux_/lambda_arity_param.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorAssign.h:
 
-/usr/include/boost/mpl/aux_/largest_int.hpp:
+/usr/include/c++/11/bits/locale_facets_nonio.h:
 
-/usr/include/boost/fusion/container/list/detail/equal_to_impl.hpp:
+/usr/include/boost/type_traits/detail/bool_trait_undef.hpp:
 
-/usr/include/boost/mpl/aux_/logical_op.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorBlock.h:
 
-/usr/include/c++/11/iosfwd:
+/usr/include/eigen3/Eigen/src/misc/Kernel.h:
 
-/usr/include/boost/mpl/aux_/na_fwd.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorBroadcasting.h:
 
-/usr/include/boost/mpl/aux_/nested_type_wknd.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorContractionThreadPool.h:
 
-/usr/include/boost/asio/execution/bulk_execute.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorCostModel.h:
 
-/usr/include/boost/function_types/config/cc_names.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDevice.h:
 
-/usr/include/boost/mpl/aux_/numeric_cast_utils.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDeviceSycl.h:
 
-/usr/include/boost/mpl/aux_/preprocessor/def_params_tail.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDeviceThreadPool.h:
 
-/usr/include/boost/iterator/advance.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorDimensions.h:
 
-/usr/include/boost/mpl/aux_/preprocessor/ext_params.hpp:
+/usr/include/linux/ioctl.h:
 
-/usr/include/eigen3/Eigen/src/Core/CwiseUnaryOp.h:
+/usr/include/c++/11/array:
 
-/usr/include/boost/integer_fwd.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorEvaluator.h:
 
-/usr/include/boost/mpl/aux_/preprocessor/params.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorFFT.h:
 
-/usr/include/boost/mpl/aux_/preprocessor/partial_spec_params.hpp:
+/usr/include/boost/function_types/components.hpp:
 
-/usr/include/boost/numeric/conversion/converter.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorForwardDeclarations.h:
 
-/usr/include/boost/mpl/aux_/iter_fold_impl.hpp:
+/usr/include/boost/function_types/detail/components_impl/arity10_0.hpp:
 
-/usr/include/boost/mpl/aux_/preprocessor/sub.hpp:
+/usr/include/boost/asio/detail/memory.hpp:
 
-/usr/include/boost/iostreams/imbue.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorFunctors.h:
 
-/usr/include/boost/mpl/aux_/reverse_fold_impl.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorGlobalFunctions.h:
 
-/usr/include/boost/type_traits/intrinsics.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorIO.h:
 
-/usr/include/boost/mpl/aux_/sequence_wrapper.hpp:
+/usr/include/boost/config/detail/select_compiler_config.hpp:
 
-/usr/include/boost/mpl/aux_/static_cast.hpp:
+/usr/include/boost/mpl/aux_/insert_range_impl.hpp:
 
-/usr/include/boost/mpl/next_prior.hpp:
+/usr/include/stdlib.h:
 
-/usr/include/boost/mpl/aux_/template_arity.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorImagePatch.h:
 
-/usr/include/x86_64-linux-gnu/asm/socket.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorInitializer.h:
 
-/usr/include/boost/mpl/next.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorLayoutSwap.h:
 
-/usr/include/x86_64-linux-gnu/bits/uintn-identity.h:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorMeta.h:
 
-/usr/include/boost/archive/detail/basic_pointer_oserializer.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorPadding.h:
 
-/usr/include/boost/date_time/posix_time/time_period.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorRandom.h:
 
-/usr/include/boost/mpl/aux_/traits_lambda_spec.hpp:
+/usr/include/x86_64-linux-gnu/sys/un.h:
 
-/usr/include/boost/type_traits/has_bit_and.hpp:
+/opt/openrobots/include/pinocchio/multibody/joint/joint-spherical.hpp:
 
-/usr/include/boost/mpl/aux_/type_wrapper.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorReduction.h:
 
-/usr/include/boost/mpl/limits/arity.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorTraits.h:
 
-/usr/include/boost/mpl/begin_end.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorReductionGpu.h:
 
-/usr/include/boost/type_traits/is_default_constructible.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorRef.h:
 
-/usr/include/boost/mpl/bitxor.hpp:
+/usr/include/c++/11/bits/locale_classes.h:
 
-/usr/include/x86_64-linux-gnu/bits/stdio2.h:
+/usr/include/boost/variant/detail/config.hpp:
 
-/usr/include/boost/asio/detail/reactive_socket_sendto_op.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorScan.h:
 
-/usr/include/boost/mpl/clear_fwd.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/Tensor/TensorTrace.h:
 
-/usr/include/boost/config/compiler/gcc.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/util/CXX11Meta.h:
 
-/opt/openrobots/include/pinocchio/multibody/fcl.hpp:
+/usr/include/x86_64-linux-gnu/sys/poll.h:
 
-/usr/include/boost/mpl/comparison.hpp:
+/usr/include/boost/fusion/algorithm/query/find_fwd.hpp:
 
-/usr/include/boost/mpl/deref.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/util/CXX11Workarounds.h:
 
-/usr/include/boost/mpl/distance.hpp:
+/usr/include/eigen3/unsupported/Eigen/CXX11/src/util/MaxSizeVector.h:
 
-/usr/include/x86_64-linux-gnu/bits/fp-fast.h:
+/usr/include/boost/fusion/container/vector/detail/deref_impl.hpp:
 
-/usr/include/boost/mpl/equal.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsArrayAPI.h:
 
-/usr/include/boost/asio/ip/bad_address_cast.hpp:
+/usr/include/boost/asio/ip/basic_resolver_iterator.hpp:
 
-/usr/include/boost/mpl/eval_if.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/BesselFunctionsFunctors.h:
 
-/usr/include/boost/preprocessor/facilities/empty.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsBFloat16.h:
 
-/usr/include/boost/core/swap.hpp:
+/usr/include/x86_64-linux-gnu/bits/floatn-common.h:
 
-/usr/include/boost/mpl/find_if.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsFunctors.h:
 
-/usr/include/boost/type_traits/has_trivial_constructor.hpp:
+/usr/include/eigen3/Eigen/src/Core/functors/BinaryFunctors.h:
 
-/usr/include/boost/fusion/container/vector/detail/end_impl.hpp:
+/usr/include/boost/fusion/iterator/deref.hpp:
 
-/usr/include/boost/mpl/fold.hpp:
+/usr/include/eigen3/unsupported/Eigen/src/SpecialFunctions/SpecialFunctionsHalf.h:
 
-/usr/include/eigen3/Eigen/src/Core/Array.h:
+/usr/include/boost/fusion/algorithm/iteration/reverse_iter_fold_fwd.hpp:
 
-/opt/openrobots/include/pinocchio/multibody/joint/joint-data-base.hpp:
+/usr/include/fcntl.h:
 
-/opt/openrobots/include/pinocchio/math/fwd.hpp:
+/usr/include/x86_64-linux-gnu/bits/epoll.h:
 
-/usr/include/boost/mpl/front.hpp:
+/usr/include/boost/predef/os/macos.h:
 
-/usr/include/boost/mpl/front_fwd.hpp:
+/usr/include/boost/fusion/container/generation/make_vector.hpp:
 
-/usr/include/boost/mpl/greater_equal.hpp:
+/usr/include/features-time64.h:
 
-/usr/include/boost/mpl/identity.hpp:
+/usr/include/libintl.h:
 
-/usr/include/boost/mpl/if.hpp:
+/usr/include/boost/mpl/aux_/iter_apply.hpp:
 
-/usr/include/boost/mpl/aux_/msvc_never_true.hpp:
+/usr/include/linux/falloc.h:
 
-/usr/include/boost/asio/detail/io_object_impl.hpp:
+/usr/include/linux/limits.h:
 
-/usr/include/boost/mpl/list/aux_/numbered.hpp:
+/usr/include/linux/version.h:
 
-/opt/openrobots/include/hpp/fcl/BVH/BVH_internal.h:
+/usr/include/boost/preprocessor/list/detail/fold_left.hpp:
 
-/usr/include/boost/mpl/insert_range_fwd.hpp:
+/usr/include/math.h:
 
-/opt/openrobots/include/pinocchio/spatial/motion-dense.hpp:
+/usr/include/netdb.h:
 
-/usr/include/boost/asio/detail/date_time_fwd.hpp:
+/usr/include/netinet/in.h:
 
-/usr/include/boost/mpl/int.hpp:
+/usr/include/pthread.h:
 
-/usr/include/eigen3/Eigen/src/Core/GenericPacketMath.h:
+/usr/include/sched.h:
 
-/usr/include/boost/type_traits/copy_cv.hpp:
+/usr/include/boost/fusion/mpl/insert.hpp:
 
-/usr/include/boost/mpl/iterator_category.hpp:
+/usr/include/stdc-predef.h:
 
-/usr/include/x86_64-linux-gnu/bits/types.h:
+/usr/include/strings.h:
 
-/usr/include/c++/11/bits/range_access.h:
+/usr/include/x86_64-linux-gnu/asm/bitsperlong.h:
 
-/usr/include/boost/mpl/protect.hpp:
+/usr/include/x86_64-linux-gnu/asm/errno.h:
 
-/usr/include/boost/mpl/iterator_range.hpp:
+/usr/include/x86_64-linux-gnu/asm/ioctl.h:
 
-/usr/include/eigen3/Eigen/src/misc/RealSvd2x2.h:
+/usr/include/x86_64-linux-gnu/asm/ioctls.h:
 
-/usr/include/c++/11/functional:
+/usr/include/x86_64-linux-gnu/asm/posix_types_64.h:
 
-/usr/include/boost/mpl/lambda.hpp:
+/usr/include/boost/asio/detail/impl/epoll_reactor.hpp:
 
-/usr/include/boost/mpl/lambda_fwd.hpp:
+/usr/include/x86_64-linux-gnu/bits/byteswap.h:
 
-/usr/include/boost/mpl/limits/list.hpp:
+/usr/include/x86_64-linux-gnu/bits/confname.h:
 
-/usr/include/boost/mpl/bind_fwd.hpp:
+/usr/include/x86_64-linux-gnu/bits/endian.h:
 
-/usr/include/boost/mpl/list.hpp:
+/usr/include/x86_64-linux-gnu/bits/endianness.h:
 
-/opt/openrobots/include/hpp/fcl/BV/RSS.h:
+/usr/include/boost/fusion/view/reverse_view/detail/value_at_impl.hpp:
 
-/usr/include/boost/date_time/gregorian/greg_day_of_year.hpp:
+/usr/include/x86_64-linux-gnu/bits/errno.h:
 
-/usr/include/boost/mpl/list/aux_/begin_end.hpp:
+/usr/include/x86_64-linux-gnu/bits/eventfd.h:
 
-/usr/include/boost/mpl/list/aux_/front.hpp:
+/usr/include/boost/asio/handler_alloc_hook.hpp:
 
-/usr/include/boost/mpl/list/aux_/iterator.hpp:
+/usr/include/boost/asio/execution/receiver.hpp:
 
-/usr/include/boost/mpl/list/aux_/push_front.hpp:
+/usr/include/x86_64-linux-gnu/bits/fcntl-linux.h:
 
-/usr/include/boost/mpl/list/aux_/tag.hpp:
+/usr/include/x86_64-linux-gnu/bits/fcntl.h:
 
-/usr/include/boost/mpl/list/list0.hpp:
+/usr/include/x86_64-linux-gnu/bits/getopt_core.h:
 
-/usr/include/boost/fusion/iterator/mpl/convert_iterator.hpp:
+/usr/include/x86_64-linux-gnu/bits/in.h:
 
-/usr/include/boost/mpl/list/list10.hpp:
+/usr/include/c++/11/cfloat:
 
-/usr/include/boost/iostreams/traits_fwd.hpp:
+/usr/include/x86_64-linux-gnu/bits/ioctls.h:
 
-/usr/include/boost/mpl/list/list20.hpp:
+/usr/include/x86_64-linux-gnu/bits/libc-header-start.h:
 
-/usr/include/boost/mpl/list/list30.hpp:
+/usr/include/boost/preprocessor/control/while.hpp:
 
-/usr/include/boost/mpl/logical.hpp:
+/usr/include/x86_64-linux-gnu/bits/local_lim.h:
 
-/usr/include/boost/date_time/gregorian/greg_calendar.hpp:
+/usr/include/x86_64-linux-gnu/bits/long-double.h:
 
-/usr/include/boost/asio/detail/work_dispatcher.hpp:
+/usr/include/eigen3/Eigen/src/Core/products/TriangularMatrixVector.h:
 
-/usr/include/boost/mpl/minus.hpp:
+/usr/include/x86_64-linux-gnu/bits/poll.h:
 
-/usr/include/boost/asio/detail/timer_scheduler_fwd.hpp:
+/usr/include/boost/asio/detail/service_registry.hpp:
 
-/usr/include/boost/mpl/multiplies.hpp:
+/usr/include/boost/mpl/has_key_fwd.hpp:
 
-/usr/include/boost/mpl/negate.hpp:
+/usr/include/x86_64-linux-gnu/bits/poll2.h:
 
-/usr/include/c++/11/ext/concurrence.h:
+/usr/include/x86_64-linux-gnu/bits/posix1_lim.h:
 
-/opt/openrobots/include/hpp/fcl/mesh_loader/assimp.h:
+/usr/include/boost/type_traits/conditional.hpp:
 
-/usr/include/boost/mpl/pop_back_fwd.hpp:
+/usr/include/boost/preprocessor/repetition/repeat_from_to.hpp:
 
-/usr/include/boost/mpl/pop_front_fwd.hpp:
+/usr/include/x86_64-linux-gnu/bits/posix2_lim.h:
 
-/usr/include/x86_64-linux-gnu/bits/types/mbstate_t.h:
+/usr/include/x86_64-linux-gnu/bits/pthread_stack_min-dynamic.h:
 
-/usr/include/eigen3/Eigen/src/Eigenvalues/EigenSolver.h:
+/usr/include/x86_64-linux-gnu/bits/pthreadtypes-arch.h:
 
-/usr/include/boost/mpl/print.hpp:
+/usr/include/boost/date_time/time_system_split.hpp:
 
-/usr/include/boost/asio/detail/conditionally_enabled_mutex.hpp:
+/usr/include/x86_64-linux-gnu/bits/setjmp.h:
 
-/usr/include/boost/mpl/prior.hpp:
+/usr/include/x86_64-linux-gnu/bits/sigevent-consts.h:
 
-/usr/include/boost/type_traits/is_fundamental.hpp:
+/usr/include/x86_64-linux-gnu/bits/siginfo-consts-arch.h:
 
-/usr/include/boost/preprocessor/seq/subseq.hpp:
+/usr/include/x86_64-linux-gnu/bits/siginfo-consts.h:
 
-/usr/include/boost/iostreams/char_traits.hpp:
+/usr/include/x86_64-linux-gnu/bits/signum-arch.h:
 
-/usr/include/boost/mpl/push_front.hpp:
+/usr/include/x86_64-linux-gnu/bits/signum-generic.h:
diff --git a/clik/build/CMakeFiles/clik.dir/flags.make b/clik/build/CMakeFiles/clik.dir/flags.make
index b4ffbcd84ef99e8b8b7d509c85d95c05b32f0e14..7a08f4031f751db56b31258b7ec5ab1068509c20 100644
--- a/clik/build/CMakeFiles/clik.dir/flags.make
+++ b/clik/build/CMakeFiles/clik.dir/flags.make
@@ -4,7 +4,7 @@
 # compile CXX with /usr/bin/c++
 CXX_DEFINES = -DBOOST_ALL_NO_LIB -DBOOST_ATOMIC_DYN_LINK -DBOOST_MPL_LIMIT_LIST_SIZE=30 -DBOOST_MPL_LIMIT_VECTOR_SIZE=30 -DBOOST_SYSTEM_DYN_LINK -DBOOST_THREAD_DYN_LINK -DHPP_FCL_HAS_OCTOMAP -DHPP_FCL_HAVE_OCTOMAP -DOCTOMAP_MAJOR_VERSION=1 -DOCTOMAP_MINOR_VERSION=9 -DOCTOMAP_PATCH_VERSION=7 -DPINOCCHIO_WITH_HPP_FCL -DPINOCCHIO_WITH_URDFDOM
 
-CXX_INCLUDES = -I/home/gospodar/lund/praxis/ur_simple_control/clik/src -isystem /opt/openrobots/include -isystem /usr/include/eigen3
+CXX_INCLUDES = -I/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src -isystem /opt/openrobots/include -isystem /usr/include/eigen3
 
 CXX_FLAGS =      -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn -std=gnu++14
 
diff --git a/clik/build/CMakeFiles/clik.dir/src/clik.cpp.o b/clik/build/CMakeFiles/clik.dir/src/clik.cpp.o
index e895b0d6a78d3c5177ae93b9aaee856874adfb27..ff1bc201759f3016a423eed5a18a500979213503 100644
Binary files a/clik/build/CMakeFiles/clik.dir/src/clik.cpp.o and b/clik/build/CMakeFiles/clik.dir/src/clik.cpp.o differ
diff --git a/clik/build/CMakeFiles/clik.dir/src/clik.cpp.o.d b/clik/build/CMakeFiles/clik.dir/src/clik.cpp.o.d
index 8b25e471d6913ff1c62e8c90ffade31930e6f2b4..e151c401012cc4d8058606321b02446d57535108 100644
--- a/clik/build/CMakeFiles/clik.dir/src/clik.cpp.o.d
+++ b/clik/build/CMakeFiles/clik.dir/src/clik.cpp.o.d
@@ -1,9 +1,8 @@
 CMakeFiles/clik.dir/src/clik.cpp.o: \
- /home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp \
+ /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp \
  /usr/include/stdc-predef.h \
- /opt/openrobots/include/pinocchio/parsers/urdf.hpp \
- /opt/openrobots/include/pinocchio/multibody/model.hpp \
- /opt/openrobots/include/pinocchio/spatial/fwd.hpp \
+ /opt/openrobots/include/pinocchio/algorithm/jacobian.hpp \
+ /opt/openrobots/include/pinocchio/multibody/fwd.hpp \
  /opt/openrobots/include/pinocchio/fwd.hpp \
  /opt/openrobots/include/pinocchio/macros.hpp \
  /usr/include/c++/11/exception \
@@ -439,6 +438,9 @@ CMakeFiles/clik.dir/src/clik.cpp.o: \
  /usr/include/eigen3/Eigen/src/Core/util/ReenableStupidWarnings.h \
  /opt/openrobots/include/pinocchio/core/binary-op.hpp \
  /opt/openrobots/include/pinocchio/core/unary-op.hpp \
+ /opt/openrobots/include/pinocchio/multibody/joint/fwd.hpp \
+ /opt/openrobots/include/pinocchio/multibody/model.hpp \
+ /opt/openrobots/include/pinocchio/spatial/fwd.hpp \
  /opt/openrobots/include/pinocchio/spatial/se3.hpp \
  /opt/openrobots/include/pinocchio/spatial/se3-base.hpp \
  /opt/openrobots/include/pinocchio/spatial/se3-tpl.hpp \
@@ -1142,8 +1144,6 @@ CMakeFiles/clik.dir/src/clik.cpp.o: \
  /opt/openrobots/include/pinocchio/spatial/inertia.hpp \
  /usr/include/c++/11/iostream \
  /opt/openrobots/include/pinocchio/spatial/symmetric3.hpp \
- /opt/openrobots/include/pinocchio/multibody/fwd.hpp \
- /opt/openrobots/include/pinocchio/multibody/joint/fwd.hpp \
  /opt/openrobots/include/pinocchio/multibody/frame.hpp \
  /opt/openrobots/include/pinocchio/multibody/joint/joint-generic.hpp \
  /opt/openrobots/include/pinocchio/multibody/joint/joint-collection.hpp \
@@ -1725,6 +1725,212 @@ CMakeFiles/clik.dir/src/clik.cpp.o: \
  /opt/openrobots/include/pinocchio/multibody/liegroup/special-orthogonal.hpp \
  /opt/openrobots/include/pinocchio/multibody/liegroup/special-euclidean.hpp \
  /opt/openrobots/include/pinocchio/multibody/liegroup/liegroup-algo.hxx \
+ /opt/openrobots/include/pinocchio/multibody/data.hpp \
+ /usr/include/eigen3/Eigen/Cholesky \
+ /opt/openrobots/include/pinocchio/multibody/data.hxx \
+ /opt/openrobots/include/pinocchio/algorithm/jacobian.hxx \
+ /opt/openrobots/include/pinocchio/algorithm/check.hpp \
+ /usr/include/boost/fusion/container/list.hpp \
+ /usr/include/boost/fusion/container/list/list.hpp \
+ /usr/include/boost/fusion/container/list/detail/list_to_cons.hpp \
+ /usr/include/boost/fusion/container/list/convert.hpp \
+ /usr/include/boost/fusion/container/list/detail/build_cons.hpp \
+ /usr/include/boost/fusion/container/list/detail/convert_impl.hpp \
+ /usr/include/boost/fusion/container/generation/make_list.hpp \
+ /opt/openrobots/include/pinocchio/algorithm/check.hxx \
+ /usr/include/boost/fusion/algorithm.hpp \
+ /usr/include/boost/fusion/algorithm/iteration.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/accumulate.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/accumulate_fwd.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/fold.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/fold_fwd.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/fold.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/detail/segmented_fold.hpp \
+ /usr/include/boost/fusion/support/segmented_fold_until.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/for_each.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/detail/for_each.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/detail/segmented_for_each.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/for_each_fwd.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/iter_fold.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/iter_fold_fwd.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/iter_fold.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/reverse_fold.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/reverse_fold_fwd.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/reverse_fold.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/reverse_iter_fold.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/reverse_iter_fold_fwd.hpp \
+ /usr/include/boost/fusion/algorithm/iteration/detail/preprocessed/reverse_iter_fold.hpp \
+ /usr/include/boost/fusion/algorithm/query.hpp \
+ /usr/include/boost/fusion/algorithm/query/all.hpp \
+ /usr/include/boost/fusion/algorithm/query/detail/all.hpp \
+ /usr/include/boost/fusion/algorithm/query/any.hpp \
+ /usr/include/boost/fusion/algorithm/query/detail/any.hpp \
+ /usr/include/boost/fusion/algorithm/query/count.hpp \
+ /usr/include/boost/fusion/algorithm/query/count_if.hpp \
+ /usr/include/boost/fusion/algorithm/query/detail/count_if.hpp \
+ /usr/include/boost/fusion/algorithm/query/detail/count.hpp \
+ /usr/include/boost/fusion/algorithm/query/find.hpp \
+ /usr/include/boost/fusion/algorithm/query/find_if_fwd.hpp \
+ /usr/include/boost/fusion/algorithm/query/detail/find_if.hpp \
+ /usr/include/boost/fusion/algorithm/query/detail/segmented_find.hpp \
+ /usr/include/boost/fusion/algorithm/query/find_fwd.hpp \
+ /usr/include/boost/fusion/algorithm/query/find_if.hpp \
+ /usr/include/boost/fusion/algorithm/query/detail/segmented_find_if.hpp \
+ /usr/include/boost/fusion/algorithm/query/none.hpp \
+ /usr/include/boost/fusion/algorithm/transformation.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/clear.hpp \
+ /usr/include/boost/fusion/container/vector/vector10.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/erase.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/erase_key.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/filter.hpp \
+ /usr/include/boost/fusion/view/filter_view/filter_view.hpp \
+ /usr/include/boost/fusion/view/filter_view/filter_view_iterator.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/deref_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/next_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/value_of_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/equal_to_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/deref_data_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/value_of_data_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/key_of_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/begin_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/end_impl.hpp \
+ /usr/include/boost/fusion/view/filter_view/detail/size_impl.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/filter_if.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/insert.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/insert_range.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/join.hpp \
+ /usr/include/boost/fusion/view/joint_view.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/pop_back.hpp \
+ /usr/include/boost/fusion/iterator/iterator_adapter.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/pop_front.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/remove.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/remove_if.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/replace.hpp \
+ /usr/include/boost/fusion/view/transform_view/transform_view.hpp \
+ /usr/include/boost/fusion/view/transform_view/transform_view_iterator.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/deref_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/next_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/prior_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/value_of_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/advance_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/distance_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/equal_to_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/transform_view_fwd.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/begin_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/end_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/at_impl.hpp \
+ /usr/include/boost/fusion/view/transform_view/detail/value_at_impl.hpp \
+ /usr/include/boost/fusion/view/detail/strictest_traversal.hpp \
+ /usr/include/boost/fusion/mpl.hpp \
+ /usr/include/boost/fusion/iterator/mpl.hpp \
+ /usr/include/boost/fusion/adapted/mpl.hpp \
+ /usr/include/boost/fusion/adapted/mpl/detail/is_sequence_impl.hpp \
+ /usr/include/boost/fusion/adapted/mpl/detail/size_impl.hpp \
+ /usr/include/boost/fusion/adapted/mpl/detail/value_at_impl.hpp \
+ /usr/include/boost/fusion/adapted/mpl/detail/at_impl.hpp \
+ /usr/include/boost/fusion/adapted/mpl/detail/has_key_impl.hpp \
+ /usr/include/boost/mpl/has_key.hpp \
+ /usr/include/boost/mpl/has_key_fwd.hpp \
+ /usr/include/boost/mpl/aux_/has_key_impl.hpp \
+ /usr/include/boost/fusion/adapted/mpl/detail/category_of_impl.hpp \
+ /usr/include/boost/fusion/adapted/mpl/detail/is_view_impl.hpp \
+ /usr/include/boost/fusion/adapted/mpl/detail/empty_impl.hpp \
+ /usr/include/boost/fusion/mpl/at.hpp \
+ /usr/include/boost/fusion/mpl/back.hpp /usr/include/boost/mpl/back.hpp \
+ /usr/include/boost/mpl/aux_/back_impl.hpp \
+ /usr/include/boost/fusion/mpl/clear.hpp \
+ /usr/include/boost/fusion/mpl/detail/clear.hpp \
+ /usr/include/boost/fusion/container/map/map_fwd.hpp \
+ /usr/include/boost/fusion/container/set/set_fwd.hpp \
+ /usr/include/boost/fusion/container/deque/deque_fwd.hpp \
+ /usr/include/boost/fusion/mpl/empty.hpp \
+ /usr/include/boost/fusion/mpl/erase.hpp /usr/include/boost/mpl/erase.hpp \
+ /usr/include/boost/mpl/erase_fwd.hpp \
+ /usr/include/boost/mpl/aux_/erase_impl.hpp \
+ /usr/include/boost/fusion/sequence/convert.hpp \
+ /usr/include/boost/fusion/mpl/erase_key.hpp \
+ /usr/include/boost/mpl/erase_key.hpp \
+ /usr/include/boost/mpl/erase_key_fwd.hpp \
+ /usr/include/boost/mpl/aux_/erase_key_impl.hpp \
+ /usr/include/boost/fusion/mpl/front.hpp \
+ /usr/include/boost/fusion/mpl/has_key.hpp \
+ /usr/include/boost/fusion/sequence/intrinsic/has_key.hpp \
+ /usr/include/boost/fusion/mpl/insert.hpp \
+ /usr/include/boost/fusion/mpl/insert_range.hpp \
+ /usr/include/boost/fusion/mpl/pop_back.hpp \
+ /usr/include/boost/mpl/pop_back.hpp \
+ /usr/include/boost/mpl/aux_/pop_back_impl.hpp \
+ /usr/include/boost/fusion/mpl/pop_front.hpp \
+ /usr/include/boost/fusion/mpl/push_back.hpp \
+ /usr/include/boost/fusion/mpl/push_front.hpp \
+ /usr/include/boost/fusion/mpl/size.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/detail/replace.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/replace_if.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/detail/replace_if.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/reverse.hpp \
+ /usr/include/boost/fusion/view/reverse_view/reverse_view.hpp \
+ /usr/include/boost/fusion/view/reverse_view/reverse_view_iterator.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/deref_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/next_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/prior_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/advance_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/distance_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/value_of_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/deref_data_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/value_of_data_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/key_of_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/begin_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/end_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/at_impl.hpp \
+ /usr/include/boost/fusion/view/reverse_view/detail/value_at_impl.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/transform.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/zip.hpp \
+ /usr/include/boost/fusion/view/zip_view.hpp \
+ /usr/include/boost/fusion/view/zip_view/zip_view.hpp \
+ /usr/include/boost/fusion/support/unused.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/begin_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/zip_view_iterator_fwd.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/end_impl.hpp \
+ /usr/include/boost/mpl/min.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/size_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/at_impl.hpp \
+ /usr/include/boost/fusion/container/vector.hpp \
+ /usr/include/boost/fusion/container/vector/convert.hpp \
+ /usr/include/boost/fusion/container/vector/detail/as_vector.hpp \
+ /usr/include/boost/fusion/container/vector/detail/convert_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/value_at_impl.hpp \
+ /usr/include/boost/mpl/transform_view.hpp \
+ /usr/include/boost/mpl/aux_/transform_iter.hpp \
+ /usr/include/boost/fusion/view/zip_view/zip_view_iterator.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/deref_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/next_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/prior_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/advance_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/distance_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/value_of_impl.hpp \
+ /usr/include/boost/fusion/view/zip_view/detail/equal_to_impl.hpp \
+ /usr/include/boost/mpl/zip_view.hpp \
+ /usr/include/boost/mpl/unpack_args.hpp \
+ /usr/include/boost/fusion/support/detail/pp_round.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/detail/preprocessed/zip.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/detail/preprocessed/zip10.hpp \
+ /usr/include/boost/fusion/algorithm/transformation/flatten.hpp \
+ /usr/include/boost/fusion/view/flatten_view.hpp \
+ /usr/include/boost/fusion/view/flatten_view/flatten_view.hpp \
+ /usr/include/boost/mpl/single_view.hpp \
+ /usr/include/boost/mpl/aux_/single_element_iter.hpp \
+ /usr/include/boost/fusion/view/flatten_view/flatten_view_iterator.hpp \
+ /usr/include/boost/fusion/include/equal_to.hpp \
+ /usr/include/boost/fusion/sequence/comparison/equal_to.hpp \
+ /usr/include/boost/fusion/sequence/comparison/detail/equal_to.hpp \
+ /usr/include/boost/fusion/support/as_const.hpp \
+ /usr/include/boost/fusion/sequence/comparison/enable_comparison.hpp \
+ /usr/include/boost/foreach.hpp /usr/include/boost/foreach_fwd.hpp \
+ /opt/openrobots/include/pinocchio/algorithm/joint-configuration.hpp \
+ /opt/openrobots/include/pinocchio/algorithm/joint-configuration.hxx \
+ /opt/openrobots/include/pinocchio/algorithm/kinematics.hpp \
+ /opt/openrobots/include/pinocchio/algorithm/kinematics.hxx \
+ /opt/openrobots/include/pinocchio/parsers/sample-models.hpp \
  /opt/openrobots/include/pinocchio/multibody/geometry.hpp \
  /opt/openrobots/include/pinocchio/multibody/fcl.hpp \
  /opt/openrobots/include/hpp/fcl/collision_object.h \
@@ -1747,7 +1953,6 @@ CMakeFiles/clik.dir/src/clik.cpp.o: \
  /opt/openrobots/include/hpp/fcl/distance.h \
  /opt/openrobots/include/hpp/fcl/distance_func_matrix.h \
  /opt/openrobots/include/pinocchio/spatial/fcl-pinocchio-conversions.hpp \
- /usr/include/boost/foreach.hpp /usr/include/boost/foreach_fwd.hpp \
  /opt/openrobots/include/pinocchio/multibody/fcl.hxx \
  /usr/include/c++/11/list /usr/include/c++/11/bits/stl_list.h \
  /usr/include/c++/11/bits/list.tcc \
@@ -1762,6 +1967,8 @@ CMakeFiles/clik.dir/src/clik.cpp.o: \
  /usr/include/boost/bind/bind_mf_cc.hpp \
  /usr/include/boost/bind/bind_mf2_cc.hpp \
  /usr/include/boost/bind/placeholders.hpp \
+ /opt/openrobots/include/pinocchio/parsers/sample-models.hxx \
+ /opt/openrobots/include/pinocchio/parsers/urdf.hpp \
  /opt/openrobots/include/pinocchio/parsers/urdf/model.hxx \
  /opt/openrobots/include/pinocchio/parsers/urdf/geometry.hxx \
  /opt/openrobots/include/hpp/fcl/mesh_loader/loader.h \
@@ -1775,8 +1982,7 @@ CMakeFiles/clik.dir/src/clik.cpp.o: \
  /opt/openrobots/include/hpp/fcl/BV/BV.h \
  /opt/openrobots/include/hpp/fcl/BV/kDOP.h \
  /opt/openrobots/include/hpp/fcl/BV/kIOS.h \
- /opt/openrobots/include/pinocchio/algorithm/joint-configuration.hpp \
- /opt/openrobots/include/pinocchio/algorithm/joint-configuration.hxx \
+ /usr/include/eigen3/Eigen/src/Core/Matrix.h \
  /usr/local/include/ur_rtde/rtde_control_interface.h \
  /usr/local/include/ur_rtde/rtde.h \
  /usr/local/include/ur_rtde/rtde_export.h \
diff --git a/clik/build/Makefile b/clik/build/Makefile
index 7354d162dc28c63c0f04d3a76a6bbf151611e8ba..cf5555fe70f2bcefe388699cfbaeec572f15590d 100644
--- a/clik/build/Makefile
+++ b/clik/build/Makefile
@@ -57,10 +57,10 @@ RM = /home/gospodar/.local/lib/python3.10/site-packages/cmake/data/bin/cmake -E
 EQUALS = =
 
 # The top-level source directory on which CMake was run.
-CMAKE_SOURCE_DIR = /home/gospodar/lund/praxis/ur_simple_control/clik
+CMAKE_SOURCE_DIR = /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik
 
 # The top-level build directory on which CMake was run.
-CMAKE_BINARY_DIR = /home/gospodar/lund/praxis/ur_simple_control/clik/build
+CMAKE_BINARY_DIR = /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build
 
 #=============================================================================
 # Targets provided globally by CMake.
@@ -87,9 +87,9 @@ rebuild_cache/fast: rebuild_cache
 
 # The main all target
 all: cmake_check_build_system
-	$(CMAKE_COMMAND) -E cmake_progress_start /home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles /home/gospodar/lund/praxis/ur_simple_control/clik/build//CMakeFiles/progress.marks
+	$(CMAKE_COMMAND) -E cmake_progress_start /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build//CMakeFiles/progress.marks
 	$(MAKE) $(MAKESILENT) -f CMakeFiles/Makefile2 all
-	$(CMAKE_COMMAND) -E cmake_progress_start /home/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles 0
+	$(CMAKE_COMMAND) -E cmake_progress_start /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/CMakeFiles 0
 .PHONY : all
 
 # The main clean target
diff --git a/clik/build/clik b/clik/build/clik
index 2f702ddf98f6ae93118b4cbf735c4b63fab01501..1d053f340f657eb2f5ade293abebcb098ff4898b 100755
Binary files a/clik/build/clik and b/clik/build/clik differ
diff --git a/clik/build/cmake_install.cmake b/clik/build/cmake_install.cmake
index bd0229d9c0fc8ca470359875a44926c01b4b17a0..732a1ff045a7c180c2cf3a27c09ed0880e013fdc 100644
--- a/clik/build/cmake_install.cmake
+++ b/clik/build/cmake_install.cmake
@@ -1,4 +1,4 @@
-# Install script for directory: /home/gospodar/lund/praxis/ur_simple_control/clik
+# Install script for directory: /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik
 
 # Set the install prefix
 if(NOT DEFINED CMAKE_INSTALL_PREFIX)
@@ -50,5 +50,5 @@ endif()
 
 string(REPLACE ";" "\n" CMAKE_INSTALL_MANIFEST_CONTENT
        "${CMAKE_INSTALL_MANIFEST_FILES}")
-file(WRITE "/home/gospodar/lund/praxis/ur_simple_control/clik/build/${CMAKE_INSTALL_MANIFEST}"
+file(WRITE "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build/${CMAKE_INSTALL_MANIFEST}"
      "${CMAKE_INSTALL_MANIFEST_CONTENT}")
diff --git a/clik/build/compile_commands.json b/clik/build/compile_commands.json
index 44da3f8aaa38f0947e993c44bd932d567494240c..4fab5e1fd73d558aed3cb795fa8486dd164cd21c 100644
--- a/clik/build/compile_commands.json
+++ b/clik/build/compile_commands.json
@@ -1,8 +1,8 @@
 [
 {
-  "directory": "/home/gospodar/lund/praxis/ur_simple_control/clik/build",
-  "command": "/usr/bin/c++ -DBOOST_ALL_NO_LIB -DBOOST_ATOMIC_DYN_LINK -DBOOST_MPL_LIMIT_LIST_SIZE=30 -DBOOST_MPL_LIMIT_VECTOR_SIZE=30 -DBOOST_SYSTEM_DYN_LINK -DBOOST_THREAD_DYN_LINK -DHPP_FCL_HAS_OCTOMAP -DHPP_FCL_HAVE_OCTOMAP -DOCTOMAP_MAJOR_VERSION=1 -DOCTOMAP_MINOR_VERSION=9 -DOCTOMAP_PATCH_VERSION=7 -DPINOCCHIO_WITH_HPP_FCL -DPINOCCHIO_WITH_URDFDOM -I/home/gospodar/lund/praxis/ur_simple_control/clik/src -isystem /opt/openrobots/include -isystem /usr/include/eigen3      -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn -std=gnu++14 -o CMakeFiles/clik.dir/src/clik.cpp.o -c /home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp",
-  "file": "/home/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp",
+  "directory": "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/build",
+  "command": "/usr/bin/c++ -DBOOST_ALL_NO_LIB -DBOOST_ATOMIC_DYN_LINK -DBOOST_MPL_LIMIT_LIST_SIZE=30 -DBOOST_MPL_LIMIT_VECTOR_SIZE=30 -DBOOST_SYSTEM_DYN_LINK -DBOOST_THREAD_DYN_LINK -DHPP_FCL_HAS_OCTOMAP -DHPP_FCL_HAVE_OCTOMAP -DOCTOMAP_MAJOR_VERSION=1 -DOCTOMAP_MINOR_VERSION=9 -DOCTOMAP_PATCH_VERSION=7 -DPINOCCHIO_WITH_HPP_FCL -DPINOCCHIO_WITH_URDFDOM -I/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src -isystem /opt/openrobots/include -isystem /usr/include/eigen3      -D_XOPEN_SOURCE=700     -D_FORTIFY_SOURCE=2     -O2     -fstack-protector     -fomit-frame-pointer     -pipe     -pedantic -pedantic-errors     -Werror     -Weffc++     -Wall -Wextra -Wshadow -Wdeprecated     -Wdiv-by-zero -Wfloat-equal -Wfloat-conversion -Wsign-compare -Wpointer-arith     -Wuninitialized -Wunreachable-code     -Wunused -Wunused-function -Wunused-label -Wunused-parameter -Wunused-but-set-parameter -Wunused-but-set-variable     -Wunused-value -Wunused-variable -Wunused-result     -Wmissing-field-initializers -Wmissing-format-attribute -Wmissing-include-dirs -Wmissing-noreturn -std=gnu++14 -o CMakeFiles/clik.dir/src/clik.cpp.o -c /home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp",
+  "file": "/home/gospodar/home2/gospodar/lund/praxis/ur_simple_control/clik/src/clik.cpp",
   "output": "CMakeFiles/clik.dir/src/clik.cpp.o"
 }
 ]
\ No newline at end of file
diff --git a/clik/src/clik.cpp b/clik/src/clik.cpp
index 9bf82d2c35931c7ab174ea415ca2be85ff2729b5..0d668ad536eca3c3a0d6b6c05e65395ce91a4724 100644
--- a/clik/src/clik.cpp
+++ b/clik/src/clik.cpp
@@ -1,26 +1,119 @@
-#include "pinocchio/parsers/urdf.hpp"
-//#include "pinocchio/spatial/explog.hpp"
-//#include "pinocchio/algorithm/kinematics.hpp"
-//#include "pinocchio/algorithm/jacobian.hpp"
+#include "pinocchio/algorithm/jacobian.hpp"
 #include "pinocchio/algorithm/joint-configuration.hpp"
+#include "pinocchio/algorithm/kinematics.hpp"
+#include "pinocchio/parsers/sample-models.hpp"
+#include "pinocchio/parsers/urdf.hpp"
+#include "pinocchio/spatial/explog.hpp"
+#include <Eigen/src/Core/Matrix.h>
+#include <pinocchio/multibody/fwd.hpp>
+
 #include <ur_rtde/rtde_control_interface.h>
 #include <ur_rtde/rtde_receive_interface.h>
-#include <iostream>
-
-
 
+#include <iostream>
 
 int main(void) {
-  std::cout << "help" << std::endl;
-  const std::string urdf_filename = std::string("/home/gospodar/lund/praxis/pinocchio/models/example-robot-data/robots/ur_description/urdf/ur5_robot.urdf");
+  //  std::cout << "help" << std::endl;
+
+  // TODO put in some ifs to run it in sim/something if you're not connected
+  // to the robot
+  ur_rtde::RTDEControlInterface rtde_control("192.168.1.102");
+  ur_rtde::RTDEReceiveInterface rtde_receive("192.168.1.102");
+  std::vector<double> init_q = rtde_receive.getActualQ();
 
+//  const std::string urdf_filename = std::string(
+//      "/home/gospodar/lund/praxis/pinocchio/models/example-robot-data/robots/"
+//      "ur_description/urdf/ur5_robot.urdf");
+  const std::string urdf_filename = std::string(
+      "/home/gospodar/lund/praxis/ur_resources/ur5e_with_robotiq_hande/urdf/ur5e_with_robotiq_hande.urdf");
   pinocchio::Model model;
   pinocchio::urdf::buildModel(urdf_filename, model);
-  std::cout << model.joints.data() << std::endl;
+  // pinocchio::buildModels::manipulator(model);
 
-  ur_rtde::RTDEControlInterface rtde_control("192.168.1.102");
-  ur_rtde::RTDEReceiveInterface rtde_receive("192.168.1.102");
-//  std::vector<double> init_q = rtde_receive.getActualQ();
+  pinocchio::Data data(model);
+
+  const int JOINT_ID = 6;
+  // oMdes is the desired pose
+
+  //const pinocchio::SE3 oMdes(Eigen::Matrix3d(1.0, 0.0, 0.0,
+  //  										 0.0, 1.0, 0.0,
+  //  										 0.0, 0.0, 1.0),
+  const pinocchio::SE3 oMdes(Eigen::Matrix3d::Zero(),
+                             Eigen::Vector3d(0.5, 0.3,  0.5));
+
+  //Eigen::VectorXd q = pinocchio::neutral(model);
+  Eigen::VectorXd q(model.nq);
+  q = Eigen::Map<Eigen::VectorXd>(&rtde_receive.getActualQ()[0], model.nq);
+  // random print to make sure it works
+  std::cout << q[2] << std::endl;
+//  Eigen::VectorXd q;
+  const double eps = 1e-4;
+  const int IT_MAX = 10000000;
+//  const double DT = 1e-1;
+  const double damp = 1e-6;
+
+  pinocchio::Data::Matrix6x J(6, model.nv);
+  J.setZero();
+
+  bool success = false;
+  typedef Eigen::Matrix<double, 6, 1> Vector6d;
+  Vector6d err;
+  Eigen::VectorXd v(model.nv);
+  std::vector<double> v_as_std_vec;
+  for (int i = 0;; i++) {
+    q = Eigen::Map<Eigen::VectorXd>(&rtde_receive.getActualQ()[0], model.nq);
+    pinocchio::forwardKinematics(model, data, q);
+// data.omi[joint_id] is the placement of joint_id
+	// se3.act is the group action,
+	// se3.actinv is the inverse group action
+	// you need to check the actual math to see what and why is this here
+    const pinocchio::SE3 iMd = data.oMi[JOINT_ID].actInv(oMdes);
+    err = pinocchio::log6(iMd).toVector(); // in joint frame
+    if (err.norm() < eps) {
+      success = true;
+	  std::cout << "reached destionation" << std::endl;
+      break;
+    }
+    if (i >= IT_MAX) {
+      success = false;
+	  std::cout << "FAIL: did not succed in IT_MAX iterations" << std::endl;
+      break;
+    }
+    pinocchio::computeJointJacobian(model, data, q, JOINT_ID,
+                                    J); // J in joint frame
+    pinocchio::Data::Matrix6 Jlog;
+    pinocchio::Jlog6(iMd.inverse(), Jlog);
+    J = -Jlog * J;
+    pinocchio::Data::Matrix6 JJt;
+    JJt.noalias() = J * J.transpose();
+    JJt.diagonal().array() += damp;
+    v.noalias() = -J.transpose() * JJt.ldlt().solve(err);
+	//    we're running it on the real system
+//    q = pinocchio::integrate(model, q, v * DT);
+//    make a cleaner cast, but also who cares
+	v_as_std_vec.push_back(v[0]);
+	v_as_std_vec.push_back(v[1]);
+	v_as_std_vec.push_back(v[2]);
+	v_as_std_vec.push_back(v[3]);
+	v_as_std_vec.push_back(v[4]);
+	v_as_std_vec.push_back(v[5]);
+    rtde_control.speedJ(v_as_std_vec, 0.1, 1.0/500);
+	v_as_std_vec.clear();
+    if (!(i % 1000))
+      std::cout << i << ": error = " << err.transpose() << std::endl;
+	  std::cout << "pos" << data.oMi[JOINT_ID] << std::endl;
+  }
+
+  if (success) {
+    std::cout << "Convergence achieved!" << std::endl;
+  } else {
+    std::cout << "\nWarning: the iterative algorithm has not reached "
+                 "convergence to the desired precision"
+              << std::endl;
+  }
+
+  std::cout << "\nresult: " << q.transpose() << std::endl;
+  std::cout << "\nfinal error: " << err.transpose() << std::endl;
 
   return 0;
 }
diff --git a/ur5e_with_robotiq_hande.urdf b/ur5e_with_robotiq_hande.urdf
new file mode 100644
index 0000000000000000000000000000000000000000..ad9a2f3fe804fd1dea8b3f6b34e39aa7353370e1
--- /dev/null
+++ b/ur5e_with_robotiq_hande.urdf
@@ -0,0 +1,575 @@
+<?xml version="1.0" encoding="utf-8"?>
+<!-- =================================================================================== -->
+<!-- |    This document was autogenerated by xacro from ur5e_with_robotiq_hande.xacro  | -->
+<!-- |    EDITING THIS FILE BY HAND IS NOT RECOMMENDED                                 | -->
+<!-- =================================================================================== -->
+<robot name="ur5e_with_robotiq_hande">
+  <!--   <gazebo>
+    <plugin name="gazebo_ros_control" filename="libgazebo_ros_control.so"> -->
+  <!-- <robotNamespace>/</robotNamespace>
+      <robotSimType>gazebo_ros_control/DefaultRobotHWSim</robotSimType>
+      <legacyModeNS>true</legacyModeNS> -->
+  <!--     </plugin>
+
+  </gazebo> -->
+  <!--
+  Author: Cristian C Beltran-Hernandez
+-->
+  <!-- Robotiq Coupler -->
+  <!--  + Height added by the coupler: 8mm -->
+  <!--  + Reference frame: at the middle (4mm) -->
+  <link name="robotiq_coupler">
+    <visual>
+      <geometry>
+        <mesh filename="package://ur5e_with_robotiq_hande/meshes/robotiq_85_coupler.stl"/>
+      </geometry>
+      <material name="flat_black"/>
+    </visual>
+    <collision>
+      <geometry>
+        <mesh filename="package://ur5e_with_robotiq_hande/meshes/robotiq_85_coupler.stl"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <origin rpy="0 0 0" xyz="2.073e-05   1.45286e-03  -1.1049e-03"/>
+      <mass value="0.168"/>
+      <inertia ixx="6.69695624e-05" ixy="5.21511788e-09" ixz="-2.74383009e-08" iyy="7.85088161e-05" iyz="5.41105193e-07" izz="1.41819717e-04"/>
+    </inertial>
+  </link>
+  <joint name="robotiq_coupler_joint" type="fixed">
+    <origin rpy="0 0 -1.57079632679" xyz="0 0 0.004"/>
+    <parent link="tool0"/>
+    <child link="robotiq_coupler"/>
+  </joint>
+  <!-- <link name="gripper_root_link">
+    <visual>
+      <origin xyz="0 0 0.005" rpy="0 0 0"/>
+      <geometry>
+        <box size="0.01 0.01 0.01"/>
+      </geometry>
+    </visual>
+    <collision>
+      <origin xyz="0 0 0.005" rpy="0 0 0"/>
+      <geometry>
+        <box size="0.01 0.01 0.01"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <mass value="0.01" />
+      <origin xyz="0.0 0.0 0.0" />
+      <inertia ixx = "0.000001" ixy = "0.000000" ixz = "0.000000"
+           iyx = "0.000000" iyy = "0.000001" iyz = "0.000000"
+           izx = "0.000000" izy = "0.000000" izz = "0.000001" />
+    </inertial>
+  </link>
+
+  <link name="world" />
+
+  <joint name="world_joint" type="fixed">
+    <parent link="world" />
+    <child link = "gripper_root_link" />
+    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
+  </joint> -->
+  <!-- gripper -->
+  <!-- <xacro:robotiq_hande_gripper prefix="" parent="gripper_root_link" > -->
+  <!-- <xacro:robotiq_hande_gripper prefix="" parent="" > -->
+  <!-- <origin xyz="0.0 0 0.005" rpy="0 0 0"/> -->
+  <!-- </xacro:robotiq_hande_gripper> -->
+  <!--
+    Base UR robot series xacro macro.
+
+    NOTE: this is NOT a URDF. It cannot directly be loaded by consumers
+    expecting a flattened '.urdf' file. See the top-level '.xacro' for that
+    (but note: that .xacro must still be processed by the xacro command).
+
+    For use in '.launch' files: use one of the 'load_urX.launch' convenience
+    launch files.
+
+    This file models the base kinematic chain of a UR robot, which then gets
+    parameterised by various configuration files to convert it into a UR3(e),
+    UR5(e), UR10(e) or UR16e.
+
+    NOTE: the default kinematic parameters (ie: link lengths, frame locations,
+    offets, etc) do not correspond to any particular robot. They are defaults
+    only. There WILL be non-zero offsets between the Forward Kinematics results
+    in TF (ie: robot_state_publisher) and the values reported by the Teach
+    Pendant.
+
+    For accurate (and robot-specific) transforms, the 'kinematics_parameters_file'
+    parameter MUST point to a .yaml file containing the appropriate values for
+    the targetted robot.
+
+    If using the UniversalRobots/Universal_Robots_ROS_Driver, follow the steps
+    described in the readme of that repository to extract the kinematic
+    calibration from the controller and generate the required .yaml file.
+
+    Main author of the migration to yaml configs: Ludovic Delval.
+
+    Contributors to previous versions (in no particular order):
+
+     - Felix Messmer
+     - Kelsey Hawkins
+     - Wim Meeussen
+     - Shaun Edwards
+     - Nadia Hammoudeh Garcia
+     - Dave Hershberger
+     - G. vd. Hoorn
+     - Philip Long
+     - Dave Coleman
+     - Miguel Prada
+     - Mathias Luedtke
+     - Marcel Schnirring
+     - Felix von Drigalski
+     - Felix Exner
+     - Jimmy Da Silva
+     - Ajit Krisshna N L
+     - Muhammad Asif Rana
+  -->
+  <!--
+    NOTE: the macro defined in this file is NOT part of the public API of this
+          package. Users CANNOT rely on this file being available, or stored in
+          this location. Nor can they rely on the existence of the macro.
+  -->
+  <transmission name="shoulder_pan_trans">
+    <type>transmission_interface/SimpleTransmission</type>
+    <joint name="shoulder_pan_joint">
+      <hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
+    </joint>
+    <actuator name="shoulder_pan_motor">
+      <mechanicalReduction>1</mechanicalReduction>
+    </actuator>
+  </transmission>
+  <transmission name="shoulder_lift_trans">
+    <type>transmission_interface/SimpleTransmission</type>
+    <joint name="shoulder_lift_joint">
+      <hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
+    </joint>
+    <actuator name="shoulder_lift_motor">
+      <mechanicalReduction>1</mechanicalReduction>
+    </actuator>
+  </transmission>
+  <transmission name="elbow_trans">
+    <type>transmission_interface/SimpleTransmission</type>
+    <joint name="elbow_joint">
+      <hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
+    </joint>
+    <actuator name="elbow_motor">
+      <mechanicalReduction>1</mechanicalReduction>
+    </actuator>
+  </transmission>
+  <transmission name="wrist_1_trans">
+    <type>transmission_interface/SimpleTransmission</type>
+    <joint name="wrist_1_joint">
+      <hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
+    </joint>
+    <actuator name="wrist_1_motor">
+      <mechanicalReduction>1</mechanicalReduction>
+    </actuator>
+  </transmission>
+  <transmission name="wrist_2_trans">
+    <type>transmission_interface/SimpleTransmission</type>
+    <joint name="wrist_2_joint">
+      <hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
+    </joint>
+    <actuator name="wrist_2_motor">
+      <mechanicalReduction>1</mechanicalReduction>
+    </actuator>
+  </transmission>
+  <transmission name="wrist_3_trans">
+    <type>transmission_interface/SimpleTransmission</type>
+    <joint name="wrist_3_joint">
+      <hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
+    </joint>
+    <actuator name="wrist_3_motor">
+      <mechanicalReduction>1</mechanicalReduction>
+    </actuator>
+  </transmission>
+  <!-- links: main serial chain -->
+  <link name="base_link"/>
+  <link name="base_link_inertia">
+    <visual>
+      <origin rpy="0 0 3.14159265359" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/visual/base.dae"/>
+      </geometry>
+      <material name="LightGrey">
+        <color rgba="0.7 0.7 0.7 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="0 0 3.14159265359" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/collision/base.stl"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <mass value="4.0"/>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <inertia ixx="0.00443333156" ixy="0.0" ixz="0.0" iyy="0.00443333156" iyz="0.0" izz="0.0072"/>
+    </inertial>
+  </link>
+  <link name="shoulder_link">
+    <visual>
+      <origin rpy="0 0 3.14159265359" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/visual/shoulder.dae"/>
+      </geometry>
+      <material name="LightGrey">
+        <color rgba="0.7 0.7 0.7 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="0 0 3.14159265359" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/collision/shoulder.stl"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <mass value="3.7"/>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <inertia ixx="0.010267495893" ixy="0.0" ixz="0.0" iyy="0.010267495893" iyz="0.0" izz="0.00666"/>
+    </inertial>
+  </link>
+  <link name="upper_arm_link">
+    <visual>
+      <origin rpy="1.57079632679 0 -1.57079632679" xyz="0 0 0.138"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/visual/upperarm.dae"/>
+      </geometry>
+      <material name="LightGrey">
+        <color rgba="0.7 0.7 0.7 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="1.57079632679 0 -1.57079632679" xyz="0 0 0.138"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/collision/upperarm.stl"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <mass value="8.393"/>
+      <origin rpy="0 1.57079632679 0" xyz="-0.2125 0.0 0.138"/>
+      <inertia ixx="0.133885781862" ixy="0.0" ixz="0.0" iyy="0.133885781862" iyz="0.0" izz="0.0151074"/>
+    </inertial>
+  </link>
+  <link name="forearm_link">
+    <visual>
+      <origin rpy="1.57079632679 0 -1.57079632679" xyz="0 0 0.007"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/visual/forearm.dae"/>
+      </geometry>
+      <material name="LightGrey">
+        <color rgba="0.7 0.7 0.7 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="1.57079632679 0 -1.57079632679" xyz="0 0 0.007"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/collision/forearm.stl"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <mass value="2.275"/>
+      <origin rpy="0 1.57079632679 0" xyz="-0.1961 0.0 0.007"/>
+      <inertia ixx="0.0312093550996" ixy="0.0" ixz="0.0" iyy="0.0312093550996" iyz="0.0" izz="0.004095"/>
+    </inertial>
+  </link>
+  <link name="wrist_1_link">
+    <visual>
+      <!-- TODO: Move this to a parameter -->
+      <origin rpy="1.57079632679 0 0" xyz="0 0 -0.127"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/visual/wrist1.dae"/>
+      </geometry>
+      <material name="LightGrey">
+        <color rgba="0.7 0.7 0.7 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="1.57079632679 0 0" xyz="0 0 -0.127"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/collision/wrist1.stl"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <mass value="1.219"/>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <inertia ixx="0.00255989897604" ixy="0.0" ixz="0.0" iyy="0.00255989897604" iyz="0.0" izz="0.0021942"/>
+    </inertial>
+  </link>
+  <link name="wrist_2_link">
+    <visual>
+      <origin rpy="0 0 0" xyz="0 0 -0.0997"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/visual/wrist2.dae"/>
+      </geometry>
+      <material name="LightGrey">
+        <color rgba="0.7 0.7 0.7 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="0 0 0" xyz="0 0 -0.0997"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/collision/wrist2.stl"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <mass value="1.219"/>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <inertia ixx="0.00255989897604" ixy="0.0" ixz="0.0" iyy="0.00255989897604" iyz="0.0" izz="0.0021942"/>
+    </inertial>
+  </link>
+  <link name="wrist_3_link">
+    <visual>
+      <origin rpy="1.57079632679 0 0" xyz="0 0 -0.0989"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/visual/wrist3.dae"/>
+      </geometry>
+      <material name="LightGrey">
+        <color rgba="0.7 0.7 0.7 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="1.57079632679 0 0" xyz="0 0 -0.0989"/>
+      <geometry>
+        <mesh filename="package://ur_description/meshes/ur5e/collision/wrist3.stl"/>
+      </geometry>
+    </collision>
+    <inertial>
+      <mass value="0.1879"/>
+      <origin rpy="0 0 0" xyz="0.0 0.0 -0.0229"/>
+      <inertia ixx="9.89041005217e-05" ixy="0.0" ixz="0.0" iyy="9.89041005217e-05" iyz="0.0" izz="0.0001321171875"/>
+    </inertial>
+  </link>
+  <!-- joints: main serial chain -->
+  <joint name="base_link-base_link_inertia" type="fixed">
+    <parent link="base_link"/>
+    <child link="base_link_inertia"/>
+    <!-- 'base_link' is REP-103 aligned (so X+ forward), while the internal
+           frames of the robot/controller have X+ pointing backwards.
+           Use the joint between 'base_link' and 'base_link_inertia' (a dummy
+           link/frame) to introduce the necessary rotation over Z (of pi rad).
+      -->
+    <origin rpy="0 0 3.14159265359" xyz="0 0 0"/>
+  </joint>
+  <joint name="shoulder_pan_joint" type="revolute">
+    <parent link="base_link_inertia"/>
+    <child link="shoulder_link"/>
+    <origin rpy="0 0 0" xyz="0 0 0.1625"/>
+    <axis xyz="0 0 1"/>
+    <limit effort="150.0" lower="-6.28318530718" upper="6.28318530718" velocity="3.14159265359"/>
+    <dynamics damping="0" friction="0"/>
+  </joint>
+  <joint name="shoulder_lift_joint" type="revolute">
+    <parent link="shoulder_link"/>
+    <child link="upper_arm_link"/>
+    <origin rpy="1.570796327 0 0" xyz="0 0 0"/>
+    <axis xyz="0 0 1"/>
+    <limit effort="150.0" lower="-6.28318530718" upper="6.28318530718" velocity="3.14159265359"/>
+    <dynamics damping="0" friction="0"/>
+  </joint>
+  <joint name="elbow_joint" type="revolute">
+    <parent link="upper_arm_link"/>
+    <child link="forearm_link"/>
+    <origin rpy="0 0 0" xyz="-0.425 0 0"/>
+    <axis xyz="0 0 1"/>
+    <limit effort="150.0" lower="-3.14159265359" upper="3.14159265359" velocity="3.14159265359"/>
+    <dynamics damping="0" friction="0"/>
+  </joint>
+  <joint name="wrist_1_joint" type="revolute">
+    <parent link="forearm_link"/>
+    <child link="wrist_1_link"/>
+    <origin rpy="0 0 0" xyz="-0.3922 0 0.1333"/>
+    <axis xyz="0 0 1"/>
+    <limit effort="28.0" lower="-6.28318530718" upper="6.28318530718" velocity="3.14159265359"/>
+    <dynamics damping="0" friction="0"/>
+  </joint>
+  <joint name="wrist_2_joint" type="revolute">
+    <parent link="wrist_1_link"/>
+    <child link="wrist_2_link"/>
+    <origin rpy="1.570796327 0 0" xyz="0 -0.0997 -2.0448811823e-11"/>
+    <axis xyz="0 0 1"/>
+    <limit effort="28.0" lower="-6.28318530718" upper="6.28318530718" velocity="3.14159265359"/>
+    <dynamics damping="0" friction="0"/>
+  </joint>
+  <joint name="wrist_3_joint" type="revolute">
+    <parent link="wrist_2_link"/>
+    <child link="wrist_3_link"/>
+    <origin rpy="1.57079632659 3.14159265359 3.14159265359" xyz="0 0.0996 -2.04283014801e-11"/>
+    <axis xyz="0 0 1"/>
+    <limit effort="28.0" lower="-6.28318530718" upper="6.28318530718" velocity="3.14159265359"/>
+    <dynamics damping="0" friction="0"/>
+  </joint>
+  <!-- ROS-Industrial 'base' frame: base_link to UR 'Base' Coordinates transform -->
+  <link name="base"/>
+  <joint name="base_link-base_fixed_joint" type="fixed">
+    <!-- Note the rotation over Z of pi radians: as base_link is REP-103
+           aligned (ie: has X+ forward, Y+ left and Z+ up), this is needed
+           to correctly align 'base' with the 'Base' coordinate system of
+           the UR controller.
+      -->
+    <origin rpy="0 0 3.14159265359" xyz="0 0 0"/>
+    <parent link="base_link"/>
+    <child link="base"/>
+  </joint>
+  <!-- ROS-Industrial 'flange' frame: attachment point for EEF models -->
+  <link name="flange"/>
+  <joint name="wrist_3-flange" type="fixed">
+    <parent link="wrist_3_link"/>
+    <child link="flange"/>
+    <origin rpy="0 -1.57079632679 -1.57079632679" xyz="0 0 0"/>
+  </joint>
+  <!-- ROS-Industrial 'tool0' frame: all-zeros tool frame -->
+  <link name="tool0"/>
+  <joint name="flange-tool0" type="fixed">
+    <!-- default toolframe: X+ left, Y+ up, Z+ front -->
+    <origin rpy="1.57079632679 0 1.57079632679" xyz="0 0 0"/>
+    <parent link="flange"/>
+    <child link="tool0"/>
+  </joint>
+  <joint name="robotiq_hande_base_joint" type="fixed">
+    <parent link="tool0"/>
+    <child link="hand_e_link"/>
+    <!-- <xacro:insert_block name="origin"/> -->
+  </joint>
+  <link name="hand_e_link">
+    <inertial>
+      <origin rpy="0 0 0" xyz="0 0 0.04607"/>
+      <mass value="0.86387"/>
+      <inertia ixx="1017560E-9" ixy="0" ixz="2235E-9" iyy="1028041E-9" iyz="0" izz="489810E-9"/>
+    </inertial>
+    <visual>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://ur5e_with_robotiq_hande/meshes/visual/hand-e.dae" scale="1.0 1.0 1.0"/>
+      </geometry>
+      <material name="Dark">
+        <color rgba=".1 0.1 0.1 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://robotiq_description/meshes/collision/hand-e-collision.dae" scale="1.0 1.0 1.0"/>
+      </geometry>
+    </collision>
+  </link>
+  <link name="hande_left_finger">
+    <inertial>
+      <origin rpy="0 0 0" xyz="-0.02262 0.00759 0.00738"/>
+      <mass value="0.03804"/>
+      <inertia ixx="13567E-9" ixy="1849E-9" ixz="3622E-9" iyy="15784E-9" iyz="3616E-9" izz="7478E-9"/>
+    </inertial>
+    <visual>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://robotiq_description/meshes/visual/finger_1.dae" scale="1.0 1.0 1.0"/>
+      </geometry>
+      <material name="DarkGray">
+        <color rgba=".4 0.4 0.4 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://robotiq_description/meshes/collision/finger_1-collision.dae" scale="1.0 1.0 1.0"/>
+      </geometry>
+    </collision>
+  </link>
+  <link name="hande_right_finger">
+    <inertial>
+      <origin rpy="0 0 0" xyz="0.02262 -0.00759 0.00738"/>
+      <mass value="0.03804"/>
+      <inertia ixx="13567E-9" ixy="1849E-9" ixz="-3622E-9" iyy="15784E-9" iyz="-3616E-9" izz="7478E-9"/>
+    </inertial>
+    <visual>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://robotiq_description/meshes/visual/finger_2.dae" scale="1.0 1.0 1.0"/>
+      </geometry>
+      <material name="DarkGray">
+        <color rgba=".4 0.4 0.4 1.0"/>
+      </material>
+    </visual>
+    <collision>
+      <origin rpy="0 0 0" xyz="0 0 0"/>
+      <geometry>
+        <mesh filename="package://robotiq_description/meshes/collision/finger_2-collision.dae" scale="1.0 1.0 1.0"/>
+      </geometry>
+    </collision>
+  </link>
+  <!-- <gazebo reference="${prefix}hand_e_link">
+      <material>Gazebo/FlatBlack</material>
+    </gazebo>
+    <gazebo reference="${prefix}hande_right_finger">
+      <material>Gazebo/Grey</material>
+    </gazebo>
+    <gazebo reference="${prefix}hande_left_finger">
+      <material>Gazebo/Grey</material>
+    </gazebo> -->
+  <joint name="hande_left_finger_joint" type="prismatic">
+    <origin rpy="0 0 0" xyz="0 0 0.099"/>
+    <parent link="hand_e_link"/>
+    <child link="hande_left_finger"/>
+    <axis xyz="-1 0 0"/>
+    <limit effort="130" lower="0" upper="0.025" velocity="0.15"/>
+  </joint>
+  <joint name="hande_right_finger_joint" type="prismatic">
+    <origin rpy="0 0 0" xyz="0 0 0.099"/>
+    <parent link="hand_e_link"/>
+    <child link="hande_right_finger"/>
+    <axis xyz="1 0 0"/>
+    <limit effort="130" lower="0" upper="0.025" velocity="0.15"/>
+    <mimic joint="hande_left_finger_joint" multiplier="1" offset="0"/>
+  </joint>
+  <!-- Improve grasping physics -->
+  <gazebo reference="hande_left_finger">
+    <kp>1e8</kp>
+    <kd>1.0</kd>
+    <mu1>1.0</mu1>
+    <mu2>1.0</mu2>
+    <minDepth>0.001</minDepth>
+  </gazebo>
+  <gazebo reference="hande_right_finger">
+    <kp>1e8</kp>
+    <kd>1.0</kd>
+    <mu1>1.0</mu1>
+    <mu2>1.0</mu2>
+    <minDepth>0.001</minDepth>
+  </gazebo>
+  <transmission name="hande_left_finger_trans">
+    <type>transmission_interface/SimpleTransmission</type>
+    <joint name="hande_left_finger_joint">
+      <hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
+    </joint>
+    <actuator name="hande_left_finger_motor">
+      <mechanicalReduction>1</mechanicalReduction>
+    </actuator>
+  </transmission>
+  <!-- <transmission name="${prefix}hande_right_finger_trans">
+      <type>transmission_interface/SimpleTransmission</type>
+      <joint name="${prefix}hande_right_finger_joint">
+        <hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
+      </joint>
+      <actuator name="${prefix}hande_right_finger_motor">
+        <mechanicalReduction>1</mechanicalReduction>
+      </actuator>
+    </transmission> -->
+  <!-- Mimic joints -->
+  <!-- <gazebo>
+      <plugin filename="libgazebo_mimic_joint_plugin.so" name="${prefix}mimic_robotiq_hande">
+        <joint>${prefix}hande_left_finger_joint</joint>
+        <mimicJoint>${prefix}hande_right_finger_joint</mimicJoint>
+        <multiplier>1.0</multiplier>
+        <offset>0.0</offset>
+      </plugin>
+    </gazebo> -->
+  <!-- define the ur5e's position and orientation in the world coordinate system -->
+  <link name="world"/>
+  <joint name="world_joint" type="fixed">
+    <parent link="world"/>
+    <child link="base_link"/>
+    <!-- TODO: check base_link name of robot -->
+    <origin rpy="0.0 0.0 0.0" xyz="0.0 0.0 0.0"/>
+  </joint>
+</robot>