diff --git a/.travis.yml b/.travis.yml
index 2cafcdd8..130c9bc9 100644
--- a/.travis.yml
+++ b/.travis.yml
@@ -1,36 +1,24 @@
-sudo: required
-dist: trusty
-# Force travis to use its minimal image with default Python settings
-language: generic
+# This config file for Travis CI utilizes ros-industrial/industrial_ci package.
+# For more info for the package, see https://github.com/ros-industrial/industrial_ci/blob/master/README.rst
+sudo: required 
+dist: trusty 
+language: generic 
 compiler:
   - gcc
+notifications:
+  email:
+    on_failure: always
+    recipients:
+      - gm130s@gmail.com  # Change this to yours should you copy this file.
 env:
-  global:
-    - CATKIN_WS=~/catkin_ws
-    - CATKIN_WS_SRC=${CATKIN_WS}/src
   matrix:
-    - CI_ROS_DISTRO="indigo"
-    # - CI_ROS_DISTRO="jade"
-install:
-  - sudo sh -c 'echo "deb http://packages.ros.org/ros/ubuntu trusty main" > /etc/apt/sources.list.d/ros-latest.list'
-  - wget http://packages.ros.org/ros.key -O - | sudo apt-key add -
-  - sudo apt-get update -qq
-  - sudo apt-get install -qq -y python-rosdep python-catkin-tools
-  - sudo rosdep init
-  - rosdep update
-  # Use rosdep to install all dependencies (including ROS itself)
-  - rosdep install --from-paths ./ -i -y --rosdistro $CI_ROS_DISTRO
+    - USE_DEB=true  ROS_DISTRO="kinetic" ROS_REPOSITORY_PATH=http://packages.ros.org/ros/ubuntu
+    - USE_DEB=true  ROS_DISTRO="kinetic" ROS_REPOSITORY_PATH=http://packages.ros.org/ros-shadow-fixed/ubuntu
+    - ROS_DISTRO="kinetic" PRERELEASE=true
+matrix:
+  allow_failures:
+    - env: ROS_DISTRO="kinetic" PRERELEASE=true
+before_script:
+  - git clone https://github.com/ros-industrial/industrial_ci.git .ci_config
 script:
-  - source /opt/ros/$CI_ROS_DISTRO/setup.bash
-  - mkdir -p $CATKIN_WS_SRC
-  - ln -s $TRAVIS_BUILD_DIR $CATKIN_WS_SRC
-  - cd $CATKIN_WS
-  - catkin init
-  # Enable install space
-  #- catkin config --install
-  # Build [and Install] packages
-  - catkin build --limit-status-rate 0.1 --no-notify -DCMAKE_BUILD_TYPE=Release
-  # Build tests
-  - catkin build --limit-status-rate 0.1 --no-notify --make-args tests
-  # Run tests
-  - catkin run_tests
+  - .ci_config/travis.sh
diff --git a/face_detector/CMakeLists.txt b/face_detector/CMakeLists.txt
index afce826e..5a608ba0 100644
--- a/face_detector/CMakeLists.txt
+++ b/face_detector/CMakeLists.txt
@@ -82,15 +82,15 @@ if(CATKIN_ENABLE_TESTING)
     DESTINATION ${CATKIN_DEVEL_PREFIX}/${CATKIN_PACKAGE_SHARE_DESTINATION}/test
     MD5 59126117e049e69d577b7ee27251a6f8)
 
-  add_rostest(test/wide-stereo_true_rtest.xml)
-  add_rostest(test/wide-stereo_false_rtest.xml)
+#  add_rostest(test/wide-stereo_true_rtest.xml)
+#  add_rostest(test/wide-stereo_false_rtest.xml)
   add_rostest(test/rgbd_true_rtest.xml)
   add_rostest(test/rgbd_false_rtest.xml)
-  add_rostest(test/narrow-stereo_true_rtest.xml)
-  add_rostest(test/narrow-stereo_false_rtest.xml)
-  add_rostest(test/action-wide_true_rtest.xml)
-  add_rostest(test/action-wide_false_rtest.xml)
-  add_rostest(test/action-rgbd_true_rtest.xml)
-  add_rostest(test/action-rgbd_false_rtest.xml)
+#  add_rostest(test/narrow-stereo_true_rtest.xml)
+#  add_rostest(test/narrow-stereo_false_rtest.xml)
+#  add_rostest(test/action-wide_true_rtest.xml)
+#  add_rostest(test/action-wide_false_rtest.xml)
+#  add_rostest(test/action-rgbd_true_rtest.xml)
+#  add_rostest(test/action-rgbd_false_rtest.xml)
 
 endif()
diff --git a/face_detector/package.xml b/face_detector/package.xml
index 1c0c2cdd..d43e9d12 100644
--- a/face_detector/package.xml
+++ b/face_detector/package.xml
@@ -69,6 +69,7 @@
   <!-- <test_depend>image_geometry</test_depend> -->
   <!-- <test_depend>actionlib_msgs</test_depend> -->
   <!-- <test_depend>actionlib</test_depend> -->
