Add stop agent

micro_ros_agent/CHANGELOG.rst

@@ -2,22 +2,6 @@
 Changelog for package micro-ros_agent
 ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
 
-1.5.0 (2021-09-13)
-------------------
-* Remove XRCE dependency and add superbuild (`#97 <https://github.com/micro-ROS/micro-ROS-Agent/issues/97>`_)
-* Fixed launch file by using a list for arguments. Ensures order of items is kept. (`#93 <https://github.com/micro-ROS/micro-ROS-Agent/issues/93>`_) (`#94 <https://github.com/micro-ROS/micro-ROS-Agent/issues/94>`_)
-* Modify argument type (`#91 <https://github.com/micro-ROS/micro-ROS-Agent/issues/91>`_)
-* Fix graph manager datawriters behaviour (`#84 <https://github.com/micro-ROS/micro-ROS-Agent/issues/84>`_)
-* Graph manager: Fix participant mask for listener callbacks (`#81 <https://github.com/micro-ROS/micro-ROS-Agent/issues/81>`_)
-* Fix agent launch (`#78 <https://github.com/micro-ROS/micro-ROS-Agent/issues/78>`_)
-* Fix graph manager node namespaces (`#75 <https://github.com/micro-ROS/micro-ROS-Agent/issues/75>`_)
-* Fix Rolling agent (`#61 <https://github.com/micro-ROS/micro-ROS-Agent/issues/61>`_)
-* Add multi domain graph manager (`#69 <https://github.com/micro-ROS/micro-ROS-Agent/issues/69>`_)
-* Add ros2 launch capabilities and example launch file (`#47 <https://github.com/micro-ROS/micro-ROS-Agent/issues/47>`_)
-* Snap build for the micro-ROS-Agent (`#43 <https://github.com/micro-ROS/micro-ROS-Agent/issues/43>`_)
-* Create graph manager after checking passed CLI arguments and launch xrce-dds server (`#41 <https://github.com/micro-ROS/micro-ROS-Agent/issues/41>`_)
-* Contributors: Antonio Cuadros, Jose Antonio Moral, Pablo Garrido, mergify[bot]
-
 0.0.1 (2019-04-24)
 -----------------
 * Initial release

micro_ros_agent/CMakeLists.txt

@@ -19,15 +19,7 @@ option(UROSAGENT_GENERATE_PROFILE
   )
 set(CMAKE_C_CLANG_TIDY clang-tidy -checks=*)
 
-option(MICROROSAGENT_SUPERBUILD "Enable superbuild compilation." ON)
+project(micro_ros_agent LANGUAGES CXX)
-
-if(NOT MICROROSAGENT_SUPERBUILD)
-    project(micro_ros_agent LANGUAGES CXX)
-else()
-    project(uagent_superbuild NONE)
-    include(${PROJECT_SOURCE_DIR}/cmake/SuperBuild.cmake)
-    return()
-endif()
 
 find_package(ament_cmake REQUIRED)
 find_package(microxrcedds_agent REQUIRED)

micro_ros_agent/cmake/Config.cmake.in

@@ -0,0 +1,32 @@
+# Copyright 2016 Proyectos y Sistemas de Mantenimiento SL (eProsima).
+#
+# Licensed under the Apache License, Version 2.0 (the "License");
+# you may not use this file except in compliance with the License.
+# You may obtain a copy of the License at
+#
+#     http://www.apache.org/licenses/LICENSE-2.0
+#
+# Unless required by applicable law or agreed to in writing, software
+# distributed under the License is distributed on an "AS IS" BASIS,
+# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+# See the License for the specific language governing permissions and
+# limitations under the License.
+
+set(@PROJECT_NAME@_VERSION @PROJECT_VERSION@)
+
+@PACKAGE_INIT@
+
+if(MSVC OR MSVC_IDE)
+    set_and_check(@PROJECT_NAME@_BIN_DIR "@PACKAGE_BIN_INSTALL_DIR@")
+endif()
+set_and_check(@PROJECT_NAME@_INCLUDE_DIR "@PACKAGE_INCLUDE_INSTALL_DIR@")
+set_and_check(@PROJECT_NAME@_LIB_DIR "@PACKAGE_LIB_INSTALL_DIR@")
+set_and_check(@PROJECT_NAME@_DATA_DIR "@PACKAGE_DATA_INSTALL_DIR@")
+
+foreach(d @_deps@)
+    list(GET d 0 _name)
+    list(GET d 1 _version)
+    find_package(${_name} ${_version} REQUIRED)
+endforeach()
+
+include(${@PROJECT_NAME@_DATA_DIR}/@PROJECT_NAME@/cmake/@PROJECT_NAME@Targets.cmake)

