Merge pull request #57 from midemig/savemap_default

Added default path for route if not specified

Author: fmrico

maps_managers/easynav_routes_maps_manager/src/easynav_routes_maps_manager/RoutesMapsManager.cpp

@@ -74,11 +74,12 @@ void RoutesMapsManager::on_initialize()
 
   map_path_.clear();
   if (package_name.empty() && map_path_file.empty()) {
-    // Accepted: we will use a default in-memory route in load_routes_from_yaml().
+    // No path configured: default to /tmp so that save_routes still works.
+    map_path_ = "/tmp/routes.yaml";
     RCLCPP_INFO(
       node->get_logger(),
-      "[%s] No package or map_path_file specified, using default in-memory route",
-      plugin_name.c_str());
+      "[%s] No package or map_path_file specified, routes will be saved to %s",
+      plugin_name.c_str(), map_path_.c_str());
   } else if (!map_path_file.empty() && map_path_file[0] == '/') {
     // Absolute path: ignore package_name.
     map_path_ = map_path_file;
@@ -161,11 +162,16 @@ void RoutesMapsManager::on_initialize()
         out << YAML::EndMap;
 
         std::ofstream file(map_path_);
+        if (!file.is_open()) {
+          response->success = false;
+          response->message = "Could not open file for writing: " + map_path_;
+          return;
+        }
         file << out.c_str();
         file.close();
 
         response->success = true;
-        response->message = "Routes saved";
+        response->message = "Routes saved to " + map_path_;
       } catch (const std::exception & e) {
         response->success = false;
         response->message = e.what();