diff --git a/aruco_pose/CMakeLists.txt b/aruco_pose/CMakeLists.txt
index 92662447..5ac90d48 100644
--- a/aruco_pose/CMakeLists.txt
+++ b/aruco_pose/CMakeLists.txt
@@ -212,3 +212,8 @@ target_link_libraries(aruco_pose
 
 ## Add folders to be run by python nosetests
 # catkin_add_nosetests(test)
+
+if (CATKIN_ENABLE_TESTING)
+  find_package(rostest REQUIRED)
+  add_rostest(test/basic.test)
+endif()
diff --git a/builder/image-ros.sh b/builder/image-ros.sh
index 561a9607..6fc6eb05 100755
--- a/builder/image-ros.sh
+++ b/builder/image-ros.sh
@@ -144,6 +144,7 @@ echo_stamp "Installing CLEVER" \
 && my_travis_retry pip install -r /home/pi/catkin_ws/src/clever/clever/requirements.txt \
 && source /opt/ros/kinetic/setup.bash \
 && catkin_make -j2 -DCMAKE_BUILD_TYPE=Release \
+&& catkin_make run_tests \
 && systemctl enable roscore \
 && systemctl enable clever \
 && echo_stamp "All CLEVER was installed!" "SUCCESS" \