micro_ros_agent/cmake/SuperBuild.cmake

@@ -1,66 +0,0 @@
-# Copyright 2019 Proyectos y Sistemas de Mantenimiento SL (eProsima).
-#
-# Licensed under the Apache License, Version 2.0 (the "License");
-# you may not use this file except in compliance with the License.
-# You may obtain a copy of the License at
-#
-#     http://www.apache.org/licenses/LICENSE-2.0
-#
-# Unless required by applicable law or agreed to in writing, software
-# distributed under the License is distributed on an "AS IS" BASIS,
-# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
-# See the License for the specific language governing permissions and
-# limitations under the License.
-
-include(ExternalProject)
-
-unset(_deps)
-
-enable_language(C)
-enable_language(CXX)
-
-unset(xrceagent_DIR CACHE)
-find_package(xrceagent 2 EXACT QUIET)
-if(NOT xrceagent_FOUND)
-    ExternalProject_Add(xrceagent
-            GIT_REPOSITORY
-                https://github.com/eProsima/Micro-XRCE-DDS-Agent.git
-            GIT_TAG
-                ros2
-            PREFIX
-                ${PROJECT_BINARY_DIR}/agent
-            INSTALL_DIR
-                ${CMAKE_INSTALL_PREFIX}
-            CMAKE_CACHE_ARGS
-                -DCMAKE_CXX_COMPILER:FILEPATH=${CMAKE_CXX_COMPILER}
-                -DCMAKE_C_COMPILER:FILEPATH=${CMAKE_C_COMPILER}
-                -DCMAKE_BUILD_TYPE:STRING=${CMAKE_BUILD_TYPE}
-                -DCMAKE_C_FLAGS:STRING=${CMAKE_C_FLAGS}
-                -DCMAKE_CXX_FLAGS:STRING=${CMAKE_CXX_FLAGS}
-                -DCMAKE_EXE_LINKER_FLAGS:STRING=${CMAKE_EXE_LINKER_FLAGS}
-                -DCMAKE_SHARED_LINKER_FLAGS:STRING=${CMAKE_SHARED_LINKER_FLAGS}
-                -DCMAKE_INSTALL_PREFIX:PATH=<INSTALL_DIR>
-                -DCMAKE_BUILD_TYPE:STRING=${CMAKE_BUILD_TYPE}
-                -DCMAKE_PREFIX_PATH:PATH=<INSTALL_DIR>
-                -DUAGENT_USE_SYSTEM_FASTDDS:BOOL=ON
-                -DUAGENT_USE_SYSTEM_FASTCDR:BOOL=ON
-                -DUAGENT_CED_PROFILE:BOOL=OFF
-                -DUAGENT_P2P_PROFILE:BOOL=OFF
-                -DUAGENT_BUILD_EXECUTABLE:BOOL=OFF
-                -DUAGENT_ISOLATED_INSTALL:BOOL=OFF
-            )
-endif()
-
-# Main project.
-ExternalProject_Add(micro_ros_agent
-    SOURCE_DIR
-        ${PROJECT_SOURCE_DIR}
-    BINARY_DIR
-        ${CMAKE_CURRENT_BINARY_DIR}
-    CMAKE_CACHE_ARGS
-        -DMICROROSAGENT_SUPERBUILD:BOOL=OFF
-    INSTALL_COMMAND
-        ""
-    DEPENDS
-        xrceagent
-    )

