diff --git a/source/RobotAPI/applications/ForceTorqueObserver/CMakeLists.txt b/source/RobotAPI/applications/ForceTorqueObserver/CMakeLists.txt
index ca55112b9962c053bdfeb0879878461adee162d2..db0ee2c94123469297b2469e01b58714fc665634 100644
--- a/source/RobotAPI/applications/ForceTorqueObserver/CMakeLists.txt
+++ b/source/RobotAPI/applications/ForceTorqueObserver/CMakeLists.txt
@@ -4,18 +4,13 @@ armarx_component_set_name(ForceTorqueObserver)
 find_package(Eigen3 QUIET)
 armarx_build_if(Eigen3_FOUND "Eigen3 not available")
 
-find_package(Simox QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
-
-if(Eigen3_FOUND AND Simox_FOUND)
-    include_directories(${Eigen3_INCLUDE_DIR})
-    include_directories(${Simox_INCLUDE_DIRS})
+if (Eigen3_FOUND)
+    include_directories(
+        ${Eigen3_INCLUDE_DIR})
 endif()
 
-if(ARMARX_BUILD)
-    set(COMPONENT_LIBS RobotAPIUnits RobotAPICore RobotAPIInterfaces  ArmarXInterfaces ArmarXCore ArmarXCoreObservers RobotAPIRemoteRobot)
+set(COMPONENT_LIBS RobotAPIUnits)
 
-    set(SOURCES main.cpp ForceTorqueObserverApp.h)
+set(EXE_SOURCE main.cpp ForceTorqueObserverApp.h)
 
-    armarx_add_component_executable("${SOURCES}")
-endif()
+armarx_add_component_executable("${EXE_SOURCE}")
diff --git a/source/RobotAPI/applications/ForceTorqueUnitSimulation/CMakeLists.txt b/source/RobotAPI/applications/ForceTorqueUnitSimulation/CMakeLists.txt
index 0c51e6653e33fa86b9c8726099d7aefcb58ab0b9..93f53429d6846ba5a4870205063eeb0956c54310 100644
--- a/source/RobotAPI/applications/ForceTorqueUnitSimulation/CMakeLists.txt
+++ b/source/RobotAPI/applications/ForceTorqueUnitSimulation/CMakeLists.txt
@@ -1,19 +1,15 @@
 armarx_component_set_name(ForceTorqueUnitSimulation)
 
 find_package(Eigen3 QUIET)
-armarx_build_if(Simox_FOUND "Eigen3 not available")
+armarx_build_if(Eigen3_FOUND "Eigen3 not available")
 
-find_package(Simox QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
-
-if(Eigen3_FOUND AND Simox_FOUND)
-    include_directories(${Eigen3_INCLUDE_DIR})
-    include_directories(${Simox_INCLUDE_DIRS})
+if (Eigen3_FOUND)
+    include_directories(
+        ${Eigen3_INCLUDE_DIR})
 endif()
 
-if(ARMARX_BUILD)
-    set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore RobotAPIUnits)
-    set(SOURCES main.cpp ForceTorqueUnitSimulationApp.h)
+set(COMPONENT_LIBS RobotAPIUnits)
 
-    armarx_add_component_executable("${SOURCES}")
-endif()
+set(SOURCES main.cpp ForceTorqueUnitSimulationApp.h)
+
+armarx_add_component_executable("${SOURCES}")
diff --git a/source/RobotAPI/applications/HapticObserver/CMakeLists.txt b/source/RobotAPI/applications/HapticObserver/CMakeLists.txt
index 9a596db9e72df4d6193ead5c8ca2934320ccc1b4..f1b7f7073f1873cb27033d76e8c8b99774d81b7b 100644
--- a/source/RobotAPI/applications/HapticObserver/CMakeLists.txt
+++ b/source/RobotAPI/applications/HapticObserver/CMakeLists.txt
@@ -8,7 +8,7 @@ if (Eigen3_FOUND)
         ${Eigen3_INCLUDE_DIR})
 endif()
 
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore ArmarXCoreObservers ArmarXCoreEigen3Variants WeissHapticSensorListener RobotAPIUnits)
+set(COMPONENT_LIBS WeissHapticSensorListener RobotAPIUnits)
 
 set(EXE_SOURCE main.cpp HapticObserverApp.h)
 
diff --git a/source/RobotAPI/applications/HeadIKUnit/CMakeLists.txt b/source/RobotAPI/applications/HeadIKUnit/CMakeLists.txt
index 666c2f9c63467498eed3602cd781a4192f12a2b3..2062804a398cb289e31fad693f617fa87dfdc3cc 100644
--- a/source/RobotAPI/applications/HeadIKUnit/CMakeLists.txt
+++ b/source/RobotAPI/applications/HeadIKUnit/CMakeLists.txt
@@ -4,17 +4,12 @@ armarx_component_set_name(HeadIKUnit)
 find_package(Eigen3 QUIET)
 armarx_build_if(Eigen3_FOUND "Eigen3 not available")
 
-find_package(Simox QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
-
-if (Eigen3_FOUND AND Simox_FOUND)
+if (Eigen3_FOUND)
     include_directories(
-        ${Eigen3_INCLUDE_DIR}
-        ${Simox_INCLUDE_DIRS})
+        ${Eigen3_INCLUDE_DIR})
 endif()
 
-set(COMPONENT_LIBS RobotAPIUnits RobotAPICore RobotAPIInterfaces  ArmarXInterfaces ArmarXCore ArmarXCoreObservers RobotAPIRemoteRobot 
-    ${Simox_LIBRARIES})
+set(COMPONENT_LIBS RobotAPIUnits)
 
 set(SOURCES main.cpp HeadIKUnitApp.h)
 
