diff --git a/modules/catkin_ws/src/car/CMakeLists.txt b/modules/catkin_ws/src/car/CMakeLists.txt
index 529d1068e0689c1e6b9a69a145fc9f7788879563..71ddbfac629d8c7385625692e143027d876bddbd 100644
--- a/modules/catkin_ws/src/car/CMakeLists.txt
+++ b/modules/catkin_ws/src/car/CMakeLists.txt
@@ -76,7 +76,7 @@ set(MAIN_NODE_SOURCE_FILES
         ${PLATOON_PROTOCOL_DIR_SOURCE_FILES}
         ${PC2CAR_SOURCE_FILES}
         src/mainNode/mainNode.cpp
-        include/mainNode/mainNode.h)
+        include/mainNode/mainNode.h include/mainNode/PlatoonController.h src/mainNode/PlatoonController.cpp)
 
 find_package(catkin REQUIRED COMPONENTS
   roscpp
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/Makefile2 b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/Makefile2
index 1d3054611ae55fb955695a25ab8ea441ca2c775b..96f28eb1b54493185ccc7ffb7749b595b76d7c1c 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/Makefile2
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/Makefile2
@@ -91,7 +91,7 @@ CMakeFiles/ultrasonic.dir/all: CMakeFiles/bond_generate_messages_cpp.dir/all
 CMakeFiles/ultrasonic.dir/all: CMakeFiles/car_generate_messages_cpp.dir/all
 	$(MAKE) -f CMakeFiles/ultrasonic.dir/build.make CMakeFiles/ultrasonic.dir/depend
 	$(MAKE) -f CMakeFiles/ultrasonic.dir/build.make CMakeFiles/ultrasonic.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=66,67 "Built target ultrasonic"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=69,70 "Built target ultrasonic"
 .PHONY : CMakeFiles/ultrasonic.dir/all
 
 # Include target in all.
@@ -136,7 +136,7 @@ CMakeFiles/car_generate_messages_py.dir/all: CMakeFiles/_car_generate_messages_c
 CMakeFiles/car_generate_messages_py.dir/all: CMakeFiles/_car_generate_messages_check_deps_camDataMsg.dir/all
 	$(MAKE) -f CMakeFiles/car_generate_messages_py.dir/build.make CMakeFiles/car_generate_messages_py.dir/depend
 	$(MAKE) -f CMakeFiles/car_generate_messages_py.dir/build.make CMakeFiles/car_generate_messages_py.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=37,38,39,40,41,42,43,44,45 "Built target car_generate_messages_py"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=39,40,41,42,43,44,45,46,47 "Built target car_generate_messages_py"
 .PHONY : CMakeFiles/car_generate_messages_py.dir/all
 
 # Build rule for subdir invocation for target.
@@ -373,7 +373,7 @@ CMakeFiles/car_generate_messages_nodejs.dir/all: CMakeFiles/_car_generate_messag
 CMakeFiles/car_generate_messages_nodejs.dir/all: CMakeFiles/_car_generate_messages_check_deps_camDataMsg.dir/all
 	$(MAKE) -f CMakeFiles/car_generate_messages_nodejs.dir/build.make CMakeFiles/car_generate_messages_nodejs.dir/depend
 	$(MAKE) -f CMakeFiles/car_generate_messages_nodejs.dir/build.make CMakeFiles/car_generate_messages_nodejs.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=29,30,31,32,33,34,35,36 "Built target car_generate_messages_nodejs"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=31,32,33,34,35,36,37,38 "Built target car_generate_messages_nodejs"
 .PHONY : CMakeFiles/car_generate_messages_nodejs.dir/all
 
 # Build rule for subdir invocation for target.
@@ -462,7 +462,7 @@ CMakeFiles/environment.dir/all: CMakeFiles/bond_generate_messages_cpp.dir/all
 CMakeFiles/environment.dir/all: CMakeFiles/car_generate_messages_cpp.dir/all
 	$(MAKE) -f CMakeFiles/environment.dir/build.make CMakeFiles/environment.dir/depend
 	$(MAKE) -f CMakeFiles/environment.dir/build.make CMakeFiles/environment.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=46,47 "Built target environment"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=48,49 "Built target environment"
 .PHONY : CMakeFiles/environment.dir/all
 
 # Include target in all.
@@ -652,7 +652,7 @@ CMakeFiles/main_node.dir/all: CMakeFiles/bond_generate_messages_cpp.dir/all
 CMakeFiles/main_node.dir/all: CMakeFiles/car_generate_messages_cpp.dir/all
 	$(MAKE) -f CMakeFiles/main_node.dir/build.make CMakeFiles/main_node.dir/depend
 	$(MAKE) -f CMakeFiles/main_node.dir/build.make CMakeFiles/main_node.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=52,53,54,55,56,57,58,59,60,61,62,63,64,65 "Built target main_node"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=54,55,56,57,58,59,60,61,62,63,64,65,66,67,68 "Built target main_node"
 .PHONY : CMakeFiles/main_node.dir/all
 
 # Include target in all.
@@ -662,7 +662,7 @@ all: CMakeFiles/main_node.dir/all
 
 # Build rule for subdir invocation for target.
 CMakeFiles/main_node.dir/rule: cmake_check_build_system
-	$(CMAKE_COMMAND) -E cmake_progress_start "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" 22
+	$(CMAKE_COMMAND) -E cmake_progress_start "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" 23
 	$(MAKE) -f CMakeFiles/Makefile2 CMakeFiles/main_node.dir/all
 	$(CMAKE_COMMAND) -E cmake_progress_start "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" 0
 .PHONY : CMakeFiles/main_node.dir/rule
@@ -1162,7 +1162,7 @@ CMakeFiles/camera.dir/all: CMakeFiles/bond_generate_messages_cpp.dir/all
 CMakeFiles/camera.dir/all: CMakeFiles/car_generate_messages_cpp.dir/all
 	$(MAKE) -f CMakeFiles/camera.dir/build.make CMakeFiles/camera.dir/depend
 	$(MAKE) -f CMakeFiles/camera.dir/build.make CMakeFiles/camera.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num= "Built target camera"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=4,5 "Built target camera"
 .PHONY : CMakeFiles/camera.dir/all
 
 # Include target in all.
@@ -1172,7 +1172,7 @@ all: CMakeFiles/camera.dir/all
 
 # Build rule for subdir invocation for target.
 CMakeFiles/camera.dir/rule: cmake_check_build_system
-	$(CMAKE_COMMAND) -E cmake_progress_start "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" 8
+	$(CMAKE_COMMAND) -E cmake_progress_start "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" 10
 	$(MAKE) -f CMakeFiles/Makefile2 CMakeFiles/camera.dir/all
 	$(CMAKE_COMMAND) -E cmake_progress_start "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" 0
 .PHONY : CMakeFiles/camera.dir/rule
@@ -1792,7 +1792,7 @@ CMakeFiles/car_generate_messages_cpp.dir/all: CMakeFiles/_car_generate_messages_
 CMakeFiles/car_generate_messages_cpp.dir/all: CMakeFiles/_car_generate_messages_check_deps_camDataMsg.dir/all
 	$(MAKE) -f CMakeFiles/car_generate_messages_cpp.dir/build.make CMakeFiles/car_generate_messages_cpp.dir/depend
 	$(MAKE) -f CMakeFiles/car_generate_messages_cpp.dir/build.make CMakeFiles/car_generate_messages_cpp.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=4,5,6,7,8,9,10,11 "Built target car_generate_messages_cpp"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=6,7,8,9,10,11,12,13 "Built target car_generate_messages_cpp"
 .PHONY : CMakeFiles/car_generate_messages_cpp.dir/all
 
 # Build rule for subdir invocation for target.
@@ -1864,7 +1864,7 @@ CMakeFiles/car_generate_messages_eus.dir/all: CMakeFiles/_car_generate_messages_
 CMakeFiles/car_generate_messages_eus.dir/all: CMakeFiles/_car_generate_messages_check_deps_camDataMsg.dir/all
 	$(MAKE) -f CMakeFiles/car_generate_messages_eus.dir/build.make CMakeFiles/car_generate_messages_eus.dir/depend
 	$(MAKE) -f CMakeFiles/car_generate_messages_eus.dir/build.make CMakeFiles/car_generate_messages_eus.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=12,13,14,15,16,17,18,19,20 "Built target car_generate_messages_eus"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=14,15,16,17,18,19,20,21,22 "Built target car_generate_messages_eus"
 .PHONY : CMakeFiles/car_generate_messages_eus.dir/all
 
 # Build rule for subdir invocation for target.
@@ -1904,7 +1904,7 @@ CMakeFiles/car_generate_messages_lisp.dir/all: CMakeFiles/_car_generate_messages
 CMakeFiles/car_generate_messages_lisp.dir/all: CMakeFiles/_car_generate_messages_check_deps_camDataMsg.dir/all
 	$(MAKE) -f CMakeFiles/car_generate_messages_lisp.dir/build.make CMakeFiles/car_generate_messages_lisp.dir/depend
 	$(MAKE) -f CMakeFiles/car_generate_messages_lisp.dir/build.make CMakeFiles/car_generate_messages_lisp.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=21,22,23,24,25,26,27,28 "Built target car_generate_messages_lisp"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=23,24,25,26,27,28,29,30 "Built target car_generate_messages_lisp"
 .PHONY : CMakeFiles/car_generate_messages_lisp.dir/all
 
 # Build rule for subdir invocation for target.
@@ -1987,7 +1987,7 @@ gtest/preinstall:
 gtest/CMakeFiles/gtest_main.dir/all: gtest/CMakeFiles/gtest.dir/all
 	$(MAKE) -f gtest/CMakeFiles/gtest_main.dir/build.make gtest/CMakeFiles/gtest_main.dir/depend
 	$(MAKE) -f gtest/CMakeFiles/gtest_main.dir/build.make gtest/CMakeFiles/gtest_main.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=50,51 "Built target gtest_main"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=52,53 "Built target gtest_main"
 .PHONY : gtest/CMakeFiles/gtest_main.dir/all
 
 # Build rule for subdir invocation for target.
@@ -2019,7 +2019,7 @@ clean: gtest/CMakeFiles/gtest_main.dir/clean
 gtest/CMakeFiles/gtest.dir/all:
 	$(MAKE) -f gtest/CMakeFiles/gtest.dir/build.make gtest/CMakeFiles/gtest.dir/depend
 	$(MAKE) -f gtest/CMakeFiles/gtest.dir/build.make gtest/CMakeFiles/gtest.dir/build
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=48,49 "Built target gtest"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=50,51 "Built target gtest"
 .PHONY : gtest/CMakeFiles/gtest.dir/all
 
 # Build rule for subdir invocation for target.
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/DependInfo.cmake b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/DependInfo.cmake
index 19fab2149bf120962a1699d74b7373348dc4c117..239379f64e0320babc20141508c2ad97d9ebd544 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/DependInfo.cmake
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/DependInfo.cmake
@@ -1,7 +1,26 @@
 # The set of languages for which implicit dependencies are needed:
 set(CMAKE_DEPENDS_LANGUAGES
+  "CXX"
   )
 # The set of files for implicit dependencies of each language:
+set(CMAKE_DEPENDS_CHECK_CXX
+  "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/camera/camera.cpp" "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/src/camera/camera.cpp.o"
+  )
+set(CMAKE_CXX_COMPILER_ID "GNU")
+
+# Preprocessor definitions for this target.
+set(CMAKE_TARGET_DEFINITIONS_CXX
+  "ROSCONSOLE_BACKEND_LOG4CXX"
+  "ROS_PACKAGE_NAME=\"car\""
+  )
+
+# The include file search paths:
+set(CMAKE_CXX_TARGET_INCLUDE_PATH
+  "devel/include"
+  "../include"
+  "/opt/ros/kinetic/include"
+  "/opt/ros/kinetic/share/xmlrpcpp/cmake/../../../include/xmlrpcpp"
+  )
 
 # Targets to which this target links.
 set(CMAKE_TARGET_LINKED_INFO_FILES
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/build.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/build.make
index dbeb2910aa4a531203ece28b2336024730da8dd1..f4543f3a1418e9bdf17787b159a44185d3c3091b 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/build.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/build.make
@@ -57,7 +57,80 @@ include CMakeFiles/camera.dir/progress.make
 # Include the compile flags for this target's objects.
 include CMakeFiles/camera.dir/flags.make
 
-CMakeFiles/camera.dir/requires:
+CMakeFiles/camera.dir/src/camera/camera.cpp.o: CMakeFiles/camera.dir/flags.make
+CMakeFiles/camera.dir/src/camera/camera.cpp.o: ../src/camera/camera.cpp
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=$(CMAKE_PROGRESS_1) "Building CXX object CMakeFiles/camera.dir/src/camera/camera.cpp.o"
+	/usr/bin/c++  $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -o CMakeFiles/camera.dir/src/camera/camera.cpp.o -c "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/camera/camera.cpp"
+
+CMakeFiles/camera.dir/src/camera/camera.cpp.i: cmake_force
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green "Preprocessing CXX source to CMakeFiles/camera.dir/src/camera/camera.cpp.i"
+	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -E "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/camera/camera.cpp" > CMakeFiles/camera.dir/src/camera/camera.cpp.i
+
+CMakeFiles/camera.dir/src/camera/camera.cpp.s: cmake_force
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green "Compiling CXX source to assembly CMakeFiles/camera.dir/src/camera/camera.cpp.s"
+	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -S "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/camera/camera.cpp" -o CMakeFiles/camera.dir/src/camera/camera.cpp.s
+
+CMakeFiles/camera.dir/src/camera/camera.cpp.o.requires:
+
+.PHONY : CMakeFiles/camera.dir/src/camera/camera.cpp.o.requires
+
+CMakeFiles/camera.dir/src/camera/camera.cpp.o.provides: CMakeFiles/camera.dir/src/camera/camera.cpp.o.requires
+	$(MAKE) -f CMakeFiles/camera.dir/build.make CMakeFiles/camera.dir/src/camera/camera.cpp.o.provides.build
+.PHONY : CMakeFiles/camera.dir/src/camera/camera.cpp.o.provides
+
+CMakeFiles/camera.dir/src/camera/camera.cpp.o.provides.build: CMakeFiles/camera.dir/src/camera/camera.cpp.o
+
+
+# Object files for target camera
+camera_OBJECTS = \
+"CMakeFiles/camera.dir/src/camera/camera.cpp.o"
+
+# External object files for target camera
+camera_EXTERNAL_OBJECTS =
+
+devel/lib/libcamera.so: CMakeFiles/camera.dir/src/camera/camera.cpp.o
+devel/lib/libcamera.so: CMakeFiles/camera.dir/build.make
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/libnodeletlib.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/libbondcpp.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libuuid.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libtinyxml2.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/libclass_loader.so
+devel/lib/libcamera.so: /usr/lib/libPocoFoundation.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libdl.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/libroslib.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/librospack.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libpython2.7.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_program_options.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libtinyxml.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/libroscpp.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_filesystem.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_signals.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/librosconsole.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/librosconsole_log4cxx.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/librosconsole_backend_interface.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/liblog4cxx.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_regex.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/libxmlrpcpp.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/libroscpp_serialization.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/librostime.so
+devel/lib/libcamera.so: /opt/ros/kinetic/lib/libcpp_common.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_system.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_thread.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_chrono.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_date_time.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libboost_atomic.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libpthread.so
+devel/lib/libcamera.so: /usr/lib/x86_64-linux-gnu/libconsole_bridge.so
+devel/lib/libcamera.so: CMakeFiles/camera.dir/link.txt
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green --bold --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=$(CMAKE_PROGRESS_2) "Linking CXX shared library devel/lib/libcamera.so"
+	$(CMAKE_COMMAND) -E cmake_link_script CMakeFiles/camera.dir/link.txt --verbose=$(VERBOSE)
+
+# Rule to build all files generated by this target.
+CMakeFiles/camera.dir/build: devel/lib/libcamera.so
+
+.PHONY : CMakeFiles/camera.dir/build
+
+CMakeFiles/camera.dir/requires: CMakeFiles/camera.dir/src/camera/camera.cpp.o.requires
 
 .PHONY : CMakeFiles/camera.dir/requires
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/cmake_clean.cmake b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/cmake_clean.cmake
index 842dd3dae2ff2677f0f37e23fb46932df983827a..c07393a47b5616e791e262aedd2d9071f8a251e0 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/cmake_clean.cmake
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/cmake_clean.cmake
@@ -1,5 +1,10 @@
+file(REMOVE_RECURSE
+  "CMakeFiles/camera.dir/src/camera/camera.cpp.o"
+  "devel/lib/libcamera.pdb"
+  "devel/lib/libcamera.so"
+)
 
 # Per-language clean rules from dependency scanning.
-foreach(lang )
+foreach(lang CXX)
   include(CMakeFiles/camera.dir/cmake_clean_${lang}.cmake OPTIONAL)
 endforeach()
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/flags.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/flags.make
index bd7aaa21c4c7f5646c9a34e6a149a665082ed4ec..dee5f35256fc35ff0b54ac163d7847cdff0a742b 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/flags.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/flags.make
@@ -1,3 +1,10 @@
 # CMAKE generated file: DO NOT EDIT!
 # Generated by "Unix Makefiles" Generator, CMake Version 3.9
 
+# compile CXX with /usr/bin/c++
+CXX_FLAGS = -pthread -g -fPIC   -std=c++14
+
+CXX_DEFINES = -DROSCONSOLE_BACKEND_LOG4CXX -DROS_PACKAGE_NAME=\"car\" -Dcamera_EXPORTS
+
+CXX_INCLUDES = -I"/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/devel/include" -I"/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/include" -I/opt/ros/kinetic/include -I/opt/ros/kinetic/share/xmlrpcpp/cmake/../../../include/xmlrpcpp 
+
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/link.txt b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/link.txt
new file mode 100644
index 0000000000000000000000000000000000000000..a7e101f09ced65e44b508a6fd71559a66484123a
--- /dev/null
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/link.txt
@@ -0,0 +1 @@
+/usr/bin/c++ -fPIC -pthread -g  -shared -Wl,-soname,libcamera.so -o devel/lib/libcamera.so CMakeFiles/camera.dir/src/camera/camera.cpp.o -Wl,-rpath,/opt/ros/kinetic/lib: /opt/ros/kinetic/lib/libnodeletlib.so /opt/ros/kinetic/lib/libbondcpp.so -luuid -ltinyxml2 /opt/ros/kinetic/lib/libclass_loader.so -lPocoFoundation -ldl /opt/ros/kinetic/lib/libroslib.so /opt/ros/kinetic/lib/librospack.so -lpython2.7 -lboost_program_options -ltinyxml /opt/ros/kinetic/lib/libroscpp.so -lboost_filesystem -lboost_signals /opt/ros/kinetic/lib/librosconsole.so /opt/ros/kinetic/lib/librosconsole_log4cxx.so /opt/ros/kinetic/lib/librosconsole_backend_interface.so -llog4cxx -lboost_regex /opt/ros/kinetic/lib/libxmlrpcpp.so /opt/ros/kinetic/lib/libroscpp_serialization.so /opt/ros/kinetic/lib/librostime.so /opt/ros/kinetic/lib/libcpp_common.so -lboost_system -lboost_thread -lboost_chrono -lboost_date_time -lboost_atomic -lpthread -lconsole_bridge 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/progress.make
index 8b137891791fe96927ad78e64b0aad7bded08bdc..19ce96ee79209cb1256758487b084f3bf13432af 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/camera.dir/progress.make
@@ -1 +1,3 @@
+CMAKE_PROGRESS_1 = 4
+CMAKE_PROGRESS_2 = 5
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_cpp.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_cpp.dir/progress.make
index f1bc8c6543ae891cd9e2304eb2d4272b9532c89a..1480e3e82adf09715f843a022f9f573f2409824f 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_cpp.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_cpp.dir/progress.make
@@ -1,9 +1,9 @@
-CMAKE_PROGRESS_1 = 4
-CMAKE_PROGRESS_2 = 5
-CMAKE_PROGRESS_3 = 6
-CMAKE_PROGRESS_4 = 7
-CMAKE_PROGRESS_5 = 8
-CMAKE_PROGRESS_6 = 9
-CMAKE_PROGRESS_7 = 10
-CMAKE_PROGRESS_8 = 11
+CMAKE_PROGRESS_1 = 6
+CMAKE_PROGRESS_2 = 7
+CMAKE_PROGRESS_3 = 8
+CMAKE_PROGRESS_4 = 9
+CMAKE_PROGRESS_5 = 10
+CMAKE_PROGRESS_6 = 11
+CMAKE_PROGRESS_7 = 12
+CMAKE_PROGRESS_8 = 13
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_eus.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_eus.dir/progress.make
index 52d6eff6024a9b9db7010675314f5cb40ada1ca4..e6e724035688f59386ba278e50f672c970733828 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_eus.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_eus.dir/progress.make
@@ -1,10 +1,10 @@
-CMAKE_PROGRESS_1 = 12
-CMAKE_PROGRESS_2 = 13
-CMAKE_PROGRESS_3 = 14
-CMAKE_PROGRESS_4 = 15
-CMAKE_PROGRESS_5 = 16
-CMAKE_PROGRESS_6 = 17
-CMAKE_PROGRESS_7 = 18
-CMAKE_PROGRESS_8 = 19
-CMAKE_PROGRESS_9 = 20
+CMAKE_PROGRESS_1 = 14
+CMAKE_PROGRESS_2 = 15
+CMAKE_PROGRESS_3 = 16
+CMAKE_PROGRESS_4 = 17
+CMAKE_PROGRESS_5 = 18
+CMAKE_PROGRESS_6 = 19
+CMAKE_PROGRESS_7 = 20
+CMAKE_PROGRESS_8 = 21
+CMAKE_PROGRESS_9 = 22
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_lisp.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_lisp.dir/progress.make
index f6749fd4dcd7f7eb61ce2a29406a9e198fdb4355..fc4f7551ab50c227b32206af29c515bcc0306905 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_lisp.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_lisp.dir/progress.make
@@ -1,9 +1,9 @@
-CMAKE_PROGRESS_1 = 21
-CMAKE_PROGRESS_2 = 22
-CMAKE_PROGRESS_3 = 23
-CMAKE_PROGRESS_4 = 24
-CMAKE_PROGRESS_5 = 25
-CMAKE_PROGRESS_6 = 26
-CMAKE_PROGRESS_7 = 27
-CMAKE_PROGRESS_8 = 28
+CMAKE_PROGRESS_1 = 23
+CMAKE_PROGRESS_2 = 24
+CMAKE_PROGRESS_3 = 25
+CMAKE_PROGRESS_4 = 26
+CMAKE_PROGRESS_5 = 27
+CMAKE_PROGRESS_6 = 28
+CMAKE_PROGRESS_7 = 29
+CMAKE_PROGRESS_8 = 30
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_nodejs.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_nodejs.dir/progress.make
index 0b2682adf30025e8fbe2980b96720726d405803c..87b42695a8d68e2e4fef0eef3bae4953ff98650c 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_nodejs.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_nodejs.dir/progress.make
@@ -1,9 +1,9 @@
-CMAKE_PROGRESS_1 = 29
-CMAKE_PROGRESS_2 = 30
-CMAKE_PROGRESS_3 = 31
-CMAKE_PROGRESS_4 = 32
-CMAKE_PROGRESS_5 = 33
-CMAKE_PROGRESS_6 = 34
-CMAKE_PROGRESS_7 = 35
-CMAKE_PROGRESS_8 = 36
+CMAKE_PROGRESS_1 = 31
+CMAKE_PROGRESS_2 = 32
+CMAKE_PROGRESS_3 = 33
+CMAKE_PROGRESS_4 = 34
+CMAKE_PROGRESS_5 = 35
+CMAKE_PROGRESS_6 = 36
+CMAKE_PROGRESS_7 = 37
+CMAKE_PROGRESS_8 = 38
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_py.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_py.dir/progress.make
index ba8bcb991dca332f32275b8fb0fba724a113ca79..17edbae36f56ee00979ac47776b93277514072ed 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_py.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/car_generate_messages_py.dir/progress.make
@@ -1,10 +1,10 @@
-CMAKE_PROGRESS_1 = 37
-CMAKE_PROGRESS_2 = 38
-CMAKE_PROGRESS_3 = 39
-CMAKE_PROGRESS_4 = 40
-CMAKE_PROGRESS_5 = 41
-CMAKE_PROGRESS_6 = 42
-CMAKE_PROGRESS_7 = 43
-CMAKE_PROGRESS_8 = 44
-CMAKE_PROGRESS_9 = 45
+CMAKE_PROGRESS_1 = 39
+CMAKE_PROGRESS_2 = 40
+CMAKE_PROGRESS_3 = 41
+CMAKE_PROGRESS_4 = 42
+CMAKE_PROGRESS_5 = 43
+CMAKE_PROGRESS_6 = 44
+CMAKE_PROGRESS_7 = 45
+CMAKE_PROGRESS_8 = 46
+CMAKE_PROGRESS_9 = 47
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/clion-log.txt b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/clion-log.txt
index 44f9aed1ccb8734cf090d9a6b60dc26eed9b80dc..e6484adc84a814128a1047c1a5c4e9072508d759 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/clion-log.txt
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/clion-log.txt
@@ -21,16 +21,5 @@
 --   system
 -- car: 8 messages, 0 services
 -- Configuring done
-CMake Error at CMakeLists.txt:140 (add_library):
-  Cannot find source file:
-
-    src/camera/camera.cpp
-
-  Tried extensions .c .C .c++ .cc .cpp .cxx .m .M .mm .h .hh .h++ .hm .hpp
-  .hxx .in .txx
-
-
-CMake Error: CMake can not determine linker language for target: camera
-CMake Error: Cannot determine link language for target "camera".
 -- Generating done
 -- Build files have been written to: /home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/environment.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/environment.dir/progress.make
index 80ac6c176b9915a974324451b4357740823f4252..961e1cad8a491d6eab4b1b2fbea140b4981d8bfc 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/environment.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/environment.dir/progress.make
@@ -1,3 +1,3 @@
-CMAKE_PROGRESS_1 = 46
-CMAKE_PROGRESS_2 = 47
+CMAKE_PROGRESS_1 = 48
+CMAKE_PROGRESS_2 = 49
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/DependInfo.cmake b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/DependInfo.cmake
index 8aef356cdac7404ac8bf7f1cac141d5e77b89ebe..1b5459c3d6c2b0621f0c62c5c0316a1bf6af19ee 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/DependInfo.cmake
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/DependInfo.cmake
@@ -16,6 +16,7 @@ set(CMAKE_DEPENDS_CHECK_CXX
   "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/Communication/PlatoonProtocol/src/Protocol.cpp" "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Protocol.cpp.o"
   "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/Communication/PlatoonProtocol/src/Vehicle.cpp" "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Vehicle.cpp.o"
   "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.cpp" "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.cpp.o"
+  "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/mainNode/PlatoonController.cpp" "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o"
   "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/mainNode/mainNode.cpp" "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o"
   )
 set(CMAKE_CXX_COMPILER_ID "GNU")
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/build.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/build.make
index 93811ae1eecda7fa257195e3357e1e612503f2da..5b5d75d1c0d5ad7d57a94b297781ba62626e0d92 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/build.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/build.make
@@ -369,6 +369,30 @@ CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o.provides: CMakeFiles/main_n
 CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o.provides.build: CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o
 
 
+CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o: CMakeFiles/main_node.dir/flags.make
+CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o: ../src/mainNode/PlatoonController.cpp
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=$(CMAKE_PROGRESS_14) "Building CXX object CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o"
+	/usr/bin/c++  $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -o CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o -c "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/mainNode/PlatoonController.cpp"
+
+CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.i: cmake_force
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green "Preprocessing CXX source to CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.i"
+	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -E "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/mainNode/PlatoonController.cpp" > CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.i
+
+CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.s: cmake_force
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green "Compiling CXX source to assembly CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.s"
+	/usr/bin/c++ $(CXX_DEFINES) $(CXX_INCLUDES) $(CXX_FLAGS) -S "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/mainNode/PlatoonController.cpp" -o CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.s
+
+CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o.requires:
+
+.PHONY : CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o.requires
+
+CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o.provides: CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o.requires
+	$(MAKE) -f CMakeFiles/main_node.dir/build.make CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o.provides.build
+.PHONY : CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o.provides
+
+CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o.provides.build: CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o
+
+
 # Object files for target main_node
 main_node_OBJECTS = \
 "CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Timer.cpp.o" \
@@ -383,7 +407,8 @@ main_node_OBJECTS = \
 "CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.cpp.o" \
 "CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Protocol.cpp.o" \
 "CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PC2Car/src/CommandReceiver.cpp.o" \
-"CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o"
+"CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o" \
+"CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o"
 
 # External object files for target main_node
 main_node_EXTERNAL_OBJECTS =
@@ -401,6 +426,7 @@ devel/lib/libmain_node.so: CMakeFiles/main_node.dir/home/philipp/hu/Hochautomati
 devel/lib/libmain_node.so: CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Protocol.cpp.o
 devel/lib/libmain_node.so: CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PC2Car/src/CommandReceiver.cpp.o
 devel/lib/libmain_node.so: CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o
+devel/lib/libmain_node.so: CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o
 devel/lib/libmain_node.so: CMakeFiles/main_node.dir/build.make
 devel/lib/libmain_node.so: /opt/ros/kinetic/lib/libnodeletlib.so
 devel/lib/libmain_node.so: /opt/ros/kinetic/lib/libbondcpp.so
@@ -434,7 +460,7 @@ devel/lib/libmain_node.so: /usr/lib/x86_64-linux-gnu/libboost_atomic.so
 devel/lib/libmain_node.so: /usr/lib/x86_64-linux-gnu/libpthread.so
 devel/lib/libmain_node.so: /usr/lib/x86_64-linux-gnu/libconsole_bridge.so
 devel/lib/libmain_node.so: CMakeFiles/main_node.dir/link.txt
-	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green --bold --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=$(CMAKE_PROGRESS_14) "Linking CXX shared library devel/lib/libmain_node.so"
+	@$(CMAKE_COMMAND) -E cmake_echo_color --switch=$(COLOR) --green --bold --progress-dir="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles" --progress-num=$(CMAKE_PROGRESS_15) "Linking CXX shared library devel/lib/libmain_node.so"
 	$(CMAKE_COMMAND) -E cmake_link_script CMakeFiles/main_node.dir/link.txt --verbose=$(VERBOSE)
 
 # Rule to build all files generated by this target.
@@ -455,6 +481,7 @@ CMakeFiles/main_node.dir/requires: CMakeFiles/main_node.dir/home/philipp/hu/Hoch
 CMakeFiles/main_node.dir/requires: CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Protocol.cpp.o.requires
 CMakeFiles/main_node.dir/requires: CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PC2Car/src/CommandReceiver.cpp.o.requires
 CMakeFiles/main_node.dir/requires: CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o.requires
+CMakeFiles/main_node.dir/requires: CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o.requires
 
 .PHONY : CMakeFiles/main_node.dir/requires
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/cmake_clean.cmake b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/cmake_clean.cmake
index f25944c64cfbd58653ed6e925e98e2ad492b423d..e9ad6ab1e0e5ad2355e3140475b71f1449d54d1b 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/cmake_clean.cmake
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/cmake_clean.cmake
@@ -12,6 +12,7 @@ file(REMOVE_RECURSE
   "CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Protocol.cpp.o"
   "CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PC2Car/src/CommandReceiver.cpp.o"
   "CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o"
+  "CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o"
   "devel/lib/libmain_node.pdb"
   "devel/lib/libmain_node.so"
 )
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/link.txt b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/link.txt
index 836d377bf640ca332b6b9f8675d9bd44ac62512a..fc9279aab1391089d84c04727d02916ba8b9e8fb 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/link.txt
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/link.txt
@@ -1 +1 @@
-/usr/bin/c++ -fPIC -pthread -g  -shared -Wl,-soname,libmain_node.so -o devel/lib/libmain_node.so CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Timer.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Time.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Networking.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Socket.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Stream.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Busyable.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/LeaderVehicle.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/FollowerVehicle.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Vehicle.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Protocol.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PC2Car/src/CommandReceiver.cpp.o CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o -Wl,-rpath,/opt/ros/kinetic/lib: /opt/ros/kinetic/lib/libnodeletlib.so /opt/ros/kinetic/lib/libbondcpp.so -luuid -ltinyxml2 /opt/ros/kinetic/lib/libclass_loader.so -lPocoFoundation -ldl /opt/ros/kinetic/lib/libroslib.so /opt/ros/kinetic/lib/librospack.so -lpython2.7 -lboost_program_options -ltinyxml /opt/ros/kinetic/lib/libroscpp.so -lboost_filesystem -lboost_signals /opt/ros/kinetic/lib/librosconsole.so /opt/ros/kinetic/lib/librosconsole_log4cxx.so /opt/ros/kinetic/lib/librosconsole_backend_interface.so -llog4cxx -lboost_regex /opt/ros/kinetic/lib/libxmlrpcpp.so /opt/ros/kinetic/lib/libroscpp_serialization.so /opt/ros/kinetic/lib/librostime.so /opt/ros/kinetic/lib/libcpp_common.so -lboost_system -lboost_thread -lboost_chrono -lboost_date_time -lboost_atomic -lpthread -lconsole_bridge 
+/usr/bin/c++ -fPIC -pthread -g  -shared -Wl,-soname,libmain_node.so -o devel/lib/libmain_node.so CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Timer.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Time.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Networking.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Socket.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Stream.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/NetworkingLib/src/Busyable.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/LeaderVehicle.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/FollowerVehicle.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Vehicle.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/Protocol.cpp.o CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PC2Car/src/CommandReceiver.cpp.o CMakeFiles/main_node.dir/src/mainNode/mainNode.cpp.o CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o -Wl,-rpath,/opt/ros/kinetic/lib: /opt/ros/kinetic/lib/libnodeletlib.so /opt/ros/kinetic/lib/libbondcpp.so -luuid -ltinyxml2 /opt/ros/kinetic/lib/libclass_loader.so -lPocoFoundation -ldl /opt/ros/kinetic/lib/libroslib.so /opt/ros/kinetic/lib/librospack.so -lpython2.7 -lboost_program_options -ltinyxml /opt/ros/kinetic/lib/libroscpp.so -lboost_filesystem -lboost_signals /opt/ros/kinetic/lib/librosconsole.so /opt/ros/kinetic/lib/librosconsole_log4cxx.so /opt/ros/kinetic/lib/librosconsole_backend_interface.so -llog4cxx -lboost_regex /opt/ros/kinetic/lib/libxmlrpcpp.so /opt/ros/kinetic/lib/libroscpp_serialization.so /opt/ros/kinetic/lib/librostime.so /opt/ros/kinetic/lib/libcpp_common.so -lboost_system -lboost_thread -lboost_chrono -lboost_date_time -lboost_atomic -lpthread -lconsole_bridge 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/progress.make
index 324d43716df08e2aa7fe521bdb00bca45927c2c8..6fc8763fc8272756fb5fefe9eb7b8a1f3ea132d8 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/main_node.dir/progress.make
@@ -1,15 +1,16 @@
-CMAKE_PROGRESS_1 = 52
-CMAKE_PROGRESS_2 = 53
-CMAKE_PROGRESS_3 = 54
-CMAKE_PROGRESS_4 = 55
-CMAKE_PROGRESS_5 = 56
-CMAKE_PROGRESS_6 = 57
-CMAKE_PROGRESS_7 = 58
-CMAKE_PROGRESS_8 = 59
-CMAKE_PROGRESS_9 = 60
-CMAKE_PROGRESS_10 = 61
-CMAKE_PROGRESS_11 = 62
-CMAKE_PROGRESS_12 = 63
-CMAKE_PROGRESS_13 = 64
-CMAKE_PROGRESS_14 = 65
+CMAKE_PROGRESS_1 = 54
+CMAKE_PROGRESS_2 = 55
+CMAKE_PROGRESS_3 = 56
+CMAKE_PROGRESS_4 = 57
+CMAKE_PROGRESS_5 = 58
+CMAKE_PROGRESS_6 = 59
+CMAKE_PROGRESS_7 = 60
+CMAKE_PROGRESS_8 = 61
+CMAKE_PROGRESS_9 = 62
+CMAKE_PROGRESS_10 = 63
+CMAKE_PROGRESS_11 = 64
+CMAKE_PROGRESS_12 = 65
+CMAKE_PROGRESS_13 = 66
+CMAKE_PROGRESS_14 = 67
+CMAKE_PROGRESS_15 = 68
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/progress.marks b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/progress.marks
index 4b9026d8e2aa237955be84bd9e06954bdd343190..69a893aa31141827125ddaaee26966b7aed3de74 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/progress.marks
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/progress.marks
@@ -1 +1 @@
-63
+66
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/ultrasonic.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/ultrasonic.dir/progress.make
index 6846ccae2541389d58471170f9d469a7a10bfee4..352b7a46f1b9b1a4ba40430735266be5ca3c639f 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/ultrasonic.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/CMakeFiles/ultrasonic.dir/progress.make
@@ -1,3 +1,3 @@
-CMAKE_PROGRESS_1 = 66
-CMAKE_PROGRESS_2 = 67
+CMAKE_PROGRESS_1 = 69
+CMAKE_PROGRESS_2 = 70
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/Makefile b/modules/catkin_ws/src/car/cmake-build-debug/Makefile
index a134d41766872c75d655a820468d04cc74ffcc92..1d81d7c1d665c7ac9eccbdeaaa4523f8ced506ee 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/Makefile
+++ b/modules/catkin_ws/src/car/cmake-build-debug/Makefile
@@ -1219,6 +1219,33 @@ home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonPro
 	$(MAKE) -f CMakeFiles/main_node.dir/build.make CMakeFiles/main_node.dir/home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.cpp.s
 .PHONY : home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.cpp.s
 
+src/camera/camera.o: src/camera/camera.cpp.o
+
+.PHONY : src/camera/camera.o
+
+# target to build an object file
+src/camera/camera.cpp.o:
+	$(MAKE) -f CMakeFiles/camera.dir/build.make CMakeFiles/camera.dir/src/camera/camera.cpp.o
+.PHONY : src/camera/camera.cpp.o
+
+src/camera/camera.i: src/camera/camera.cpp.i
+
+.PHONY : src/camera/camera.i
+
+# target to preprocess a source file
+src/camera/camera.cpp.i:
+	$(MAKE) -f CMakeFiles/camera.dir/build.make CMakeFiles/camera.dir/src/camera/camera.cpp.i
+.PHONY : src/camera/camera.cpp.i
+
+src/camera/camera.s: src/camera/camera.cpp.s
+
+.PHONY : src/camera/camera.s
+
+# target to generate assembly for a file
+src/camera/camera.cpp.s:
+	$(MAKE) -f CMakeFiles/camera.dir/build.make CMakeFiles/camera.dir/src/camera/camera.cpp.s
+.PHONY : src/camera/camera.cpp.s
+
 src/environment/environment.o: src/environment/environment.cpp.o
 
 .PHONY : src/environment/environment.o
@@ -1273,6 +1300,33 @@ src/mainNode/NotifiableThread.cpp.s:
 	$(MAKE) -f CMakeFiles/NotifiableThreadTest.dir/build.make CMakeFiles/NotifiableThreadTest.dir/src/mainNode/NotifiableThread.cpp.s
 .PHONY : src/mainNode/NotifiableThread.cpp.s
 
+src/mainNode/PlatoonController.o: src/mainNode/PlatoonController.cpp.o
+
+.PHONY : src/mainNode/PlatoonController.o
+
+# target to build an object file
+src/mainNode/PlatoonController.cpp.o:
+	$(MAKE) -f CMakeFiles/main_node.dir/build.make CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.o
+.PHONY : src/mainNode/PlatoonController.cpp.o
+
+src/mainNode/PlatoonController.i: src/mainNode/PlatoonController.cpp.i
+
+.PHONY : src/mainNode/PlatoonController.i
+
+# target to preprocess a source file
+src/mainNode/PlatoonController.cpp.i:
+	$(MAKE) -f CMakeFiles/main_node.dir/build.make CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.i
+.PHONY : src/mainNode/PlatoonController.cpp.i
+
+src/mainNode/PlatoonController.s: src/mainNode/PlatoonController.cpp.s
+
+.PHONY : src/mainNode/PlatoonController.s
+
+# target to generate assembly for a file
+src/mainNode/PlatoonController.cpp.s:
+	$(MAKE) -f CMakeFiles/main_node.dir/build.make CMakeFiles/main_node.dir/src/mainNode/PlatoonController.cpp.s
+.PHONY : src/mainNode/PlatoonController.cpp.s
+
 src/mainNode/mainNode.o: src/mainNode/mainNode.cpp.o
 
 .PHONY : src/mainNode/mainNode.o
@@ -1459,12 +1513,18 @@ help:
 	@echo "... home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.o"
 	@echo "... home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.i"
 	@echo "... home/philipp/hu/Hochautomatisiertes_Fahren/Repo/modules/Communication/PlatoonProtocol/src/VehicleEndpoint.s"
+	@echo "... src/camera/camera.o"
+	@echo "... src/camera/camera.i"
+	@echo "... src/camera/camera.s"
 	@echo "... src/environment/environment.o"
 	@echo "... src/environment/environment.i"
 	@echo "... src/environment/environment.s"
 	@echo "... src/mainNode/NotifiableThread.o"
 	@echo "... src/mainNode/NotifiableThread.i"
 	@echo "... src/mainNode/NotifiableThread.s"
+	@echo "... src/mainNode/PlatoonController.o"
+	@echo "... src/mainNode/PlatoonController.i"
+	@echo "... src/mainNode/PlatoonController.s"
 	@echo "... src/mainNode/mainNode.o"
 	@echo "... src/mainNode/mainNode.i"
 	@echo "... src/mainNode/mainNode.s"
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/car.cbp b/modules/catkin_ws/src/car/cmake-build-debug/car.cbp
index 3fcf6413bb6bad1013906504c5bc6e71fafa41f2..1340d1b9f6074550c4c29f75706056dddcbae962 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/car.cbp
+++ b/modules/catkin_ws/src/car/cmake-build-debug/car.cbp
@@ -1104,15 +1104,24 @@
 		<Unit filename="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/include/mainNode/NotifiableThread.h">
 			<Option target="NotifiableThreadTest"/>
 		</Unit>
+		<Unit filename="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/include/mainNode/PlatoonController.h">
+			<Option target="main_node"/>
+		</Unit>
 		<Unit filename="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/include/mainNode/mainNode.h">
 			<Option target="main_node"/>
 		</Unit>
+		<Unit filename="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/camera/camera.cpp">
+			<Option target="camera"/>
+		</Unit>
 		<Unit filename="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/environment/environment.cpp">
 			<Option target="environment"/>
 		</Unit>
 		<Unit filename="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/mainNode/NotifiableThread.cpp">
 			<Option target="NotifiableThreadTest"/>
 		</Unit>
+		<Unit filename="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/mainNode/PlatoonController.cpp">
+			<Option target="main_node"/>
+		</Unit>
 		<Unit filename="/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/src/mainNode/mainNode.cpp">
 			<Option target="main_node"/>
 		</Unit>
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/cmake_install.cmake b/modules/catkin_ws/src/car/cmake-build-debug/cmake_install.cmake
index 01d9310cdd3859f29d5b9a91aa6e17471a2e05c2..9c5f0b31e4540b69428dec58b8d7ea1bef6d8e43 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/cmake_install.cmake
+++ b/modules/catkin_ws/src/car/cmake-build-debug/cmake_install.cmake
@@ -235,9 +235,19 @@ if("${CMAKE_INSTALL_COMPONENT}" STREQUAL "Unspecified" OR NOT CMAKE_INSTALL_COMP
 endif()
 
 if("${CMAKE_INSTALL_COMPONENT}" STREQUAL "Unspecified" OR NOT CMAKE_INSTALL_COMPONENT)
+  if(EXISTS "$ENV{DESTDIR}${CMAKE_INSTALL_PREFIX}/lib/libcamera.so" AND
+     NOT IS_SYMLINK "$ENV{DESTDIR}${CMAKE_INSTALL_PREFIX}/lib/libcamera.so")
+    file(RPATH_CHECK
+         FILE "$ENV{DESTDIR}${CMAKE_INSTALL_PREFIX}/lib/libcamera.so"
+         RPATH "")
+  endif()
   file(INSTALL DESTINATION "${CMAKE_INSTALL_PREFIX}/lib" TYPE SHARED_LIBRARY FILES "/home/philipp/hu/Hochautomatisiertes Fahren/Repo/modules/catkin_ws/src/car/cmake-build-debug/devel/lib/libcamera.so")
   if(EXISTS "$ENV{DESTDIR}${CMAKE_INSTALL_PREFIX}/lib/libcamera.so" AND
      NOT IS_SYMLINK "$ENV{DESTDIR}${CMAKE_INSTALL_PREFIX}/lib/libcamera.so")
+    file(RPATH_CHANGE
+         FILE "$ENV{DESTDIR}${CMAKE_INSTALL_PREFIX}/lib/libcamera.so"
+         OLD_RPATH "/opt/ros/kinetic/lib:"
+         NEW_RPATH "")
     if(CMAKE_INSTALL_DO_STRIP)
       execute_process(COMMAND "/usr/bin/strip" "$ENV{DESTDIR}${CMAKE_INSTALL_PREFIX}/lib/libcamera.so")
     endif()
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/gtest/CMakeFiles/gtest.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/gtest/CMakeFiles/gtest.dir/progress.make
index 961e1cad8a491d6eab4b1b2fbea140b4981d8bfc..dbabe1f503005bb056cc5f60ca4f00c4dd805cad 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/gtest/CMakeFiles/gtest.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/gtest/CMakeFiles/gtest.dir/progress.make
@@ -1,3 +1,3 @@
-CMAKE_PROGRESS_1 = 48
-CMAKE_PROGRESS_2 = 49
+CMAKE_PROGRESS_1 = 50
+CMAKE_PROGRESS_2 = 51
 
diff --git a/modules/catkin_ws/src/car/cmake-build-debug/gtest/CMakeFiles/gtest_main.dir/progress.make b/modules/catkin_ws/src/car/cmake-build-debug/gtest/CMakeFiles/gtest_main.dir/progress.make
index dbabe1f503005bb056cc5f60ca4f00c4dd805cad..3b1f03a283674d85998962d5dc3890e786829890 100644
--- a/modules/catkin_ws/src/car/cmake-build-debug/gtest/CMakeFiles/gtest_main.dir/progress.make
+++ b/modules/catkin_ws/src/car/cmake-build-debug/gtest/CMakeFiles/gtest_main.dir/progress.make
@@ -1,3 +1,3 @@
-CMAKE_PROGRESS_1 = 50
-CMAKE_PROGRESS_2 = 51
+CMAKE_PROGRESS_1 = 52
+CMAKE_PROGRESS_2 = 53
 
diff --git a/modules/catkin_ws/src/car/include/mainNode/PlatoonController.h b/modules/catkin_ws/src/car/include/mainNode/PlatoonController.h
new file mode 100644
index 0000000000000000000000000000000000000000..703c9513c38bc4e19fb1d9ed9e34ed20853345f8
--- /dev/null
+++ b/modules/catkin_ws/src/car/include/mainNode/PlatoonController.h
@@ -0,0 +1,20 @@
+//
+// Created by philipp on 12.02.18.
+//
+
+#ifndef CAR_PLATOONCONTROLLER_H
+#define CAR_PLATOONCONTROLLER_H
+
+namespace car
+{
+
+class PlatoonController
+{
+public:
+
+private:
+};
+
+}
+
+#endif //CAR_PLATOONCONTROLLER_H
diff --git a/modules/catkin_ws/src/car/include/mainNode/mainNode.h b/modules/catkin_ws/src/car/include/mainNode/mainNode.h
index 1c3b73f2cb6c77699da12c3570570372ac4b5578..bf1157b691ccdcf6c7adc82951eed5ff2fe33fb1 100644
--- a/modules/catkin_ws/src/car/include/mainNode/mainNode.h
+++ b/modules/catkin_ws/src/car/include/mainNode/mainNode.h
@@ -4,25 +4,31 @@
 #include <nodelet/nodelet.h>
 #include <ros/ros.h>
 #include "boost/thread.hpp"
-#include "car/environmentDataMsg.h" 
+#include "car/environmentDataMsg.h"
+#include "NotifiableThread.h"
+#include "../../../../../Communication/NetworkingLib/include/Networking.h"
 
 namespace car
 {
-	class MainNode : public nodelet::Nodelet
-	{
-		public:
-			virtual void onInit();
-			MainNode(ros::NodeHandle &nh, std::string &name);
-			MainNode();
-			~MainNode();
-		private:
-			ros::NodeHandle nh_;
-			std::string name_;
-			boost::thread loggerModule;
-			ros::Publisher logEnabled;
-      ros::Subscriber environmentData;
-      
-      void environmentDataCallback(const environmentDataMsg::ConstPtr& inMsg);
-	};
+class MainNode : public nodelet::Nodelet
+{
+public:
+    virtual void onInit();
+
+    MainNode(ros::NodeHandle & nh, std::string & name);
+
+    MainNode();
+
+    ~MainNode();
+
+private:
+    ros::NodeHandle nh;
+    std::string name;
+    boost::thread loggerModule;
+    ros::Publisher logEnabled;
+    ros::Subscriber environmentData;
+
+    void environmentDataCallback(const environmentDataMsg::ConstPtr & inMsg);
+};
 }
 #endif
diff --git a/modules/catkin_ws/src/car/src/mainNode/PlatoonController.cpp b/modules/catkin_ws/src/car/src/mainNode/PlatoonController.cpp
new file mode 100644
index 0000000000000000000000000000000000000000..5a3dbccf01c57d786a747749896de73f9096e8b9
--- /dev/null
+++ b/modules/catkin_ws/src/car/src/mainNode/PlatoonController.cpp
@@ -0,0 +1,4 @@
+//
+// Created by philipp on 12.02.18.
+//
+
diff --git a/modules/catkin_ws/src/car/src/mainNode/mainNode.cpp b/modules/catkin_ws/src/car/src/mainNode/mainNode.cpp
index ad5a8b1a17b6177239065dfac39341232980cdf2..3c22e498a91e91038f533fca9a059b0eaafde90a 100644
--- a/modules/catkin_ws/src/car/src/mainNode/mainNode.cpp
+++ b/modules/catkin_ws/src/car/src/mainNode/mainNode.cpp
@@ -16,15 +16,15 @@ PLUGINLIB_EXPORT_CLASS(car::MainNode, nodelet::Nodelet);
 
 namespace car
 {
-	MainNode::MainNode(ros::NodeHandle &nh, std::string &name) : nh_(nh), name_(name) {}
+	MainNode::MainNode(ros::NodeHandle &nh, std::string &name) : nh(nh), name(name) {}
 	MainNode::MainNode() {}
 	MainNode::~MainNode() {}
 	void MainNode::onInit()
 	{
 		NODELET_INFO("MainNode::onInit -- START");
-		logEnabled = nh_.advertise<logEnabledMsg>("logEnabled", 5);
-	  environmentData = nh_.subscribe("environmentData", 1, &MainNode::environmentDataCallback, this);
-    std::cout << "MainNode &nh_: " << &nh_ << "\n";
+		logEnabled = nh.advertise<logEnabledMsg>("logEnabled", 5);
+	  environmentData = nh.subscribe("environmentData", 1, &MainNode::environmentDataCallback, this);
+    std::cout << "MainNode &nh: " << &nh << "\n";
 
 
     		// CODE GOES HERE