micro_ros_agent/include/agent/Agent.hpp

@@ -32,20 +32,103 @@ public:
 
     ~Agent() = default;
 
+    /**
+     * @brief   Agent class shall not be copy constructible.
+     */
+    UXR_AGENT_EXPORT Agent(
+            const Agent &) = delete;
+
+    UXR_AGENT_EXPORT Agent(
+            Agent &&) = delete;
+
+    /**
+     * @brief   Agent class shall not be copy assignable.
+     */
+    UXR_AGENT_EXPORT Agent& operator =(
+            const Agent &) = delete;
+
+    UXR_AGENT_EXPORT Agent& operator =(
+            Agent &&) = delete;
+
+    static Agent& getInstance()
+    {
+        static Agent instance;
+        return instance;
+    }
+
     bool create(
             int argc,
             char** argv);
 
     void run();
 
-private:
+    void stop();
 
+    void add_callbacks();
+
+private:
     eprosima::uxr::AgentInstance& xrce_dds_agent_instance_;
     std::map<eprosima::fastdds::dds::DomainId_t, std::shared_ptr<graph_manager::GraphManager>> graph_manager_map_;
-
     std::shared_ptr<graph_manager::GraphManager> find_or_create_graph_manager(eprosima::fastdds::dds::DomainId_t domain_id);
+    bool started = false;
 };
 
+template<typename AgentType>
+class AgentAPI
+{
+public:
+    AgentAPI()
+    : agent_instance_(agent_instance_.getInstance())
+    {};
+
+    ~AgentAPI() = default;
+
+    void create(uint16_t port)
+	{
+		xrce_dds_agent_instance_API.configure(port);
+	}
+
+	void create(std::string dev, const std::string baudrate);
+	void create(std::vector<std::string> devs, const std::string baudrate);
+	void create(const std::string baudrate);
+
+    void set_verbose_level(uint8_t verbose_level)
+    {
+        xrce_dds_agent_instance_API.set_verbose_level(verbose_level);
+    }
+
+    void run()
+    {
+        agent_instance_.add_callbacks();
+        xrce_dds_agent_instance_API.run();
+    }
+
+    void stop()
+    {
+        xrce_dds_agent_instance_API.stop();
+    }
+
+private:
+    Agent& agent_instance_;
+    eprosima::uxr::AgentInstanceAPI<AgentType> xrce_dds_agent_instance_API;
+};
+
+template<> inline UXR_AGENT_EXPORT void AgentAPI<eprosima::uxr::TermiosAgent>::create(std::string dev, const std::string baudrate)
+{
+    xrce_dds_agent_instance_API.configure(dev, baudrate);
+}
+
+template<> inline UXR_AGENT_EXPORT void AgentAPI<eprosima::uxr::MultiTermiosAgent>::create(std::vector<std::string> devs, const std::string baudrate)
+{
+    xrce_dds_agent_instance_API.configure(devs, baudrate);
+
+}
+
+template<> inline UXR_AGENT_EXPORT void AgentAPI<eprosima::uxr::PseudoTerminalAgent>::create(const std::string baudrate)
+{
+    xrce_dds_agent_instance_API.configure(baudrate);
+}
+
 }  // namespace agent
 }  // namespace uros
 #endif  // _UROS_AGENT_AGENT_HPP

micro_ros_agent/include/agent/graph_manager/graph_manager.hpp

@@ -80,7 +80,16 @@ public:
     /**
      * @brief   Default destructor.
      */
