Set gt room frame id from config

Author: GoldenZephyr

hydra_ros/include/hydra_ros/backend/gt_room_publisher.h

@@ -15,6 +15,7 @@ class GtRoomPublisher : public UpdateRoomsFunctor::Sink {
  public:
   struct Config {
     std::string ns = "~/gt_rooms";
+    std::string room_frame_id = "map";
     visualizer::DiscreteColormap::Config colormap;
   } const config;
 

hydra_ros/src/backend/gt_room_publisher.cpp

@@ -22,6 +22,7 @@ void declare_config(GtRoomPublisher::Config& config) {
   using namespace config;
   name("GtRoomPublisher::Config");
   field(config.ns, "ns");
+  field(config.room_frame_id, "room_frame_id");
   field(config.colormap, "colormap");
 }
 
@@ -36,7 +37,6 @@ GtRoomPublisher::GtRoomPublisher(const Config& config)
 std::string GtRoomPublisher::printInfo() const { return config::toString(config); }
 
 void GtRoomPublisher::call(uint64_t, const RoomFinder& rf) const {
-  LOG(WARNING) << "GT Room sink called";
   MarkerArray ma;
   auto& m = ma.markers.emplace_back();
   m.action = m.DELETEALL;
@@ -48,7 +48,7 @@ void GtRoomPublisher::call(uint64_t, const RoomFinder& rf) const {
   for (auto room : rf.room_extents.room_bounding_boxes) {
     for (auto box : room) {
       auto& m = ma.markers.emplace_back();
-      m.header.frame_id = "euclid/utm_local";
+      m.header.frame_id = config.room_frame_id;
       m.ns = "gt_rooms";
       m.id = idx++;
       m.action = m.ADD;