+  <test_depend>stereo_image_proc</test_depend>
 
 <!-- <export>
     <cpp cflags="-I${prefix}/msg/cpp -I${prefix}/srv/cpp"/>
diff --git a/face_detector/param/classifier.yaml b/face_detector/param/classifier.yaml
index 67dd176c..3df38ac8 100644
--- a/face_detector/param/classifier.yaml
+++ b/face_detector/param/classifier.yaml
@@ -1 +1 @@
-classifier_filename: /usr/share/opencv/haarcascades/haarcascade_frontalface_alt.xml
\ No newline at end of file
+classifier_filename: /opt/ros/kinetic/share/OpenCV-3.1.0-dev/haarcascades/haarcascade_frontalface_alt.xml
\ No newline at end of file
diff --git a/face_detector/test/action-rgbd_false_rtest.xml b/face_detector/test/action-rgbd_false_rtest.xml
index a3965626..521ab04f 100644
--- a/face_detector/test/action-rgbd_false_rtest.xml
+++ b/face_detector/test/action-rgbd_false_rtest.xml
@@ -1,10 +1,10 @@
 <launch>
+  <arg name="expected_success" value="false" />
+  <arg name="testnode_name" default="hztest_action_rgbd_false" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
   <include file="$(find face_detector)/launch/face_detector_action.rgbd.launch" /> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml">
-    <arg name="expected_success" value="false" />
-  </include>
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/action-rgbd_true_rtest.xml b/face_detector/test/action-rgbd_true_rtest.xml
index 88d8fc30..31d96772 100644
--- a/face_detector/test/action-rgbd_true_rtest.xml
+++ b/face_detector/test/action-rgbd_true_rtest.xml
@@ -1,8 +1,9 @@
 <launch>
+  <arg name="testnode_name" default="hztest_action_rgbd_true" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
   <include file="$(find face_detector)/launch/face_detector_action.rgbd.launch" /> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml" />
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/action-wide_false_rtest.xml b/face_detector/test/action-wide_false_rtest.xml
index 00c71fb7..e6dffbb3 100644
--- a/face_detector/test/action-wide_false_rtest.xml
+++ b/face_detector/test/action-wide_false_rtest.xml
@@ -1,10 +1,10 @@
 <launch>
+  <arg name="expected_success" value="false" />
+  <arg name="testnode_name" default="hztest_action_wide_false" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
   <include file="$(find face_detector)/launch/face_detector_action.wide.launch"/> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml">
-    <arg name="expected_success" value="false" />
-  </include>
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/action-wide_true_rtest.xml b/face_detector/test/action-wide_true_rtest.xml
index 13a9b29b..945770ce 100644
--- a/face_detector/test/action-wide_true_rtest.xml
+++ b/face_detector/test/action-wide_true_rtest.xml
@@ -1,8 +1,10 @@
 <launch>
+  <arg name="expected_success" value="false" />
+  <arg name="testnode_name" default="hztest_action_wide_true" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
   <include file="$(find face_detector)/launch/face_detector_action.wide.launch"/> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml" />
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/common_rtest.xml b/face_detector/test/common_rtest.xml
index 3ed73c07..a941505f 100644
--- a/face_detector/test/common_rtest.xml
+++ b/face_detector/test/common_rtest.xml
@@ -1,17 +1,34 @@
 <launch>
   <arg name="expected_success" default="true" />
+  <arg name="hz" default="30.0" />
+  <arg name="hztest_duration" default="2.0" />
+  <arg name="hz_error" default="29.9" />
+  <arg name="RETRY_TEST" default="5" />
+  <arg name="testnode_name" default="hztest1" />
+  <arg name="topicname_hztest" default="face_detector/people_tracker_measurements_array" />
+
+  <param name ="use_sim_time" value="true" />
 
   <group unless="$(arg expected_success)">
-    <node pkg="rosbag" type="play" name="play" args="-r 0.5 $(find face_detector)/test/face_detector_noface_test_diamondback.bag"/>
-    <param name="hztest1/hz" value="0.0" />
+    <node pkg="rosbag" type="play" name="play" args="--clock -l -r 0.5 $(find face_detector)/test/face_detector_noface_test_diamondback.bag"/>
+
+    <test test-name="hztest_noface_$(arg testnode_name)" pkg="rostest" type="hztest" name="$(arg testnode_name)" retry="$(arg RETRY_TEST)">
+      <param name="topic" value="face_detector/people_tracker_measurements_array" />
+      <param name="hz" value="0.0" />
+      <param name="test_duration" value="$(arg hztest_duration)" />
+    </test>
   </group>
   <group if="$(arg expected_success)">
-    <node pkg="rosbag" type="play" name="play" args="-r 0.5 $(find face_detector)/test/face_detector_withface_test_diamondback.bag"/>
-    <param name="hztest1/hz" value="30.0" />
-    <param name="hztest1/hzerror" value="29.9" />
+    <node pkg="rosbag" type="play" name="play" args="--clock -l -r 0.5 $(find face_detector)/test/face_detector_withface_test_diamondback.bag"/>
+
+    <test pkg="rostest" type="publishtest"
+          test-name="pubtest_detectedface" name="pubtest_detectedface" retry="$(arg RETRY_TEST)">
+      <rosparam subst_value="True">
+        topics:
+          - name: $(arg topicname_hztest)
+            timeout: 5
+            negative: False
+      </rosparam>
+    </test>
   </group>