diff --git a/source/RobotAPI/applications/HeadIKUnit/HeadIKUnitApp.h b/source/RobotAPI/applications/HeadIKUnit/HeadIKUnitApp.h
index 697a651cb2ef46630ecaca754241fbcd86a75806..e7837c29335f91d9686132137c792af3d172f9bc 100644
--- a/source/RobotAPI/applications/HeadIKUnit/HeadIKUnitApp.h
+++ b/source/RobotAPI/applications/HeadIKUnit/HeadIKUnitApp.h
@@ -28,8 +28,8 @@
 namespace armarx
 {
     class HeadIKUnitApp :
-		virtual public armarx::Application
-	{
+        virtual public armarx::Application
+    {
         void setup(const ManagedIceObjectRegistryInterfacePtr& registry, Ice::PropertiesPtr properties)
         {
             registry->addObject( Component::create<HeadIKUnit>(properties) );
diff --git a/source/RobotAPI/applications/HeadIKUnit/main.cpp b/source/RobotAPI/applications/HeadIKUnit/main.cpp
index f88f74f1241453d86785372e181101ebe2567e6e..411a5eef168cdd16c4a3f58e69d221139511a585 100644
--- a/source/RobotAPI/applications/HeadIKUnit/main.cpp
+++ b/source/RobotAPI/applications/HeadIKUnit/main.cpp
@@ -22,7 +22,6 @@
  */
 
 #include "HeadIKUnitApp.h"
-#include <Core/core/logging/Logging.h>
 
 int main(int argc, char* argv[])
 {
diff --git a/source/RobotAPI/applications/KinematicUnitObserver/CMakeLists.txt b/source/RobotAPI/applications/KinematicUnitObserver/CMakeLists.txt
index 38b60d712b06b977365a860105baa8d734625eeb..cea242b9155a85624229cb1d0b01ebee55842ebd 100644
--- a/source/RobotAPI/applications/KinematicUnitObserver/CMakeLists.txt
+++ b/source/RobotAPI/applications/KinematicUnitObserver/CMakeLists.txt
@@ -1,13 +1,8 @@
 
 armarx_component_set_name(KinematicUnitObserver)
 
-find_package(Simox 2.3.0 QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
 
-
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore #ArmarXCoreUnits 
-    RobotAPIUnits
-    ArmarXCoreObservers)
+set(COMPONENT_LIBS RobotAPIUnits)
 
 set(SOURCES main.cpp KinematicUnitObserverApp.h)
 
diff --git a/source/RobotAPI/applications/KinematicUnitSimulation/CMakeLists.txt b/source/RobotAPI/applications/KinematicUnitSimulation/CMakeLists.txt
index 89f9c9c8fb1d687abf6f19244d9e8c163433780a..11b478b49ed4393c5856eecac2db1fef2d9eef12 100644
--- a/source/RobotAPI/applications/KinematicUnitSimulation/CMakeLists.txt
+++ b/source/RobotAPI/applications/KinematicUnitSimulation/CMakeLists.txt
@@ -4,16 +4,11 @@ armarx_component_set_name(KinematicUnitSimulation)
 find_package(Eigen3 QUIET)
 armarx_build_if(Eigen3_FOUND "Eigen3 not available")
 
-find_package(Simox 2.3.0 QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
+if (Eigen3_FOUND)
+    include_directories(${Eigen3_INCLUDE_DIR})
+endif()
 
-
-include_directories(${Eigen3_INCLUDE_DIR})
-include_directories(${Simox_INCLUDE_DIRS})
-
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore #ArmarXCoreUnits 
-    RobotAPIUnits
-    ${Simox_LIBRARIES})
+set(COMPONENT_LIBS RobotAPIUnits)
 
 set(SOURCES main.cpp KinematicUnitSimulationApp.h)
 
diff --git a/source/RobotAPI/applications/MotionControlTest/CMakeLists.txt b/source/RobotAPI/applications/MotionControlTest/CMakeLists.txt
index 33584e6f9b551385da8b5b6ad8240be5983b106d..8cf024c3738f99fc5fe4be92b64a804008d0d15b 100644
--- a/source/RobotAPI/applications/MotionControlTest/CMakeLists.txt
+++ b/source/RobotAPI/applications/MotionControlTest/CMakeLists.txt
@@ -4,16 +4,12 @@ armarx_component_set_name(MotionControlTest)
 find_package(Eigen3 QUIET)
 armarx_build_if(Eigen3_FOUND "Eigen3 not available")
 
-find_package(Simox QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
-
-if (Eigen3_FOUND AND Simox_FOUND)
+if (Eigen3_FOUND)
     include_directories(
-        ${Eigen3_INCLUDE_DIR}
-        ${Simox_INCLUDE_DIRS})
+        ${Eigen3_INCLUDE_DIR})
 endif()
 
-set(COMPONENT_LIBS MotionControl RobotAPICore ArmarXInterfaces ArmarXCore ArmarXCoreObservers RobotAPIRobotStateComponent ArmarXCoreStatechart RobotAPIOperations ${Simox_LIBRARIES})
+set(COMPONENT_LIBS MotionControl)
 
 set(SOURCES main.cpp MotionControlTestApp.h)
 
diff --git a/source/RobotAPI/applications/MotionControlTest/MotionControlTestApp.h b/source/RobotAPI/applications/MotionControlTest/MotionControlTestApp.h
index f53f50ca6e02e19899f193b0ce7728cbd63acd7f..2c04a59ba9e6d9d016aa1a30eb72693123ed6dcc 100644
--- a/source/RobotAPI/applications/MotionControlTest/MotionControlTestApp.h
+++ b/source/RobotAPI/applications/MotionControlTest/MotionControlTestApp.h
@@ -28,8 +28,8 @@
 namespace armarx
 {
     class MotionControlTestApp :
-		virtual public armarx::Application
-	{
+        virtual public armarx::Application
+    {
         void setup(const ManagedIceObjectRegistryInterfacePtr& registry, Ice::PropertiesPtr properties)
         {
             registry->addObject( Component::create<MotionControl::MotionControlOfferer>(properties) );
diff --git a/source/RobotAPI/applications/MovePlatform/CMakeLists.txt b/source/RobotAPI/applications/MovePlatform/CMakeLists.txt
index 4d19006a46024b501f81729c38a6e11fb60962ad..62f9f4c1bc98dcd2a97bf4875788e7084687d4e1 100644
--- a/source/RobotAPI/applications/MovePlatform/CMakeLists.txt
+++ b/source/RobotAPI/applications/MovePlatform/CMakeLists.txt
@@ -3,26 +3,12 @@
 armarx_component_set_name(MovePlatformApp)
 
 find_package(Eigen3 QUIET)
-find_package(Simox QUIET)
 
 armarx_build_if(Eigen3_FOUND "Eigen3 not available")
-armarx_build_if(Simox_FOUND "Simox not available")
-#armarx_build_if(MemoryX_FOUND "VisionX not available")
 
-include_directories(${Eigen3_INCLUDE_DIR} ${Simox_INCLUDE_DIRS})
+include_directories(${Eigen3_INCLUDE_DIR})
 
-set(COMPONENT_LIBS
-                   MovePlatform
-                   ArmarXInterfaces
-                   ArmarXCore
-                   ArmarXCoreStatechart
-                   ArmarXCoreObservers
-                   RobotAPIOperations
-                   RobotAPIRemoteRobot
-                   #MemoryXInterfaces
-                   #MemoryXCore
-                   #MemoryXMemoryTypes
-                   ${Simox_LIBRARIES})
+set(COMPONENT_LIBS MovePlatform)
 
 set(SOURCES main.cpp
     MovePlatformApp.h)
diff --git a/source/RobotAPI/applications/MovePlatformToLandmark/CMakeLists.txt b/source/RobotAPI/applications/MovePlatformToLandmark/CMakeLists.txt
index f31bd16898b1494de5f28275c1ac5aee590b1a96..a8d0c65af7d989b534f48a9db714ee05a942ebce 100644
--- a/source/RobotAPI/applications/MovePlatformToLandmark/CMakeLists.txt
+++ b/source/RobotAPI/applications/MovePlatformToLandmark/CMakeLists.txt
@@ -3,27 +3,12 @@
 armarx_component_set_name(MovePlatformToLandmarkApp)
 
 find_package(Eigen3 QUIET)
-find_package(Simox QUIET)
 
 armarx_build_if(Eigen3_FOUND "Eigen3 not available")
-armarx_build_if(Simox_FOUND "Simox not available")
-#armarx_build_if(MemoryX_FOUND "VisionX not available")
 
-include_directories(${Eigen3_INCLUDE_DIR} ${Simox_INCLUDE_DIRS})
+include_directories(${Eigen3_INCLUDE_DIR})
 
-set(COMPONENT_LIBS
-                   #MovePlatform
-		   MovePlatformToLandmark
-                   ArmarXInterfaces
-                   ArmarXCore
-                   ArmarXCoreStatechart
-                   ArmarXCoreObservers
-                   RobotAPIOperations
-                   RobotAPIRemoteRobot
-                   #MemoryXInterfaces
-                   #MemoryXCore
-                   #MemoryXMemoryTypes
-                   ${Simox_LIBRARIES})
+set(COMPONENT_LIBS MovePlatformToLandmark)
 
 set(SOURCES main.cpp
     MovePlatformToLandmarkApp.h)
diff --git a/source/RobotAPI/applications/PlatformUnitObserver/CMakeLists.txt b/source/RobotAPI/applications/PlatformUnitObserver/CMakeLists.txt
index 13dbfdf627791c08a9c98c07ec3d853bb7b533d9..83e6e45a9705999f4e9e7e4ab52c3f50672b73bf 100644
--- a/source/RobotAPI/applications/PlatformUnitObserver/CMakeLists.txt
+++ b/source/RobotAPI/applications/PlatformUnitObserver/CMakeLists.txt
@@ -1,13 +1,7 @@
 
 armarx_component_set_name(PlatformUnitObserver)
 
-find_package(Simox QUIET)
-armarx_build_if(Simox_FOUND "Simox VirtualRobot not found")
-
-
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore ArmarXCoreObservers #ArmarXCoreUnits 
-    RobotAPIUnits
-    ${Simox_LIBRARIES})
+set(COMPONENT_LIBS RobotAPIUnits)
 
 set(SOURCES main.cpp PlatformUnitObserverApp.h)
 
diff --git a/source/RobotAPI/applications/PlatformUnitSimulation/CMakeLists.txt b/source/RobotAPI/applications/PlatformUnitSimulation/CMakeLists.txt
index bb60f53c08754be1ca3ac91d8aee93db959ba1ea..40e5ea07cc1da98424ea7270200b95b0205dc32c 100644
--- a/source/RobotAPI/applications/PlatformUnitSimulation/CMakeLists.txt
+++ b/source/RobotAPI/applications/PlatformUnitSimulation/CMakeLists.txt
@@ -1,12 +1,7 @@
 
 armarx_component_set_name(PlatformUnitSimulation)
 
-find_package(Simox QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
-
-
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore #ArmarXCoreUnits 
-    RobotAPIUnits)
+set(COMPONENT_LIBS RobotAPIUnits)
 
 set(SOURCES main.cpp PlatformUnitSimulationApp.h)
 
diff --git a/source/RobotAPI/applications/RobotControl/CMakeLists.txt b/source/RobotAPI/applications/RobotControl/CMakeLists.txt
index a65a1295169b5eabff492c2832cf66fccbd28fb3..2159a85acb6ac9bde062182aa24e9e7a6be35155 100644
--- a/source/RobotAPI/applications/RobotControl/CMakeLists.txt
+++ b/source/RobotAPI/applications/RobotControl/CMakeLists.txt
@@ -1,11 +1,7 @@
 
 armarx_component_set_name(RobotControl)
 
-#find_package(Simox QUIET)
-#armarx_build_if(Simox_FOUND 2.3.0 "Simox-VirtualRobot not available")
-
-
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore ArmarXCoreObservers RobotAPIInterfaces RobotAPIRobotStateComponent ArmarXCoreStatechart RobotAPIOperations RobotAPIUnits RobotAPIRemoteRobot)
+set(COMPONENT_LIBS RobotAPIOperations)
 
 set(SOURCES main.cpp RobotControlApp.h)
 
diff --git a/source/RobotAPI/applications/RobotControlUI/CMakeLists.txt b/source/RobotAPI/applications/RobotControlUI/CMakeLists.txt
index 7078f19f4676abaf7f7ba0694b6d1b6c912ae732..2a8fbed83fb6583325dbc26092ded79d3a9c99e0 100644
--- a/source/RobotAPI/applications/RobotControlUI/CMakeLists.txt
+++ b/source/RobotAPI/applications/RobotControlUI/CMakeLists.txt
@@ -1,13 +1,7 @@
 
 armarx_component_set_name(RobotControlUI)
 
-# Removed dependency on Simox 2014-08-04
-#find_package(Simox 2.3.0 QUIET)
-#armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
-
-
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore #ArmarXCoreUnits 
-    ArmarXCoreObservers ArmarXCoreStatechart RobotAPIOperations)
+set(COMPONENT_LIBS RobotAPIOperations)
 
 set(SOURCES main.cpp
     RobotControlUI.cpp
diff --git a/source/RobotAPI/applications/RobotStateComponent/CMakeLists.txt b/source/RobotAPI/applications/RobotStateComponent/CMakeLists.txt
index a1c1856f83776f3aceba1abd1caf46716cb1b669..e19c80de0133cfc63dfda96d102d3e4f16589ba2 100644
--- a/source/RobotAPI/applications/RobotStateComponent/CMakeLists.txt
+++ b/source/RobotAPI/applications/RobotStateComponent/CMakeLists.txt
@@ -4,15 +4,9 @@ armarx_component_set_name(RobotStateComponent)
 find_package(Eigen3 QUIET)
 armarx_build_if(Eigen3_FOUND "component disabled")
 
-find_package(Simox 2.3.0 QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
-
-
 include_directories(${Eigen3_INCLUDE_DIR})
-include_directories(${Simox_INCLUDE_DIRS})
 
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore RobotAPIUnits RobotAPIInterfaces #ArmarXCoreUnits
-    RobotAPIRobotStateComponent)
+set(COMPONENT_LIBS RobotAPIRobotStateComponent)
 
 set(SOURCES main.cpp RobotStateComponentApp.h)
 
diff --git a/source/RobotAPI/applications/RobotStateObserver/CMakeLists.txt b/source/RobotAPI/applications/RobotStateObserver/CMakeLists.txt
index b59006f2cc85180f9944068d1186cff65a435843..94931b7ad0c41fe08b980daddd2e315001ea5475 100644
--- a/source/RobotAPI/applications/RobotStateObserver/CMakeLists.txt
+++ b/source/RobotAPI/applications/RobotStateObserver/CMakeLists.txt
@@ -3,14 +3,10 @@ armarx_component_set_name(RobotStateObserver)
 
 find_package(Eigen3 QUIET)
 armarx_build_if(Eigen3_FOUND "component disabled")
-find_package(Simox 2.3.0 QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
 
 include_directories(${Eigen3_INCLUDE_DIR})
-include_directories(${Simox_INCLUDE_DIRS})
 
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore RobotAPIInterfaces RobotAPIUnits #ArmarXCoreUnits
-    ArmarXCoreObservers RobotAPIRemoteRobot)
+set(COMPONENT_LIBS RobotAPIRemoteRobot)
 
 set(SOURCES main.cpp RobotStateObserverApp.h)
 
diff --git a/source/RobotAPI/applications/TCPControlUnit/CMakeLists.txt b/source/RobotAPI/applications/TCPControlUnit/CMakeLists.txt
index eabfd7b4aee6ecf6030530433236f0d481de9648..fe203c509c852506b16ee9fe22781163ae523df2 100644
--- a/source/RobotAPI/applications/TCPControlUnit/CMakeLists.txt
+++ b/source/RobotAPI/applications/TCPControlUnit/CMakeLists.txt
@@ -4,17 +4,12 @@ armarx_component_set_name(TCPControlUnit)
 find_package(Eigen3 QUIET)
 armarx_build_if(Eigen3_FOUND "Eigen3 not available")
 
-find_package(Simox QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
-
-if (Eigen3_FOUND AND Simox_FOUND)
+if (Eigen3_FOUND)
     include_directories(
-        ${Eigen3_INCLUDE_DIR}
-        ${Simox_INCLUDE_DIRS})
+        ${Eigen3_INCLUDE_DIR})
 endif()
 
-set(COMPONENT_LIBS RobotAPIUnits RobotAPICore RobotAPIInterfaces  ArmarXInterfaces ArmarXCore ArmarXCoreObservers RobotAPIRemoteRobot 
-    ${Simox_LIBRARIES})
+set(COMPONENT_LIBS RobotAPIUnits)
 
 set(SOURCES main.cpp TCPControlUnitApp.h)
 
diff --git a/source/RobotAPI/applications/TCPMoverUnit/CMakeLists.txt b/source/RobotAPI/applications/TCPMoverUnit/CMakeLists.txt
index c17f356fee3d4ecbc879653effd1ae93294bafa9..00b1e0807ba6fc1137fb9114d63f7149b44aeeb8 100644
--- a/source/RobotAPI/applications/TCPMoverUnit/CMakeLists.txt
+++ b/source/RobotAPI/applications/TCPMoverUnit/CMakeLists.txt
@@ -1,15 +1,15 @@
 
 armarx_component_set_name(TCPMoverUnit)
 
-find_package(Simox 2.3.0 QUIET)
-armarx_build_if(Simox_FOUND "Simox-VirtualRobot not available")
+find_package(Eigen3 QUIET)
+armarx_build_if(Eigen3_FOUND "Eigen3 not available")
 
-include_directories(${Eigen3_INCLUDE_DIR})
-include_directories(${Simox_INCLUDE_DIRS})
+if (Eigen3_FOUND)
+    include_directories(
+        ${Eigen3_INCLUDE_DIR})
+endif()
 
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore #ArmarXCoreUnits 
-    RobotAPIInterfaces RobotAPIUnits
-    ${Simox_LIBRARIES})
+set(COMPONENT_LIBS RobotAPIUnits)
 
 set(SOURCES main.cpp TCPMoverUnitApp.h)
 
diff --git a/source/RobotAPI/applications/WeissHapticSensor/CMakeLists.txt b/source/RobotAPI/applications/WeissHapticSensor/CMakeLists.txt
index 378475a1c7b43d082822a9fc398709dfdaff1482..7c213c1df95c52979185a9225f94ede2a0ce5a2e 100644
--- a/source/RobotAPI/applications/WeissHapticSensor/CMakeLists.txt
+++ b/source/RobotAPI/applications/WeissHapticSensor/CMakeLists.txt
@@ -8,7 +8,7 @@ if (Eigen3_FOUND)
         ${Eigen3_INCLUDE_DIR})
 endif()
 
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore ArmarXCoreObservers ArmarXCoreEigen3Variants WeissHapticSensorListener RobotAPIUnits RobotAPIInterfaces)
+set(COMPONENT_LIBS RobotAPIUnits WeissHapticSensorListener)
 
 set(EXE_SOURCE main.cpp WeissHapticSensorApp.h)
 
diff --git a/source/RobotAPI/applications/WeissHapticSensorsUnit/CMakeLists.txt b/source/RobotAPI/applications/WeissHapticSensorsUnit/CMakeLists.txt
index 3f7af3cd59fbdac4735e98129332367b788ef8d1..ffc1889bb5753b0acf7cc6544ec0553928f12b97 100644
--- a/source/RobotAPI/applications/WeissHapticSensorsUnit/CMakeLists.txt
+++ b/source/RobotAPI/applications/WeissHapticSensorsUnit/CMakeLists.txt
@@ -8,7 +8,7 @@ if (Eigen3_FOUND)
         ${Eigen3_INCLUDE_DIR})
 endif()
 
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore ArmarXCoreObservers ArmarXCoreEigen3Variants WeissHapticSensor RobotAPIUnits RobotAPIInterfaces)
+set(COMPONENT_LIBS RobotAPIUnits WeissHapticSensor )
 
 set(EXE_SOURCE main.cpp WeissHapticSensorsUnitApp.h)
 
diff --git a/source/RobotAPI/armarx-objects/WeissHapticSensorListener/CMakeLists.txt b/source/RobotAPI/armarx-objects/WeissHapticSensorListener/CMakeLists.txt
index 613112f8e1fae0115c71e6fd745abc90bf2bf20a..bb04b5df7eeb244a1f9d61abe4f24b2af3c44c24 100644
--- a/source/RobotAPI/armarx-objects/WeissHapticSensorListener/CMakeLists.txt
+++ b/source/RobotAPI/armarx-objects/WeissHapticSensorListener/CMakeLists.txt
@@ -8,12 +8,9 @@ if (Eigen3_FOUND)
         ${Eigen3_INCLUDE_DIR})
 endif()
 
-set(COMPONENT_LIBS ArmarXInterfaces ArmarXCore ArmarXCoreObservers ArmarXCoreEigen3Variants RobotAPIInterfaces)
+set(COMPONENT_LIBS ArmarXCoreObservers ArmarXCoreEigen3Variants RobotAPIInterfaces)
 
 set(SOURCES WeissHapticSensorListener.cpp)
 set(HEADERS WeissHapticSensorListener.h)
 
 armarx_add_component("${SOURCES}" "${HEADERS}")
-
-# add unit tests
-#add_subdirectory(test)
diff --git a/source/RobotAPI/core/CMakeLists.txt b/source/RobotAPI/core/CMakeLists.txt
index 58a91cb8bfe810ac80cd9c76d21930d371f791b7..434dd7ea2240b466563a9f9aa5e60ececcc9c99e 100644
--- a/source/RobotAPI/core/CMakeLists.txt
+++ b/source/RobotAPI/core/CMakeLists.txt
@@ -17,7 +17,7 @@ set(LIB_NAME       RobotAPICore)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreObservers ArmarXCoreStatechart RobotAPIRobotStateComponent ${Simox_LIBRARIES})
+set(LIBS RobotAPIInterfaces RobotAPIRobotStateComponent ArmarXCoreObservers ArmarXCoreStatechart ${Simox_LIBRARIES})
 
 set(LIB_FILES
     RobotStatechartContext.cpp
diff --git a/source/RobotAPI/core/RobotStatechartContext.cpp b/source/RobotAPI/core/RobotStatechartContext.cpp
index b2b22deb812204bb50ae98070b12bbbc7b01068d..5b94b441da841c5dd2238034d18dcc61949336a5 100644
--- a/source/RobotAPI/core/RobotStatechartContext.cpp
+++ b/source/RobotAPI/core/RobotStatechartContext.cpp
@@ -21,16 +21,14 @@
 *             GNU General Public License
 */
 
-#include <Core/core/Component.h>
-#include <Core/core/system/ImportExportComponent.h>
-#include <Core/statechart/Statechart.h>
+#include "RobotStatechartContext.h"
+
 #include <RobotAPI/robotstate/remote/RemoteRobot.h>
 #include <RobotAPI/robotstate/remote/ArmarPose.h>
 
-
-//#include <VirtualRobot/VirtualRobot.h>
-
-#include "RobotStatechartContext.h"
+#include <Core/core/Component.h>
+#include <Core/core/system/ImportExportComponent.h>
+#include <Core/statechart/Statechart.h>
 
 namespace armarx
 {
@@ -102,7 +100,7 @@ namespace armarx
                 ARMARX_LOG << eINFO << "Fetched handUnit proxy " << handUnitList.at(i) << ": " << handPrx << flush;
             }
         }
