diff --git a/CMakeLists.txt b/CMakeLists.txt
index da6a225fda3ba918a4e57db2b2efd600c347d6b0..cb41ae04224c447fa798421acb48b85dd8873324 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -10,6 +10,9 @@ add_compile_options(-std=c++11)
 ## is used, also find other catkin packages
 find_package(catkin REQUIRED COMPONENTS
   gazebo_ros
+  moveit_core
+  moveit_visual_tools
+  moveit_ros_planning_interface
 )
 
 ## System dependencies are found with CMake's conventions
@@ -104,7 +107,12 @@ find_package(catkin REQUIRED COMPONENTS
 catkin_package(
  #INCLUDE_DIRS include
  #LIBRARIES robot_models
- #CATKIN_DEPENDS gazebo_ros
+ CATKIN_DEPENDS
+    gazebo_ros
+    gazebo_ros
+    moveit_core
+    moveit_visual_tools
+    moveit_ros_planning_interface
 # DEPENDS system_lib
 )
 
@@ -143,7 +151,25 @@ include_directories(
 ## With catkin_make all packages are built within a single CMake context
 ## The recommended prefix ensures that target names across packages don't collide
 add_executable(appmod
-                                                           src/appmod.cpp
+
+        src/appmod.cpp
+        src/datalink/abstractobject.h
+        src/datalink/graspobject.h
+        src/datalink/hand.h
+        src/datalink/humanspace.h
+        src/datalink/joint.h
+        src/datalink/obstacle.h
+        src/datalink/robot.h
+        src/datalink/robotfpe.h
+        src/datalink/world.h
+        src/datalink/worldobject.h
+        src/datalink/quaternion.h
+
+        )
+
+
+add_executable(testappm
+                                                           src/testappm.cpp
                                                            src/datalink/abstractobject.h
                                                            src/datalink/graspobject.h
                                                            src/datalink/hand.h
@@ -170,6 +196,8 @@ add_executable(appmod
 
 
 ## Specify libraries to link a library or executable target against
+
+target_link_libraries(testappm ${catkin_LIBRARIES} )
 target_link_libraries(appmod ${catkin_LIBRARIES} )
 #add_dependencies(robot_models_node ${catkin_LIBRARIES})