diff --git a/plugins/directional_layer.cpp b/plugins/directional_layer.cpp
index 260af1f..591d6a0 100644
--- a/plugins/directional_layer.cpp
+++ b/plugins/directional_layer.cpp
@@ -1,4 +1,5 @@
 #include <robot_costmap_2d/directional_layer.h>
+#include <robot/console.h>
 #include <data_convert/data_convert.h>
 #include <tf3/convert.h>
 #include <tf3/utils.h>
diff --git a/plugins/inflation_layer.cpp b/plugins/inflation_layer.cpp
index 37768c6..f864242 100755
--- a/plugins/inflation_layer.cpp
+++ b/plugins/inflation_layer.cpp
@@ -39,6 +39,7 @@
 #include <robot_costmap_2d/inflation_layer.h>
 #include <robot_costmap_2d/costmap_math.h>
 #include <robot_costmap_2d/footprint.h>
+#include <robot/console.h>
 #include <boost/thread.hpp>
 #include <boost/dll/alias.hpp>
 
diff --git a/plugins/obstacle_layer.cpp b/plugins/obstacle_layer.cpp
index f246631..77a5183 100755
--- a/plugins/obstacle_layer.cpp
+++ b/plugins/obstacle_layer.cpp
@@ -39,6 +39,7 @@
 #include <robot_costmap_2d/costmap_math.h>
 
 #include <robot_sensor_msgs/point_cloud2_iterator.h>
+#include <robot/console.h>
 
 #include <tf3/exceptions.h>
 #include <boost/dll/alias.hpp>
diff --git a/plugins/static_layer.cpp b/plugins/static_layer.cpp
index b6ec88f..b0d6f51 100755
--- a/plugins/static_layer.cpp
+++ b/plugins/static_layer.cpp
@@ -41,6 +41,7 @@
 
 #include <tf3/convert.h>
 #include <robot_tf3_geometry_msgs/tf3_geometry_msgs.h>
+#include <robot/console.h>
 
 #include <boost/dll/alias.hpp>
 #include <fstream>
diff --git a/plugins/voxel_layer.cpp b/plugins/voxel_layer.cpp
index d96311d..064461e 100755
--- a/plugins/voxel_layer.cpp
+++ b/plugins/voxel_layer.cpp
@@ -37,6 +37,7 @@
  *********************************************************************/
 #include <robot_costmap_2d/voxel_layer.h>
 #include <robot_sensor_msgs/point_cloud2_iterator.h>
+#include <robot/console.h>
 #include <boost/dll/alias.hpp>
 
 #define VOXEL_BITS 16
diff --git a/src/footprint.cpp b/src/footprint.cpp
index 62fec78..24ee5aa 100755
--- a/src/footprint.cpp
+++ b/src/footprint.cpp
@@ -34,6 +34,7 @@
 #include <robot_costmap_2d/footprint.h>
 #include <robot_costmap_2d/array_parser.h>
 #include <robot_geometry_msgs/Point32.h>
+#include <robot/console.h>
 
 namespace robot_costmap_2d
 {
diff --git a/src/layered_costmap.cpp b/src/layered_costmap.cpp
index 92b0297..a882ae4 100755
--- a/src/layered_costmap.cpp
+++ b/src/layered_costmap.cpp
@@ -37,6 +37,7 @@
  *********************************************************************/
 #include <robot_costmap_2d/layered_costmap.h>
 #include <robot_costmap_2d/footprint.h>
+#include <robot/console.h>
 #include <cstdio>
 #include <string>
 #include <algorithm>
diff --git a/src/observation_buffer.cpp b/src/observation_buffer.cpp
index fdc1869..9f59484 100755
--- a/src/observation_buffer.cpp
+++ b/src/observation_buffer.cpp
@@ -39,6 +39,7 @@
 #include <robot_tf3_geometry_msgs/tf3_geometry_msgs.h>
 #include <robot_tf3_sensor_msgs/tf3_sensor_msgs.h>
 #include <robot_sensor_msgs/point_cloud2_iterator.h>
+#include <robot/console.h>
 
 using namespace std;
 using namespace tf3;
diff --git a/test/static_layer_test.cpp b/test/static_layer_test.cpp
index 0acc07f..95effd1 100644
--- a/test/static_layer_test.cpp
+++ b/test/static_layer_test.cpp
@@ -3,6 +3,7 @@
 #include <gtest/gtest.h>
 #include <tf3/buffer_core.h>
 #include <robot_geometry_msgs/PoseWithCovariance.h>
+#include <robot/console.h>
 
 namespace robot_costmap_2d {