diff --git a/CMakeLists.txt b/CMakeLists.txt
index a224b12886b4f32c53b98dac503d7a665c5f66da..b4bbc1ad17d583820b40d80ebbb54f0342aef0d8 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -2,12 +2,16 @@ cmake_minimum_required(VERSION 2.8.3)
 project(axis_imu)
 
 ## Compile as C++11, supported in ROS Kinetic and newer
-# add_compile_options(-std=c++11)
+
+add_compile_options(-std=c++11)
 
 ## Find catkin macros and libraries
 ## if COMPONENTS list like find_package(catkin REQUIRED COMPONENTS xyz)
 ## is used, also find other catkin packages
-find_package(catkin REQUIRED)
+find_package(catkin REQUIRED
+  roscpp
+  sensor_msgs
+)
 
 ## System dependencies are found with CMake's conventions
 # find_package(Boost REQUIRED COMPONENTS system)
@@ -112,8 +116,8 @@ catkin_package(
 ## Specify additional locations of header files
 ## Your package locations should be listed before other locations
 include_directories(
-# include
-# ${catkin_INCLUDE_DIRS}
+ src
+ ${catkin_INCLUDE_DIRS}
 )
 
 ## Declare a C++ library
@@ -131,6 +135,10 @@ include_directories(
 ## The recommended prefix ensures that target names across packages don't collide
 # add_executable(${PROJECT_NAME}_node src/axis_imu_node.cpp)
 
+add_executable(axis_imu
+  src/axis_imu.cc
+)
+
 ## Rename C++ executable without prefix
 ## The above recommended prefix causes long target names, the following renames the
 ## target back to the shorter version for ease of user use
@@ -146,6 +154,10 @@ include_directories(
 #   ${catkin_LIBRARIES}
 # )
 
+target_link_libraries(axis_imu
+  ${catkin_LIBRARIES}
+)
+
 #############
 ## Install ##
 #############
diff --git a/data/udp_dump_port_5000.pcap b/data/udp_dump_port_5000.pcap
new file mode 100644
index 0000000000000000000000000000000000000000..bdf1d986d0597764ef03d59aa08849968ac1a696
Binary files /dev/null and b/data/udp_dump_port_5000.pcap differ
diff --git a/package.xml b/package.xml
index 819f60abeb2832f7783d63fae38980fe37fc5eaa..f8e2442a1b255a5dd6b8ee70fb5973342626289f 100644
--- a/package.xml
+++ b/package.xml
@@ -7,7 +7,7 @@
   <!-- One maintainer tag required, multiple allowed, one person per tag -->
   <!-- Example:  -->
   <!-- <maintainer email="jane.doe@example.com">Jane Doe</maintainer> -->
-  <maintainer email="tompe@todo.todo">tompe</maintainer>
+  <maintainer email="tommy.persson@liu.se">Tommy Persson</maintainer>
 
 
   <!-- One license tag required, multiple allowed, one license per tag -->
@@ -49,7 +49,8 @@
   <!-- Use doc_depend for packages you need only for building documentation: -->
   <!--   <doc_depend>doxygen</doc_depend> -->
   <buildtool_depend>catkin</buildtool_depend>
-
+  <depend>sensor_msgs</depend>
+  <depend>roscpp</depend>
 
   <!-- The export tag contains other, unspecified, tags -->
   <export>