Duong update

plugins/static_layer.cpp

@@ -41,7 +41,6 @@
 
 #include <tf3/convert.h>
 #include <robot_tf3_geometry_msgs/tf3_geometry_msgs.h>
-#include <robot/console.h>
 
 #include <boost/dll/alias.hpp>
 #include <fstream>
@@ -77,7 +76,13 @@ void StaticLayer::onInitialize()
 bool StaticLayer::getParams(const std::string& config_file_name, robot::NodeHandle &nh)
 {
     try {
-        std::string folder = ROBOT_COSTMAP_2D_DIR;
+        const char *env_config = std::getenv("PNKX_NAV_CORE_CONFIG_DIR");
+        std::string folder;
+        if (env_config && std::filesystem::exists(env_config))
+        {
+          folder = std::string(env_config);
+          // robot::log_error("config_directory: %s", folder.c_str());
+        }
         std::string path_source = getSourceFile(folder,config_file_name);
         
         YAML::Node config = YAML::LoadFile(path_source);