-    ~GraphManager() = default;
+    ~GraphManager()
+    {
+        exit = true;
+        cv_.notify_one();
+
+        if (microros_graph_publisher_.joinable())
+        {
+            microros_graph_publisher_.join();
+        }
+    }
 
     /**
      * @brief   Implementation of the notification logic that updates the micro-ROS graph.
@@ -298,6 +307,7 @@ private:
             std::string& node_name,
             std::string& node_namespace);
 
+    bool exit = false;
     eprosima::fastdds::dds::DomainId_t domain_id_;
     bool graph_changed_;
     bool display_on_change_;

micro_ros_agent/launch/micro_ros_agent_launch.py

@@ -7,6 +7,6 @@ def generate_launch_description():
             package='micro_ros_agent',
             executable='micro_ros_agent',
             name='micro_ros_agent',
-            arguments=["udp4", "-p", "8888", "-v6"]
+            arguments={"udp4", "-p", "8888", "-v6"}
         )
     ])

micro_ros_agent/package.xml

@@ -2,10 +2,9 @@
 <?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
 <package format="3">
   <name>micro_ros_agent</name>
-  <version>1.5.0</version>
+  <version>0.0.1</version>
-  <description>micro-ROS Agent package</description>
+  <description>DDS-XCRE agent implementation </description>
-  <maintainer email="pablogarrido@eprosima.com">Pablo Garrido</maintainer>
+  <maintainer email="borjaouterelo@eprosima.com">Borja Outerelo</maintainer>
-  <maintainer email="antoniocuadros@eprosima.com">Antonio Cuadros</maintainer>
   <license>Apache License 2.0</license>
 
   <buildtool_depend>ament_cmake</buildtool_depend>
@@ -15,6 +14,7 @@
   <test_depend>ament_lint_auto</test_depend>
   <test_depend>ament_lint_common</test_depend>
 
+  <depend>microxrcedds_agent</depend>
   <depend>rmw</depend>
   <depend>rcutils</depend>
   <depend>rmw_fastrtps_shared_cpp</depend>

micro_ros_agent/src/agent/Agent.cpp

@@ -29,8 +29,12 @@ bool Agent::create(
         int argc,
         char** argv)
 {
-    bool result = xrce_dds_agent_instance_.create(argc, argv);
+    return xrce_dds_agent_instance_.create(argc, argv);
-    if (result)
+}
+
+void Agent::add_callbacks()
+{
+    if (!started)
     {
         /**
          * Add CREATE_PARTICIPANT callback.
@@ -100,7 +104,6 @@ bool Agent::create(
                 const eprosima::fastdds::dds::DomainParticipant* participant,
                 const eprosima::fastdds::dds::DataWriter* datawriter) -> void
             {
-
                 auto graph_manager_ = find_or_create_graph_manager(participant->get_domain_id());
 
                 // TODO(jamoralp): Workaround for Fast-DDS bug #9977. Remove when fixed
@@ -166,9 +169,9 @@ bool Agent::create(
             eprosima::uxr::Middleware::Kind::FASTDDS,
             eprosima::uxr::middleware::CallbackKind::DELETE_DATAREADER,
             std::move(on_delete_datareader));
-    }
 
-    return result;
+        started = true;
+    }
 }
 
 void Agent::run()
@@ -176,6 +179,11 @@ void Agent::run()
     return xrce_dds_agent_instance_.run();
 }
 
+void Agent::stop()
+{
+    return xrce_dds_agent_instance_.stop();
+}
+
 std::shared_ptr<graph_manager::GraphManager> Agent::find_or_create_graph_manager(eprosima::fastdds::dds::DomainId_t domain_id)
 {
 

micro_ros_agent/src/agent/graph_manager/graph_manager.cpp

@@ -137,10 +137,15 @@ inline void GraphManager::publish_microros_graph()
             std::unique_lock<std::mutex> lock(mtx_);
             cv_.wait(lock, [this]()
             {
-                return this->graph_changed_;
+                return this->graph_changed_ || exit;
             });
         }
 
+        if (exit)
+        {
+            break;
+        }
+        
         if (display_on_change_)
         {
             std::cout << "Updated uros Graph: graph changed" << std::endl;