-		// initialize remote robot
+        // initialize remote robot
         remoteRobot.reset(new RemoteRobot(robotStateComponent->getSynchronizedRobot()));
         ARMARX_LOG << eINFO << "Created remote robot" << flush;
     }
diff --git a/source/RobotAPI/core/RobotStatechartContext.h b/source/RobotAPI/core/RobotStatechartContext.h
index 40149fc062d916299fb3661af21d2f34165a7a55..e214339d0c8a898c839c8ee0c1a9ca02e864b8e6 100644
--- a/source/RobotAPI/core/RobotStatechartContext.h
+++ b/source/RobotAPI/core/RobotStatechartContext.h
@@ -25,17 +25,16 @@
 #ifndef ARMARX_COMPONENT_RobotApi_StatechartContext_H
 #define ARMARX_COMPONENT_RobotApi_StatechartContext_H
 
-#include <Core/core/Component.h>
-#include <Core/core/system/ImportExportComponent.h>
-#include <Core/statechart/StatechartContext.h>
 #include <RobotAPI/robotstate/remote/ArmarPose.h>
 #include <RobotAPI/interface/units/KinematicUnitInterface.h>
 #include <RobotAPI/interface/units/HandUnitInterface.h>
-
 #include <RobotAPI/interface/units/TCPControlUnit.h>
 #include <RobotAPI/interface/units/HeadIKUnit.h>
