mirror of
https://github.com/micro-ROS/micro-ROS-Agent.git
synced 2026-09-06 09:55:15 +02:00
Signed-off-by: Pablo Garrido <pablogs9@gmail.com>
Signed-off-by: Pablo Garrido <pablogs9@gmail.com>
(cherry picked from commit 4f686e8dc1)
Co-authored-by: Pablo Garrido <pablogs9@gmail.com>
This commit is contained in:
co-authored by
Pablo Garrido
parent
be3134835a
commit
79c9ec1448
@@ -305,7 +305,7 @@ private:
|
|||||||
// Store a auxiliary publishers and datawriter for each participant created in micro-ROS
|
// Store a auxiliary publishers and datawriter for each participant created in micro-ROS
|
||||||
std::map<
|
std::map<
|
||||||
const eprosima::fastdds::dds::DomainParticipant*,
|
const eprosima::fastdds::dds::DomainParticipant*,
|
||||||
std::unique_ptr<eprosima::fastdds::dds::DataWriter>
|
eprosima::fastdds::dds::DataWriter*
|
||||||
> micro_ros_graph_datawriters_;
|
> micro_ros_graph_datawriters_;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|||||||
@@ -322,11 +322,10 @@ void GraphManager::add_participant(
|
|||||||
if (it == micro_ros_graph_datawriters_.end())
|
if (it == micro_ros_graph_datawriters_.end())
|
||||||
{
|
{
|
||||||
// Create datawriter
|
// Create datawriter
|
||||||
std::unique_ptr<eprosima::fastdds::dds::DataWriter> datawriter;
|
eprosima::fastdds::dds::DataWriter * datawriter = publisher_->create_datawriter(ros_discovery_topic_.get(), datawriter_qos_);
|
||||||
datawriter.reset(publisher_->create_datawriter(ros_discovery_topic_.get(), datawriter_qos_));
|
|
||||||
|
|
||||||
it = micro_ros_graph_datawriters_.insert(
|
it = micro_ros_graph_datawriters_.insert(
|
||||||
std::make_pair(participant, std::move(datawriter))).first;
|
std::make_pair(participant, datawriter)).first;
|
||||||
}
|
}
|
||||||
|
|
||||||
it->second->write(static_cast<void *>(&info));
|
it->second->write(static_cast<void *>(&info));
|
||||||
@@ -346,8 +345,9 @@ void GraphManager::remove_participant(
|
|||||||
rmw_dds_common::convert_gid_to_msg(&gid, &info.gid);
|
rmw_dds_common::convert_gid_to_msg(&gid, &info.gid);
|
||||||
auto it = micro_ros_graph_datawriters_.find(participant);
|
auto it = micro_ros_graph_datawriters_.find(participant);
|
||||||
it->second->write(static_cast<void *>(&info));
|
it->second->write(static_cast<void *>(&info));
|
||||||
}
|
publisher_->delete_datawriter(it->second);
|
||||||
micro_ros_graph_datawriters_.erase(participant);
|
micro_ros_graph_datawriters_.erase(participant);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void GraphManager::add_datawriter(
|
void GraphManager::add_datawriter(
|
||||||
|
|||||||
Reference in New Issue
Block a user