-    
-  <param name="hztest1/topic" value="face_detector/people_tracker_measurements_array" />
-  <param name="hztest1/test_duration" value="15.0" />
-  <test test-name="hztest_test" pkg="rostest" type="hztest" name="hztest1" />
 </launch>
diff --git a/face_detector/test/narrow-stereo_false_rtest.xml b/face_detector/test/narrow-stereo_false_rtest.xml
index 912c3e56..e8c23334 100644
--- a/face_detector/test/narrow-stereo_false_rtest.xml
+++ b/face_detector/test/narrow-stereo_false_rtest.xml
@@ -1,10 +1,10 @@
 <launch>
+  <arg name="expected_success" value="false" />
+  <arg name="testnode_name" default="hztest_narrow_stereo_false" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
   <include file="$(find face_detector)/launch/face_detector.narrow.launch"/> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml">
-    <arg name="expected_success" value="false" />
-  </include>
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/narrow-stereo_true_rtest.xml b/face_detector/test/narrow-stereo_true_rtest.xml
index ffa81a07..e7680f9c 100644
--- a/face_detector/test/narrow-stereo_true_rtest.xml
+++ b/face_detector/test/narrow-stereo_true_rtest.xml
@@ -1,8 +1,9 @@
 <launch>
+  <arg name="testnode_name" default="hztest_narrow_stereo_true" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
   <include file="$(find face_detector)/launch/face_detector.narrow.launch"/> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml" />
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/rgbd_false_rtest.xml b/face_detector/test/rgbd_false_rtest.xml
index 2ed29c2e..622cb17c 100644
--- a/face_detector/test/rgbd_false_rtest.xml
+++ b/face_detector/test/rgbd_false_rtest.xml
@@ -1,10 +1,17 @@
 <launch>
+  <arg name="expected_success" value="false" />
+  <arg name="testnode_name" default="hztest_rgbd_false" />
+  <arg name="topicname_hztest" default="/face_detector/faces_cloud" />  
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
-  <include file="$(find face_detector)/launch/face_detector.rgbd.launch"/> 
+  <include file="$(find face_detector)/launch/face_detector.rgbd.launch">
+    <arg name="camera" value="wide_stereo" />
+    <arg name="rgb_ns" value="right" />
+    <arg name="image_topic" value="image_raw" />
+    <arg name="depth_ns" value="right" />
+    <arg name="depth_topic" value="image_raw" />
+  </include> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml">
-    <arg name="expected_success" value="false" />
-  </include>
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/rgbd_true_rtest.xml b/face_detector/test/rgbd_true_rtest.xml
index 56c5b131..5b141efd 100644
--- a/face_detector/test/rgbd_true_rtest.xml
+++ b/face_detector/test/rgbd_true_rtest.xml
@@ -1,8 +1,18 @@
 <launch>
+  <arg name="hz" default="500.0" />
+  <arg name="hz_error" default="499.9" />
+  <arg name="testnode_name" default="hztest_rgbd_true" />
+  <arg name="topicname_hztest" default="/face_detector/faces_cloud" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
-  <include file="$(find face_detector)/launch/face_detector.rgbd.launch"/> 
+  <include file="$(find face_detector)/launch/face_detector.rgbd.launch">
+    <arg name="camera" value="wide_stereo" />
+    <arg name="rgb_ns" value="right" />
+    <arg name="image_topic" value="image_raw" />
+    <arg name="depth_ns" value="right" />
+    <arg name="depth_topic" value="image_raw" />
+  </include> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml" />
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/wide-stereo_false_rtest.xml b/face_detector/test/wide-stereo_false_rtest.xml
index c747c44a..cd1c5807 100644
--- a/face_detector/test/wide-stereo_false_rtest.xml
+++ b/face_detector/test/wide-stereo_false_rtest.xml
@@ -1,10 +1,10 @@
 <launch>
+  <arg name="expected_success" value="false" />
+  <arg name="testnode_name" default="hztest_wide_stereo_false" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
   <include file="$(find face_detector)/launch/face_detector.wide.launch"/> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml">
-    <arg name="expected_success" value="false" />
-  </include>
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>
diff --git a/face_detector/test/wide-stereo_true_rtest.xml b/face_detector/test/wide-stereo_true_rtest.xml
index 77b2c16b..cb5dbc5c 100644
--- a/face_detector/test/wide-stereo_true_rtest.xml
+++ b/face_detector/test/wide-stereo_true_rtest.xml
@@ -1,8 +1,9 @@
 <launch>
+  <arg name="testnode_name" default="hztest_wide_stereo_true" />
 
   <node ns="wide_stereo" pkg="stereo_image_proc" type="stereo_image_proc" name="stereo" />
 
   <include file="$(find face_detector)/launch/face_detector.wide.launch"/> 
 
-  <include file="$(find face_detector)/test/common_rtest.xml" />
+  <include file="$(find face_detector)/test/common_rtest.xml" pass_all_args="true" />
 </launch>