+#include <RobotAPI/interface/observers/KinematicUnitObserverInterface.h>
 
-#include <RobotAPI/units/KinematicUnitObserver.h>
+#include <Core/core/Component.h>
+#include <Core/core/system/ImportExportComponent.h>
+#include <Core/statechart/StatechartContext.h>
 
 #include <IceUtil/Time.h>
 
@@ -88,8 +87,8 @@ namespace armarx
         HandUnitInterfacePrx getHandUnit(const std::string &handUnitName);
 
         //! Prx for the RobotState
-		RobotStateComponentInterfacePrx robotStateComponent;
-		KinematicUnitInterfacePrx kinematicUnitPrx;
+        RobotStateComponentInterfacePrx robotStateComponent;
+        KinematicUnitInterfacePrx kinematicUnitPrx;
         KinematicUnitObserverInterfacePrx kinematicUnitObserverPrx;
         TCPControlUnitInterfacePrx tcpControlPrx;
         VirtualRobot::RobotPtr remoteRobot;
diff --git a/source/RobotAPI/drivers/WeissHapticSensor/CMakeLists.txt b/source/RobotAPI/drivers/WeissHapticSensor/CMakeLists.txt
index 950b6e9c3e81eb53b6e3faaf965281b954c7a5ac..ea86aacfe1fcc31c23923373a307a0a4fbb5a040 100644
--- a/source/RobotAPI/drivers/WeissHapticSensor/CMakeLists.txt
+++ b/source/RobotAPI/drivers/WeissHapticSensor/CMakeLists.txt
@@ -1,6 +1,5 @@
 armarx_set_target("WeissHapticSensor Library: WeissHapticSensor")
 
