zenoh_c to zenoh_cpp

Signed-off-by: Alejandro Hernández Cordero <[email protected]> Fixed CI Signed-off-by: Alejandro Hernández Cordero <[email protected]> tokens Signed-off-by: Alejandro Hernández Cordero <[email protected]> removed zenoh_router_check Signed-off-by: Alejandro Hernández Cordero <[email protected]> removed rmw_init_options_impl.hpp Signed-off-by: Alejandro Hernández Cordero <[email protected]> Publisher Signed-off-by: Alejandro Hernández Cordero <[email protected]> Added subscribers Signed-off-by: Alejandro Hernández Cordero <[email protected]> Removed zid_to_str Signed-off-by: Alejandro Hernández Cordero <[email protected]> use zenoh::KeyExpr Signed-off-by: Alejandro Hernández Cordero <[email protected]> service data Signed-off-by: Alejandro Hernández Cordero <[email protected]> client data Signed-off-by: Alejandro Hernández Cordero <[email protected]> Removed unused signature Signed-off-by: Alejandro Hernández Cordero <[email protected]> cleanups and shm Signed-off-by: Alejandro Hernández Cordero <[email protected]> make linters happy Signed-off-by: Alejandro Hernández Cordero <[email protected]> make linters happy Signed-off-by: Alejandro Hernández Cordero <[email protected]> make linters happy Signed-off-by: Alejandro Hernández Cordero <[email protected]> make linters happy Signed-off-by: Alejandro Hernández Cordero <[email protected]> make linters happy Signed-off-by: Alejandro Hernández Cordero <[email protected]> make linters happy Signed-off-by: Alejandro Hernández Cordero <[email protected]> more changes Signed-off-by: Alejandro Hernández Cordero <[email protected]> Fixed segfault Signed-off-by: Alejandro Hernández Cordero <[email protected]> make linters happy Signed-off-by: Alejandro Hernández Cordero <[email protected]> make linters happy Signed-off-by: Alejandro Hernández Cordero <[email protected]> removed zenohc from CMakeLists.txt and warning Signed-off-by: Alejandro Hernández Cordero <[email protected]> Restored one method Signed-off-by: Alejandro Hernández Cordero <[email protected]> wrap the zenoh session with a shared pointer Signed-off-by: Alejandro Hernández Cordero <[email protected]> Changes missed Signed-off-by: Yadunund <[email protected]>
ros2 · Dec 10, 2024 · 196f30d · 196f30d
1 parent 7fcd074
commit 196f30d
Show file tree

Hide file tree

Showing 37 changed files with 1,042 additions and 1,148 deletions.
diff --git a/.github/workflows/build.yaml b/.github/workflows/build.yaml
@@ -40,6 +40,6 @@ jobs:
       with:
         package-name: |
           rmw_zenoh_cpp
-          zenoh_c_vendor
+          zenoh_cpp_vendor
         target-ros2-distro: ${{ matrix.ROS_DISTRO }}
         vcs-repo-file-url: ${{ matrix.BUILD_TYPE == 'source' && env.ROS2_REPOS_FILE_URL || '' }}
diff --git a/README.md b/README.md
@@ -19,7 +19,7 @@ Build `rmw_zenoh_cpp`
 
 >Note: By default, we vendor and compile `zenoh-c` with a subset of `zenoh` features.
 The `ZENOHC_CARGO_FLAGS` CMake argument may be overwritten with other features included if required.
