Vision utils

Temporal merge. All works but the vision part is however not finished yet.

src/captures/CMakeLists.txt

@@ -5,9 +5,18 @@ INCLUDE_DIRECTORIES(${CMAKE_CURRENT_SOURCE_DIR})
 SET(HDRS_CAPTURE ${HDRS_CAPTURE}
   ${CMAKE_CURRENT_SOURCE_DIR}/capture_velocity.h
   ${CMAKE_CURRENT_SOURCE_DIR}/capture_wheel_joint_position.h 
-  PARENT_SCOPE)
+  )
 
 SET(SRCS_CAPTURE ${SRCS_CAPTURE}
   ${CMAKE_CURRENT_SOURCE_DIR}/capture_velocity.cpp
   ${CMAKE_CURRENT_SOURCE_DIR}/capture_wheel_joint_position.cpp 
-  PARENT_SCOPE)
+  )
+
+
+
+
+
+
+# These lines always at the end
+SET(HDRS_CAPTURE ${HDRS_CAPTURE}  PARENT_SCOPE)
+SET(SRCS_CAPTURE ${SRCS_CAPTURE}  PARENT_SCOPE)