-
 find_package(Eigen3 QUIET)
 
 armarx_build_if(Eigen3_FOUND "Eigen3 not available")
@@ -14,7 +13,7 @@ set(LIB_NAME       WeissHapticSensor)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPIUnits RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreObservers ArmarXCoreEigen3Variants)
+set(LIBS RobotAPIUnits ArmarXCoreObservers ArmarXCoreEigen3Variants)
 
 set(LIB_FILES
     WeissHapticSensorsUnit.cpp
diff --git a/source/RobotAPI/interface/CMakeLists.txt b/source/RobotAPI/interface/CMakeLists.txt
index 4fa3f1ba89d44f53b52ddfceee7786afec483ca9..c15a6d81059298ac07c2c70a3c068486ac02c2bd 100644
--- a/source/RobotAPI/interface/CMakeLists.txt
+++ b/source/RobotAPI/interface/CMakeLists.txt
@@ -5,27 +5,27 @@
 set(ROBOTAPI_INTERFACE_DEPEND ArmarXCore)
 
 set(SLICE_FILES
-	hardware/HardwareInterface.ice
-	
-	observers/KinematicUnitObserverInterface.ice
-	observers/PlatformUnitObserverInterface.ice
+    hardware/HardwareInterface.ice
+
+    observers/KinematicUnitObserverInterface.ice
+    observers/PlatformUnitObserverInterface.ice
+
+    robotstate/LinkedPoseBase.ice
+    robotstate/PoseBase.ice
+    robotstate/RobotState.ice
+    robotstate/RobotStateObserverInterface.ice
 
-	robotstate/LinkedPoseBase.ice
-	robotstate/PoseBase.ice
-	robotstate/RobotState.ice
-	robotstate/RobotStateObserverInterface.ice
-	
     selflocalisation/SelfLocalisationProcess.ice
 
-	units/ForceTorqueUnit.ice
-	units/HandUnitInterface.ice
-	units/HapticUnit.ice
-	units/HeadIKUnit.ice
-	units/KinematicUnitInterface.ice
-	units/PlatformUnitInterface.ice
-	units/TCPControlUnit.ice
-	units/TCPMoverUnitInterface.ice
-	units/UnitInterface.ice
+    units/ForceTorqueUnit.ice
+    units/HandUnitInterface.ice
+    units/HapticUnit.ice
+    units/HeadIKUnit.ice
+    units/KinematicUnitInterface.ice
+    units/PlatformUnitInterface.ice
+    units/TCPControlUnit.ice
+    units/TCPMoverUnitInterface.ice
+    units/UnitInterface.ice
 )
 
 # generate the interface library
diff --git a/source/RobotAPI/motioncontrol/CMakeLists.txt b/source/RobotAPI/motioncontrol/CMakeLists.txt
index 9abf0ef3d4b0880fd0430b8ff887bd93d8c3f386..2d1b702d342ec483758c64d00c058bb297f229a5 100644
--- a/source/RobotAPI/motioncontrol/CMakeLists.txt
+++ b/source/RobotAPI/motioncontrol/CMakeLists.txt
@@ -17,7 +17,7 @@ set(LIB_NAME       MotionControl)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPICore RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreObservers ${Simox_LIBRARIES})
+set(LIBS RobotAPICore ArmarXCore ArmarXCoreObservers ${Simox_LIBRARIES})
 
 set(LIB_FILES MotionControl.cpp
      ZeroForceControl.cpp)