-See [zenoh_c_vendor/CMakeLists.txt](./zenoh_c_vendor/CMakeLists.txt) for more details.
+See [zenoh_cpp_vendor/CMakeLists.txt](./zenoh_cpp_vendor/CMakeLists.txt) for more details.
 
 ```bash
 mkdir ~/ws_rmw_zenoh/src -p && cd ~/ws_rmw_zenoh/src

diff --git a/rmw_zenoh_cpp/CMakeLists.txt b/rmw_zenoh_cpp/CMakeLists.txt
@@ -21,7 +21,7 @@ find_package(rcutils REQUIRED)
 find_package(rosidl_typesupport_fastrtps_c REQUIRED)
 find_package(rosidl_typesupport_fastrtps_cpp REQUIRED)
 find_package(rmw REQUIRED)
-find_package(zenoh_c_vendor REQUIRED)
+find_package(zenoh_cpp_vendor REQUIRED)
 
 add_library(rmw_zenoh_cpp SHARED
   src/detail/attachment_helpers.cpp
@@ -45,7 +45,6 @@ add_library(rmw_zenoh_cpp SHARED
   src/detail/type_support.cpp
   src/detail/type_support_common.cpp
   src/detail/zenoh_config.cpp
-  src/detail/zenoh_router_check.cpp
   src/detail/zenoh_utils.cpp
   src/rmw_event.cpp
   src/rmw_get_network_flow_endpoints.cpp
@@ -68,7 +67,7 @@ target_link_libraries(rmw_zenoh_cpp
     rosidl_typesupport_fastrtps_c::rosidl_typesupport_fastrtps_c
     rosidl_typesupport_fastrtps_cpp::rosidl_typesupport_fastrtps_cpp
     rmw::rmw
-    zenohc::lib
+    zenohcxx::zenohc
 )
 
 configure_rmw_library(rmw_zenoh_cpp)
@@ -130,7 +129,7 @@ target_link_libraries(rmw_zenohd
     rcutils::rcutils
     rcpputils::rcpputils
     rmw::rmw
-    zenohc::lib
+    zenohcxx::zenohc
 )
 
 install(

diff --git a/rmw_zenoh_cpp/package.xml b/rmw_zenoh_cpp/package.xml
@@ -15,8 +15,8 @@
 
   <buildtool_depend>ament_cmake</buildtool_depend>
 
-  <build_depend>zenoh_c_vendor</build_depend>
-  <build_export_depend>zenoh_c_vendor</build_export_depend>
+  <build_depend>zenoh_cpp_vendor</build_depend>
+  <build_export_depend>zenoh_cpp_vendor</build_export_depend>
 
   <depend>ament_index_cpp</depend>
   <depend>fastcdr</depend>

diff --git a/rmw_zenoh_cpp/src/detail/attachment_helpers.cpp b/rmw_zenoh_cpp/src/detail/attachment_helpers.cpp
@@ -12,13 +12,15 @@
 // See the License for the specific language governing permissions and
 // limitations under the License.
 
-#include <zenoh.h>
-
 #include <cstdlib>
 #include <cstring>
 #include <stdexcept>
+#include <string>
 #include <string_view>
 #include <utility>
+#include <vector>
+
+#include <zenoh.hxx>
 
 #include "rmw/types.h"
 
@@ -27,75 +29,24 @@
 
 namespace rmw_zenoh_cpp
 {
-///=============================================================================
+
 AttachmentData::AttachmentData(
-  const int64_t sequence_number,
-  const int64_t source_timestamp,
-  const uint8_t source_gid[RMW_GID_STORAGE_SIZE])
-: sequence_number_(sequence_number),
-  source_timestamp_(source_timestamp)
+  const int64_t _sequence_number,
+  const int64_t _source_timestamp,
+  const std::vector<uint8_t> _source_gid)
 {
-  memcpy(source_gid_, source_gid, RMW_GID_STORAGE_SIZE);
+  sequence_number_ = _sequence_number;
+  source_timestamp_ = _source_timestamp;
+  source_gid_ = _source_gid;
   gid_hash_ = hash_gid(source_gid_);
 }
 
-///=============================================================================
 AttachmentData::AttachmentData(AttachmentData && data)
-: sequence_number_(std::move(data.sequence_number_)),
-  source_timestamp_(std::move(data.source_timestamp_)),
-  gid_hash_(std::move(data.gid_hash_))
-{
-  memcpy(source_gid_, data.source_gid_, RMW_GID_STORAGE_SIZE);
-}
-
-///=============================================================================
-AttachmentData::AttachmentData(const z_loaned_bytes_t * attachment)
 {
-  ze_deserializer_t deserializer = ze_deserializer_from_bytes(attachment);
-  z_owned_string_t key;
-
-  // Deserialize the sequence_number
-  ze_deserializer_deserialize_string(&deserializer, &key);
-  if (std::string_view(
-      z_string_data(z_loan(key)),
-      z_string_len(z_loan(key))) != "sequence_number")
-  {
-    throw std::runtime_error("sequence_number is not found in the attachment.");
-  }
-  z_drop(z_move(key));
-  if (ze_deserializer_deserialize_int64(&deserializer, &this->sequence_number_)) {
-    throw std::runtime_error("Failed to deserialize the sequence_number.");
-  }
-
-  // Deserialize the source_timestamp
-  ze_deserializer_deserialize_string(&deserializer, &key);
-  if (std::string_view(
-      z_string_data(z_loan(key)),
-      z_string_len(z_loan(key))) != "source_timestamp")
-  {
-    throw std::runtime_error("source_timestamp is not found in the attachment");
-  }
-  z_drop(z_move(key));
-  if (ze_deserializer_deserialize_int64(&deserializer, &this->source_timestamp_)) {
-    throw std::runtime_error("Failed to deserialize the source_timestamp.");
-  }
-
-  // Deserialize the source_gid
-  ze_deserializer_deserialize_string(&deserializer, &key);
-  if (std::string_view(z_string_data(z_loan(key)), z_string_len(z_loan(key))) != "source_gid") {
-    throw std::runtime_error("Invalid attachment: the key source_gid is not found");
-  }
-  z_drop(z_move(key));
-  z_owned_slice_t slice;
-  if (ze_deserializer_deserialize_slice(&deserializer, &slice)) {
-    throw std::runtime_error("Failed to deserialize the source_gid.");
-  }
-  if (z_slice_len(z_loan(slice)) != RMW_GID_STORAGE_SIZE) {
-    throw std::runtime_error("The length of source_gid mismatched.");
-  }
-  memcpy(this->source_gid_, z_slice_data(z_loan(slice)), z_slice_len(z_loan(slice)));
-  z_drop(z_move(slice));
-  gid_hash_ = hash_gid(this->source_gid_);
+  gid_hash_ = std::move(data.gid_hash_);
+  sequence_number_ = std::move(data.sequence_number_);
+  source_timestamp_ = std::move(data.source_timestamp_);
+  source_gid_ = data.source_gid_;
 }
 
 ///=============================================================================
@@ -111,9 +62,9 @@ int64_t AttachmentData::source_timestamp() const
 }
 
 ///=============================================================================
-void AttachmentData::copy_gid(uint8_t out_gid[RMW_GID_STORAGE_SIZE]) const
+std::vector<uint8_t> AttachmentData::copy_gid() const
 {
-  memcpy(out_gid, source_gid_, RMW_GID_STORAGE_SIZE);
+  return source_gid_;
 }
 
 ///=============================================================================
@@ -122,17 +73,38 @@ size_t AttachmentData::gid_hash() const
   return gid_hash_;
 }
 
-///=============================================================================
-void AttachmentData::serialize_to_zbytes(z_owned_bytes_t * attachment)
+zenoh::Bytes AttachmentData::serialize_to_zbytes()
+{
+  auto serializer = zenoh::ext::Serializer();
+  serializer.serialize(std::string("sequence_number"));
+  serializer.serialize(this->sequence_number_);
+  serializer.serialize(std::string("source_timestamp"));
+  serializer.serialize(this->source_timestamp_);
+  serializer.serialize(std::string("source_gid"));
+  serializer.serialize(this->source_gid_);
+  return std::move(serializer).finish();
+}
+
+AttachmentData::AttachmentData(const zenoh::Bytes & attachment)
 {
-  ze_owned_serializer_t serializer;
-  ze_serializer_empty(&serializer);
-  ze_serializer_serialize_str(z_loan_mut(serializer), "sequence_number");
-  ze_serializer_serialize_int64(z_loan_mut(serializer), this->sequence_number_);
-  ze_serializer_serialize_str(z_loan_mut(serializer), "source_timestamp");
-  ze_serializer_serialize_int64(z_loan_mut(serializer), this->source_timestamp_);
-  ze_serializer_serialize_str(z_loan_mut(serializer), "source_gid");
-  ze_serializer_serialize_buf(z_loan_mut(serializer), this->source_gid_, RMW_GID_STORAGE_SIZE);
-  ze_serializer_finish(z_move(serializer), attachment);
+  zenoh::ext::Deserializer deserializer(std::move(attachment));
+  const auto sequence_number_str = deserializer.deserialize<std::string>();
+  if (sequence_number_str != "sequence_number") {
+    throw std::runtime_error("sequence_number is not found in the attachment.");
+  }
+  this->sequence_number_ = deserializer.deserialize<int64_t>();
+
+  const auto source_timestamp_str = deserializer.deserialize<std::string>();
+  if (source_timestamp_str != "source_timestamp") {
+    throw std::runtime_error("source_timestamp is not found in the attachment.");
+  }
+  this->source_timestamp_ = deserializer.deserialize<int64_t>();
+
+  const auto source_gid_str = deserializer.deserialize<std::string>();
+  if (source_gid_str != "source_gid") {
+    throw std::runtime_error("source_gid is not found in the attachment.");
+  }
+  this->source_gid_ = deserializer.deserialize<std::vector<uint8_t>>();
+  gid_hash_ = hash_gid(this->source_gid_);
 }
 }  // namespace rmw_zenoh_cpp
diff --git a/rmw_zenoh_cpp/src/detail/attachment_helpers.hpp b/rmw_zenoh_cpp/src/detail/attachment_helpers.hpp
@@ -15,34 +15,37 @@
 #ifndef DETAIL__ATTACHMENT_HELPERS_HPP_
 #define DETAIL__ATTACHMENT_HELPERS_HPP_
 
-#include <zenoh.h>
+#include <cstdint>
+#include <vector>
+
+#include <zenoh.hxx>
 
 #include "rmw/types.h"
 
 namespace rmw_zenoh_cpp
 {
-///=============================================================================
 class AttachmentData final
 {
 public:
-  AttachmentData(
-    const int64_t sequence_number,
-    const int64_t source_timestamp,
-    const uint8_t source_gid[RMW_GID_STORAGE_SIZE]);
-  explicit AttachmentData(const z_loaned_bytes_t *);
+  explicit AttachmentData(
+    const int64_t _sequence_number,
+    const int64_t _source_timestamp,
+    const std::vector<uint8_t> _source_gid);
+
+  explicit AttachmentData(const zenoh::Bytes & bytes);
   explicit AttachmentData(AttachmentData && data);
 
   int64_t sequence_number() const;
   int64_t source_timestamp() const;
-  void copy_gid(uint8_t out_gid[RMW_GID_STORAGE_SIZE]) const;
+  std::vector<uint8_t> copy_gid() const;
   size_t gid_hash() const;
 
-  void serialize_to_zbytes(z_owned_bytes_t *);
+  zenoh::Bytes serialize_to_zbytes();
 
 private:
   int64_t sequence_number_;
   int64_t source_timestamp_;
-  uint8_t source_gid_[RMW_GID_STORAGE_SIZE];
+  std::vector<uint8_t> source_gid_;
   size_t gid_hash_;
 };
 }  // namespace rmw_zenoh_cpp

diff --git a/rmw_zenoh_cpp/src/detail/graph_cache.cpp b/rmw_zenoh_cpp/src/detail/graph_cache.cpp
@@ -69,8 +69,8 @@ TopicData::TopicData(ConstEntityPtr entity)
 }
 
 ///=============================================================================
-GraphCache::GraphCache(const z_id_t & zid)
-: zid_str_(liveliness::zid_to_str(zid))
+GraphCache::GraphCache(const std::string & zid)
+: zid_str_(zid)
 {
   // Do nothing.
 }
@@ -1160,7 +1160,7 @@ rmw_ret_t GraphCache::get_entities_info_by_topic(
         }
 
         memset(ep.endpoint_gid, 0, RMW_GID_STORAGE_SIZE);
-        entity->copy_gid(ep.endpoint_gid);
+        memcpy(ep.endpoint_gid, entity->copy_gid().data(), RMW_GID_STORAGE_SIZE);
 
         endpoints.push_back(ep);
       }

diff --git a/rmw_zenoh_cpp/src/detail/graph_cache.hpp b/rmw_zenoh_cpp/src/detail/graph_cache.hpp
@@ -110,7 +110,7 @@ class GraphCache final
   /// @param id The id of the zenoh session that is building the graph cache.
   ///   This is used to infer which entities originated from the current session
   ///   so that appropriate event callbacks may be triggered.
-  explicit GraphCache(const z_id_t & zid);
+  explicit GraphCache(const std::string & zid);
 
   // Parse a PUT message over a token's key-expression and update the graph.
   void parse_put(const std::string & keyexpr, bool ignore_from_current_session = false);