diff --git a/source/RobotAPI/motioncontrol/MotionControl.h b/source/RobotAPI/motioncontrol/MotionControl.h
index f7a7139e0643cae44b17ce9c6e3ee659110a5f59..2dd72eb8871821a377bdd31d104fa242d82edc1a 100644
--- a/source/RobotAPI/motioncontrol/MotionControl.h
+++ b/source/RobotAPI/motioncontrol/MotionControl.h
@@ -385,8 +385,8 @@ namespace MotionControl
         std::string virtualPrismaticJointName;
     };
 
-} // namespace MotionControl
+}
 
-} // namespace armarx
+}
 
-#endif // MOTIONCONTROL_H
+#endif
diff --git a/source/RobotAPI/operations/CMakeLists.txt b/source/RobotAPI/operations/CMakeLists.txt
index d2dd659041782da3466a6c89d1f0b78e02e971a8..3c2cce08c190726aafe66c219d9f8d65ebee8a54 100644
--- a/source/RobotAPI/operations/CMakeLists.txt
+++ b/source/RobotAPI/operations/CMakeLists.txt
@@ -13,7 +13,7 @@ set(LIB_NAME       RobotAPIOperations)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreStatechart ArmarXCoreObservers )
+set(LIBS RobotAPIUnits ArmarXCoreStatechart ArmarXCoreObservers)
 
 set(LIB_FILES RobotControl.cpp)
 set(LIB_HEADERS RobotControl.h)
diff --git a/source/RobotAPI/robotstate/CMakeLists.txt b/source/RobotAPI/robotstate/CMakeLists.txt
index 1e588b1dc60c633b85df672b2632ba8e6d8e2bf9..e4c185dd8337f93acb01113ea984b10096bd8544 100644
--- a/source/RobotAPI/robotstate/CMakeLists.txt
+++ b/source/RobotAPI/robotstate/CMakeLists.txt
@@ -1,5 +1,5 @@
-
 armarx_set_target("Core Library: ArmarXCoreRobotStateComponent")
+
 find_package(Eigen3 QUIET)
 find_package(Simox 2.3.0 QUIET)
 
@@ -13,8 +13,7 @@ set(LIB_NAME       RobotAPIRobotStateComponent)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS ArmarXInterfaces RobotAPIRemoteRobot 
-    ArmarXCore)
+set(LIBS RobotAPIRemoteRobot ArmarXCore)
 
 set(LIB_FILES
         RobotStateComponent.cpp
diff --git a/source/RobotAPI/robotstate/SharedRobotServants.h b/source/RobotAPI/robotstate/SharedRobotServants.h
index c0c78cf0221a72f24417280e8151aeccf76da0a1..d73756d0ac81542dfcfd681f01ab67424cab21e1 100644
--- a/source/RobotAPI/robotstate/SharedRobotServants.h
+++ b/source/RobotAPI/robotstate/SharedRobotServants.h
@@ -18,7 +18,7 @@ namespace armarx {
 
     /**
      * @brief The base class for remote objects on the ice server
-     * 
+     *
      */
 
     class SharedObjectBase :
@@ -80,7 +80,7 @@ namespace armarx {
      * @brief The SharedRobotNodeServant class is a remote represenation of a Simox VirtualRobot::Robot
      *
      * @details This class is used only internally by the the RobotStateComponent. The RemoteRobot class SharedRobotInterface and SharedRobotInterfacePrx
-     * classes generated by ICE.
+     * classes generated by Ice.
      */
 
     class   SharedRobotServant :
diff --git a/source/RobotAPI/robotstate/remote/CMakeLists.txt b/source/RobotAPI/robotstate/remote/CMakeLists.txt
index 8540a5d250ede4b1a15bb53c14900b1faeb8795e..5fc457af89b2578bc874cbd5eeb8857dcfdeef1e 100644
--- a/source/RobotAPI/robotstate/remote/CMakeLists.txt
+++ b/source/RobotAPI/robotstate/remote/CMakeLists.txt
@@ -15,8 +15,7 @@ set(LIB_NAME       RobotAPIRemoteRobot)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS ArmarXInterfaces ArmarXCore ArmarXCoreObservers RobotAPIInterfaces
-    ${Simox_LIBRARIES} )
+set(LIBS ArmarXCore ArmarXCoreObservers RobotAPIInterfaces ${Simox_LIBRARIES} )
 
 set(LIB_FILES ArmarPose.cpp
             LinkedPose.cpp
diff --git a/source/RobotAPI/statecharts/GraspingWithTorques/CMakeLists.txt b/source/RobotAPI/statecharts/GraspingWithTorques/CMakeLists.txt
index 3f4d1563f2e9ad7ff3fa6cf95ad8183c69ca3fc0..62eb4d0ceb609395d938c49797cc634424f64e6a 100644
--- a/source/RobotAPI/statecharts/GraspingWithTorques/CMakeLists.txt
+++ b/source/RobotAPI/statecharts/GraspingWithTorques/CMakeLists.txt
@@ -1,6 +1,5 @@
 armarx_set_target("RobotAPI Library: GraspingWithTorques")
 
-
 find_package(Eigen3 QUIET)
 find_package(Simox QUIET)
 
@@ -17,7 +16,7 @@ set(LIB_NAME       GraspingWithTorques)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPICore RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreObservers)
+set(LIBS RobotAPICore ArmarXCoreObservers ${Simox_LIBRARIES})
 
 set(LIB_FILES GraspingWithTorques.cpp
      )
diff --git a/source/RobotAPI/statecharts/MovePlatform/CMakeLists.txt b/source/RobotAPI/statecharts/MovePlatform/CMakeLists.txt
index 4934e7fa089906cf3ae41eb6c2cac1d07af1972d..f74bc9ecc73f1afc85f8cc9c43f6971bb1bd4eac 100644
--- a/source/RobotAPI/statecharts/MovePlatform/CMakeLists.txt
+++ b/source/RobotAPI/statecharts/MovePlatform/CMakeLists.txt
@@ -17,13 +17,13 @@ set(LIB_NAME       MovePlatform)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPICore RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreObservers)
+set(LIBS RobotAPICore ArmarXCoreObservers)
 
 set(LIB_FILES MovePlatform.cpp
      )
-set(LIB_HEADERS 
-	MovePlatform.h
-	PlatformContext.h
+set(LIB_HEADERS
+    MovePlatform.h
+    PlatformContext.h
 )
 
 armarx_add_library("${LIB_NAME}" "${LIB_VERSION}" "${LIB_SOVERSION}" "${LIB_FILES}" "${LIB_HEADERS}" "${LIBS}")
diff --git a/source/RobotAPI/statecharts/MovePlatformToLandmark/CMakeLists.txt b/source/RobotAPI/statecharts/MovePlatformToLandmark/CMakeLists.txt
index 7fced92f0d26c62ffeff3cccaca49c625941b2a6..d90432f954c7c76dbbb81b534b3ad7aed8f328d8 100644
--- a/source/RobotAPI/statecharts/MovePlatformToLandmark/CMakeLists.txt
+++ b/source/RobotAPI/statecharts/MovePlatformToLandmark/CMakeLists.txt
@@ -17,12 +17,12 @@ set(LIB_NAME       MovePlatformToLandmark)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPIRobotStateComponent RobotAPICore RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreObservers)
+set(LIBS RobotAPIRobotStateComponent RobotAPICore ArmarXCoreObservers)
 
 set(LIB_FILES MovePlatformToLandmark.cpp
      )
-set(LIB_HEADERS 
-	MovePlatformToLandmark.h
+set(LIB_HEADERS
+    MovePlatformToLandmark.h
 )
 
 armarx_add_library("${LIB_NAME}" "${LIB_VERSION}" "${LIB_SOVERSION}" "${LIB_FILES}" "${LIB_HEADERS}" "${LIBS}")
diff --git a/source/RobotAPI/statecharts/MovePlatformToLandmark/MovePlatformToLandmark.cpp b/source/RobotAPI/statecharts/MovePlatformToLandmark/MovePlatformToLandmark.cpp
index 072d1177ab6e7d4c70c2cd1755cb21b434aae06e..206f5cc1261e3134e07deb17d721e5acce1ce303 100644
--- a/source/RobotAPI/statecharts/MovePlatformToLandmark/MovePlatformToLandmark.cpp
+++ b/source/RobotAPI/statecharts/MovePlatformToLandmark/MovePlatformToLandmark.cpp
@@ -23,16 +23,16 @@
 */
 
 #include "MovePlatformToLandmark.h"
-//#include "../core/RobotStatechartContext.h"
 
-#include <Core/observers/variant/ChannelRef.h>
-#include <Core/observers/variant/SingleTypeVariantList.h>
 #include <RobotAPI/robotstate/remote/ArmarPose.h>
-#include <Core/core/ManagedIceObject.h>
 #include <RobotAPI/robotstate/remote/RobotStateObjectFactories.h>
+#include <RobotAPI/interface/units/PlatformUnitInterface.h>
+
+#include <Core/core/ManagedIceObject.h>
 #include <Core/core/CoreObjectFactories.h>
+#include <Core/observers/variant/ChannelRef.h>
+#include <Core/observers/variant/SingleTypeVariantList.h>
 #include <Core/observers/ObserverObjectFactories.h>
-#include <RobotAPI/interface/units/PlatformUnitInterface.h>
 
 #include <boost/algorithm/string.hpp>
 
diff --git a/source/RobotAPI/statecharts/MovePlatformToLandmark/MovePlatformToLandmark.h b/source/RobotAPI/statecharts/MovePlatformToLandmark/MovePlatformToLandmark.h
index 85b4a5d0d3fc4d4f67c74863f668919c8d5ddd6f..b5bd933c4bf5dd4ffdb34b720eddba86675aacb0 100644
--- a/source/RobotAPI/statecharts/MovePlatformToLandmark/MovePlatformToLandmark.h
+++ b/source/RobotAPI/statecharts/MovePlatformToLandmark/MovePlatformToLandmark.h
@@ -24,8 +24,8 @@
 #ifndef ARMARX_COMPONENT_MOVE_PLATFORM_TO_LANDMARK_H
 #define ARMARX_COMPONENT_MOVE_PLATFORM_TO_LANDMARK_H
 
-#include <Core/statechart/Statechart.h>
 #include <RobotAPI/statecharts/MovePlatform/PlatformContext.h>
+#include <Core/statechart/Statechart.h>
 
 /*
 * This statechart is meant to bridge the gap between a user verbally specifying a target location (i.e. fridge, table, ...)
diff --git a/source/RobotAPI/statecharts/OpenHand/CMakeLists.txt b/source/RobotAPI/statecharts/OpenHand/CMakeLists.txt
index b049ee78d1a4eb4483ae1a1de14eee4f3f15c930..61b37547f5b78930e6f6c7109ce170bbdd425f52 100644
--- a/source/RobotAPI/statecharts/OpenHand/CMakeLists.txt
+++ b/source/RobotAPI/statecharts/OpenHand/CMakeLists.txt
@@ -16,7 +16,7 @@ set(LIB_NAME       OpenHand)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPICore RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreObservers)
+set(LIBS RobotAPICore ArmarXCoreObservers)
 
 set(LIB_FILES OpenHand.cpp
      )
diff --git a/source/RobotAPI/statecharts/OpenHand/OpenHand.cpp b/source/RobotAPI/statecharts/OpenHand/OpenHand.cpp
index b448a387479668bfba263108f96e3a15991e3118..46d23d1af7f553d1a6f6d98f7f409d34027cc0f0 100644
--- a/source/RobotAPI/statecharts/OpenHand/OpenHand.cpp
+++ b/source/RobotAPI/statecharts/OpenHand/OpenHand.cpp
@@ -23,25 +23,25 @@
 */
 
 #include "OpenHand.h"
-//#include "Armar3GraspContext.h"   //MP: Maybe necessary again later?
 #include "../../core/RobotStatechartContext.h"
 
+#include <RobotAPI/robotstate/remote/ArmarPose.h>
+#include <RobotAPI/interface/units/KinematicUnitInterface.h>
+#include <RobotAPI/core/RobotStatechartContext.h>
+
+
 #include <Core/observers/variant/ChannelRef.h>
 #include <Core/observers/variant/SingleTypeVariantList.h>
-#include <RobotAPI/robotstate/remote/ArmarPose.h>
+
 #include <VirtualRobot/IK/DifferentialIK.h>
 #include <VirtualRobot/Robot.h>
 
-#include <RobotAPI/interface/units/KinematicUnitInterface.h>
-
-#include <RobotAPI/core/RobotStatechartContext.h>
-
 namespace armarx
 {
     // ****************************************************************
     // Implementation of StatechartOpenHand
     // ****************************************************************
-    void StatechartOpenHand::defineParameters()     //(OK)TODO: Anpassen!
+    void StatechartOpenHand::defineParameters()
     {
         //openHand settings:
         addToInput("jointAnglesOpenHand", VariantType::List(VariantType::Float), false);
@@ -55,7 +55,7 @@ namespace armarx
 
     }
 
-    void StatechartOpenHand::defineSubstates()     //(OK)TODO: Anpassen!
+    void StatechartOpenHand::defineSubstates()
     {
         StatePtr stateOpenHand = addState<StateOpenHand>("stateOpenHand");
         StatePtr stateSuccess = addState<SuccessState>("stateSuccess");
@@ -75,7 +75,7 @@ namespace armarx
 
     }
 
-    void StatechartOpenHand::onEnter()     //TODO: Anpassen! ???
+    void StatechartOpenHand::onEnter()
     {
         ARMARX_LOG << eINFO << "Entering StatechartOpenHand";
 
@@ -111,7 +111,7 @@ namespace armarx
     // Implementation of StateOpenHand
     // ****************************************************************
 
-    void StateOpenHand::defineParameters()      //(OK)TODO: Anpassen!
+    void StateOpenHand::defineParameters()
     {
         addToInput("jointAnglesOpenHand", VariantType::List(VariantType::Float), false);
         addToInput("timeoutOpenHandSuccess", VariantType::Float, false);
@@ -120,7 +120,7 @@ namespace armarx
         //addToInput("useTorquesForGrasping", VariantType::Int, false);
     }
 
-    void StateOpenHand::onEnter()      //(OK)TODO: Anpassen!
+    void StateOpenHand::onEnter()
     {
         ARMARX_LOG << eIMPORTANT << "Entering StateOpenHand";
 
@@ -150,7 +150,7 @@ namespace armarx
         ARMARX_LOG << eINFO << "StateOpenHand: Done onEnter()";
     }
 
-    void StateOpenHand::onExit()      //(OK)TODO: Anpassen!
+    void StateOpenHand::onExit()
     {
         removeTimeoutEvent(condOpenHandSuccessTimeout);
         removeTimeoutEvent(condOpenHandDummyFailureTimeout);
diff --git a/source/RobotAPI/statecharts/OpenHand/OpenHand.h b/source/RobotAPI/statecharts/OpenHand/OpenHand.h
index 617c07165598c951f03025191739e022b6ea1e19..3fb167f12847b5f0365a654d49034a00822923c4 100644
--- a/source/RobotAPI/statecharts/OpenHand/OpenHand.h
+++ b/source/RobotAPI/statecharts/OpenHand/OpenHand.h
@@ -48,11 +48,9 @@ namespace armarx
         void defineSubstates();
         void onEnter();
         void onExit();
-
     };
 
 
-
     // ****************************************************************
     // Definition of StateOpenHand
     // ****************************************************************
@@ -71,14 +69,6 @@ namespace armarx
         StateUtility::ActionEventIdentifier condOpenHandDummyFailureTimeout;
     };
 
-
-
-
-
-
-
-
-
 }
 
 #endif
diff --git a/source/RobotAPI/statecharts/PlaceObject/CMakeLists.txt b/source/RobotAPI/statecharts/PlaceObject/CMakeLists.txt
index 6a81c9bd881778d0ef244aefbbedcfb29f4a25da..86e2a1bc709c782e3684ca560cd5c5f54200e36a 100644
--- a/source/RobotAPI/statecharts/PlaceObject/CMakeLists.txt
+++ b/source/RobotAPI/statecharts/PlaceObject/CMakeLists.txt
@@ -16,7 +16,7 @@ set(LIB_NAME       PlaceObject)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPICore RobotAPIInterfaces ArmarXInterfaces ArmarXCore ArmarXCoreObservers)
+set(LIBS RobotAPICore ArmarXCoreObservers)
 
 set(LIB_FILES PlaceObject.cpp
      )
diff --git a/source/RobotAPI/statecharts/PlaceObject/PlaceObject.cpp b/source/RobotAPI/statecharts/PlaceObject/PlaceObject.cpp
index 1c6913acb134a5d1c65a1e7df8d7d23653a4f5e5..dd11b2bcb398939c9144b3ec45ca8a108e02ca72 100644
--- a/source/RobotAPI/statecharts/PlaceObject/PlaceObject.cpp
+++ b/source/RobotAPI/statecharts/PlaceObject/PlaceObject.cpp
@@ -16,7 +16,7 @@
 *
 * @package    RobotAPI::PlaceObject
 * @author     Nikolaus Vahrenkamp
-* @date       2014 
+* @date       2014
 
 * @copyright  http://www.gnu.org/licenses/gpl.txt
 *             GNU General Public License
@@ -25,16 +25,17 @@
 #include "PlaceObject.h"
 #include "../../core/RobotStatechartContext.h"
 
-#include <Core/observers/variant/ChannelRef.h>
-#include <Core/observers/variant/SingleTypeVariantList.h>
+#include <RobotAPI/interface/units/KinematicUnitInterface.h>
+#include <RobotAPI/core/RobotStatechartContext.h>
 #include <RobotAPI/robotstate/remote/ArmarPose.h>
 #include <RobotAPI/robotstate/remote/RemoteRobot.h>
+
+#include <Core/observers/variant/ChannelRef.h>
+#include <Core/observers/variant/SingleTypeVariantList.h>
+
 #include <VirtualRobot/IK/DifferentialIK.h>
 #include <VirtualRobot/Robot.h>
 
-#include <RobotAPI/interface/units/KinematicUnitInterface.h>
-
-#include <RobotAPI/core/RobotStatechartContext.h>
 
 namespace armarx
 {
@@ -46,7 +47,7 @@ namespace armarx
         addToInput("maxHeightToMoveDown", VariantType::Float, false);
         addToInput("minForceForSuccess", VariantType::Float, false);
         addToInput("timeoutPlaceObject", VariantType::Int, false);
- 
+
         addToInput("robotNodeSetName", VariantType::String, false);
         addToInput("robotBaseFrame", VariantType::String, false);
 
diff --git a/source/RobotAPI/units/CMakeLists.txt b/source/RobotAPI/units/CMakeLists.txt
index 60886e13236228dc2b8edb7daba9754ad33b80e9..7efcac50389d11cf09fabd06cb9b405cdea84ecb 100644
--- a/source/RobotAPI/units/CMakeLists.txt
+++ b/source/RobotAPI/units/CMakeLists.txt
@@ -13,18 +13,16 @@ if (Eigen3_FOUND AND Simox_FOUND)
         ${Simox_INCLUDE_DIRS})
 endif()
 
-
 set(LIB_NAME       RobotAPIUnits)
 set(LIB_VERSION    0.1.0)
 set(LIB_SOVERSION  0)
 
-set(LIBS RobotAPIInterfaces 
-         RobotAPICore 
-         ArmarXInterfaces 
-         ArmarXCore 
-         ArmarXCoreObservers 
-         ArmarXCoreEigen3Variants 
-         RobotAPIRemoteRobot  ${Simox_LIBRARIES})
+set(LIBS
+    RobotAPICore
+    RobotAPIRemoteRobot
+    ArmarXCoreObservers
+    ArmarXCoreEigen3Variants
+    ${Simox_LIBRARIES})
 
 set(LIB_HEADERS
     ForceTorqueObserver.h