feat: create autoware_auto_msgs_adapter node

simulator/autoware_auto_msgs_adapter/CMakeLists.txt

@@ -0,0 +1,30 @@
+cmake_minimum_required(VERSION 3.14)
+project(autoware_auto_msgs_adapter)
+
+find_package(autoware_cmake REQUIRED)
+autoware_package()
+
+set(NODE_NAME ${PROJECT_NAME}_node)
+set(EXEC_NAME ${PROJECT_NAME}_exe)
+set(TEST_NAME test_${PROJECT_NAME})
+
+ament_auto_add_library(${NODE_NAME} SHARED
+  src/autoware_auto_msgs_adapter_core.cpp
+  include/autoware_auto_msgs_adapter/adapter_base_interface.hpp
+  include/autoware_auto_msgs_adapter/adapter_base.hpp
+  include/autoware_auto_msgs_adapter/adapter_control.hpp
+  include/autoware_auto_msgs_adapter/autoware_auto_msgs_adapter_core.hpp)
+
+rclcpp_components_register_node(${NODE_NAME}
+  PLUGIN "autoware_auto_msgs_adapter::AutowareAutoMsgsAdapterNode"
+  EXECUTABLE ${EXEC_NAME})
+
+if(BUILD_TESTING)
+  file(GLOB_RECURSE TEST_SOURCES test/*.cpp)
+  ament_add_ros_isolated_gtest(${TEST_NAME} ${TEST_SOURCES})
+  target_link_libraries(${TEST_NAME} ${NODE_NAME})
+endif()
+
+ament_auto_package(INSTALL_TO_SHARE
+  launch
+  config)

simulator/autoware_auto_msgs_adapter/README.md

@@ -0,0 +1,96 @@
+# autoware_auto_msgs_adapter
+
+This package is used to convert `autoware_msgs` to `autoware_auto_msgs`.
+
+## Purpose
+
+As we transition from `autoware_auto_msgs` to `autoware_msgs`, we wanted to provide flexibility and compatibility for
+users who are still using `autoware_auto_msgs`.
+
+This adapter package allows users to easily convert messages between the two formats.
+
+## Capabilities
+
+The `autoware_auto_msgs_adapter` package provides the following capabilities:
+
+- Conversion of supported `autoware_msgs` messages to `autoware_auto_msgs` messages.
+- Can be extended to support conversion for any message type pairs.
+- Each instance is designed to convert from a single source message type to a single target message type.
+- Multiple instances can be launched to convert multiple message types.
+- Can be launched as a standalone node or as a component.
+
+## Usage
+
+Customize the adapter configuration by replicating and editing the `adapter_control.param.yaml` file located
+in the `autoware_auto_msgs_adapter/config` directory. Example configuration:
+
+```yaml
+/**:
+  ros__parameters:
+    msg_type_target: "autoware_auto_control_msgs::msg::AckermannControlCommand"
+    topic_name_source: "/control/command/control_cmd"
+    topic_name_target: "/control/command/control_cmd_auto"
+```
+
+Set the `msg_type_target` parameter to the desired target message type from `autoware_auto_msgs`.
+
+Make sure that the `msg_type_target` has the correspondence
+in [src/autoware_auto_msgs_adapter_core.cpp](src/autoware_auto_msgs_adapter_core.cpp).
+
+Launch the adapter node by any of the following methods:
+
+### `ros2 launch`
+
+```bash
+ros2 launch autoware_auto_msgs_adapter autoware_auto_msgs_adapter.launch.xml param_path:='full_path_to_param_file'
+```
+
+Make sure to set the `param_path` argument to the full path of the parameter file.
+
+Alternatively,
+
+- You can replicate and edit the launch file to suit to your needs.
+- You can make use of the existing launch file in another launch file by providing the parameter file path as an
+  argument.
+
+### `ros2 run`
+
+```bash
+ros2 run autoware_auto_msgs_adapter autoware_auto_msgs_adapter_exe --ros-args --params-file 'full_path_to_param_file'
+```
+
+Make sure to set the `param_path` argument to the full path of the parameter file.
+
+## Contributing
+
+### Current implementation details
+
+The entry point for the adapter executable is created with `RCLCPP_COMPONENTS_REGISTER_NODE` the [autoware_auto_msgs_adapter_core.cpp](src/Fautoware_auto_msgs_adapter_core.cpp).
+
+This allows it to be launched as a component or as a standalone node.
+
+In the `AutowareAutoMsgsAdapterNode` constructor, the adapter is selected by the type string provided in the
+configuration file. The adapter is then initialized with the topic names provided.
+
+The constructors of the adapters are responsible for creating the publisher and subscriber (which makes use of the conversion method).
+
+### Adding a new message pair
+
+To add a new message pair,
+
+- Replicate and edit:
+  - [adapter_control.hpp](include/autoware_auto_msgs_adapter/adapter_control.hpp).
+  - Add the new header file to the [CMakeLists.txt](CMakeLists.txt).
+- Add a new entry in the if-else if block in the constructor of the adapter node:
+  - [autoware_auto_msgs_adapter_core.cpp](src/autoware_auto_msgs_adapter_core.cpp)
+- Create a new config file by replicating and editing:
+  - [adapter_control.param.yaml](config/adapter_control.param.yaml)
+- Add a new test file by replicating and editing:
+  - [test_msg_ackerman_control_command.cpp](test/test_msg_ackerman_control_command.cpp)
+  - No need to edit the `CMakeLists.txt` file as it will automatically detect the new test file.
+
+Also make sure to test the new adapter with:
+
+```bash
+colcon test --event-handlers console_cohesion+ --packages-select autoware_auto_msgs_adapter
+```

simulator/autoware_auto_msgs_adapter/config/adapter_control.param.yaml

@@ -0,0 +1,5 @@
+/**:
+  ros__parameters:
+    msg_type_target: "autoware_auto_control_msgs::msg::AckermannControlCommand"
+    topic_name_source: "/control/command/control_cmd"
+    topic_name_target: "/control/command/control_cmd_auto"

simulator/autoware_auto_msgs_adapter/include/autoware_auto_msgs_adapter/adapter_base.hpp

@@ -0,0 +1,57 @@
+// Copyright 2023 The Autoware Foundation
+//
+// 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.
+#ifndef AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_BASE_HPP_
+#define AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_BASE_HPP_
+
+#include "autoware_auto_msgs_adapter/adapter_base_interface.hpp"
+
+#include <rclcpp/rclcpp.hpp>
+
+#include <memory>
+#include <string>
+
+namespace autoware_auto_msgs_adapter
+{
+
+template <typename SourceT, typename TargetT>
+class AdapterBase : public AdapterBaseInterface
+{
+public:
+  RCLCPP_SHARED_PTR_DEFINITIONS(AdapterBase<SourceT, TargetT>)
+
+  AdapterBase(
+    rclcpp::Node & node, const std::string & topic_name_source,
+    const std::string & topic_name_target, const rclcpp::QoS & qos = rclcpp::QoS{1})
+  {
+    pub_target_ = node.create_publisher<TargetT>(topic_name_target, qos);
+    sub_source_ = node.create_subscription<SourceT>(
+      topic_name_source, qos, std::bind(&AdapterBase::callback, this, std::placeholders::_1));
+  }
+
+protected:
+  virtual TargetT convert(const SourceT & msg_source) = 0;
+
+private:
+  typename rclcpp::Publisher<TargetT>::SharedPtr pub_target_;
+  typename rclcpp::Subscription<SourceT>::SharedPtr sub_source_;
+
+  void callback(const typename SourceT::SharedPtr msg_source)
+  {
+    pub_target_->publish(convert(*msg_source));
+  }
+};
+
+}  // namespace autoware_auto_msgs_adapter
+
+#endif  // AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_BASE_HPP_

simulator/autoware_auto_msgs_adapter/include/autoware_auto_msgs_adapter/adapter_base_interface.hpp

@@ -0,0 +1,34 @@
+// Copyright 2023 The Autoware Foundation
+//
+// 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.
+#ifndef AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_BASE_INTERFACE_HPP_
+#define AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_BASE_INTERFACE_HPP_
+
+#include <rclcpp/rclcpp.hpp>
+
+#include <memory>
+
+namespace autoware_auto_msgs_adapter
+{
+
+class AdapterBaseInterface
+{
+public:
+  RCLCPP_SHARED_PTR_DEFINITIONS(AdapterBaseInterface)
+
+  virtual ~AdapterBaseInterface() = default;
+};
+
+}  // namespace autoware_auto_msgs_adapter
+
+#endif  // AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_BASE_INTERFACE_HPP_

simulator/autoware_auto_msgs_adapter/include/autoware_auto_msgs_adapter/adapter_control.hpp

@@ -0,0 +1,69 @@
+// Copyright 2023 The Autoware Foundation
+//
+// 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.
+#ifndef AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_CONTROL_HPP_
+#define AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_CONTROL_HPP_
+
+#include "autoware_auto_msgs_adapter/adapter_base.hpp"
+
+#include <rclcpp/rclcpp.hpp>
+
+#include <autoware_auto_control_msgs/msg/ackermann_control_command.hpp>
+#include <autoware_control_msgs/msg/control.hpp>
+
+#include <string>
+
+namespace autoware_auto_msgs_adapter
+{
+using autoware_auto_control_msgs::msg::AckermannControlCommand;
+using autoware_control_msgs::msg::Control;
+
+class AdapterControl
+: public autoware_auto_msgs_adapter::AdapterBase<Control, AckermannControlCommand>
+{
+public:
+  AdapterControl(
+    rclcpp::Node & node, const std::string & topic_name_source,
+    const std::string & topic_name_target, const rclcpp::QoS & qos = rclcpp::QoS{1})
+  : AdapterBase(node, topic_name_source, topic_name_target, qos)
+  {
+    RCLCPP_DEBUG(
+      node.get_logger(), "AdapterControl is initialized to convert: %s -> %s",
+      topic_name_source.c_str(), topic_name_target.c_str());
+  }
+
+protected:
+  AckermannControlCommand convert(const Control & msg_source) override
+  {
+    autoware_auto_control_msgs::msg::AckermannControlCommand msg_auto;
+    msg_auto.stamp = msg_source.stamp;
+
+    const auto & lateral = msg_source.lateral;
+    auto & lateral_auto = msg_auto.lateral;
+    lateral_auto.stamp = lateral.stamp;
+    lateral_auto.steering_tire_angle = lateral.steering_tire_angle;
+    lateral_auto.steering_tire_rotation_rate = lateral.steering_tire_rotation_rate;
+
+    const auto & longitudinal = msg_source.longitudinal;
+    auto & longitudinal_auto = msg_auto.longitudinal;
+    longitudinal_auto.stamp = longitudinal.stamp;
+    longitudinal_auto.acceleration = longitudinal.acceleration;
+    longitudinal_auto.jerk = longitudinal.jerk;
+    longitudinal_auto.speed = longitudinal.velocity;
+
+    return msg_auto;
+  }
+};
+}  // namespace autoware_auto_msgs_adapter
+
+#endif  // AUTOWARE_AUTO_MSGS_ADAPTER__ADAPTER_CONTROL_HPP_

simulator/autoware_auto_msgs_adapter/include/autoware_auto_msgs_adapter/autoware_auto_msgs_adapter_core.hpp

@@ -0,0 +1,36 @@
+// Copyright 2023 The Autoware Foundation
+//
+// 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.
+#ifndef AUTOWARE_AUTO_MSGS_ADAPTER__AUTOWARE_AUTO_MSGS_ADAPTER_CORE_HPP_
+#define AUTOWARE_AUTO_MSGS_ADAPTER__AUTOWARE_AUTO_MSGS_ADAPTER_CORE_HPP_
+
+#include "autoware_auto_msgs_adapter/adapter_control.hpp"
+
+#include <rclcpp/rclcpp.hpp>
+
+#include <map>
+
+namespace autoware_auto_msgs_adapter
+{
+
+class AutowareAutoMsgsAdapterNode : public rclcpp::Node
+{
+public:
+  explicit AutowareAutoMsgsAdapterNode(const rclcpp::NodeOptions & node_options);
+
+private:
+  AdapterBaseInterface::SharedPtr adapter_;
+};
+}  // namespace autoware_auto_msgs_adapter
+
+#endif  // AUTOWARE_AUTO_MSGS_ADAPTER__AUTOWARE_AUTO_MSGS_ADAPTER_CORE_HPP_

simulator/autoware_auto_msgs_adapter/launch/autoware_auto_msgs_adapter.launch.xml

@@ -0,0 +1,8 @@
+<?xml version="1.0" encoding="UTF-8"?>
+<launch>
+  <arg name="param_path" default="$(find-pkg-share autoware_auto_msgs_adapter)/config/adapter_control.param.yaml"/>
+
+  <node pkg="autoware_auto_msgs_adapter" exec="autoware_auto_msgs_adapter_exe" name="autoware_auto_msgs_adapter" output="screen">
+    <param from="$(var param_path)"/>
+  </node>
+</launch>

simulator/autoware_auto_msgs_adapter/package.xml

@@ -0,0 +1,27 @@
+<?xml version="1.0"?>
+<?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
+<package format="3">
+  <name>autoware_auto_msgs_adapter</name>
+  <version>1.0.0</version>
+  <description>Converts an autoware_msgs message to autoware_auto_msgs version and publishes it.</description>
+  <maintainer email="mfc@leodrive.ai">M. Fatih Cırıt</maintainer>
+  <license>Apache License 2.0</license>
+
+  <buildtool_depend>ament_cmake_auto</buildtool_depend>
+  <buildtool_depend>autoware_cmake</buildtool_depend>
+
+  <build_depend>rosidl_default_generators</build_depend>
+
+  <test_depend>ament_cmake_ros</test_depend>
+  <test_depend>ament_lint_auto</test_depend>
+  <test_depend>autoware_lint_common</test_depend>
+
+  <depend>autoware_auto_control_msgs</depend>
+  <depend>autoware_control_msgs</depend>
+  <depend>rclcpp</depend>
+  <depend>rclcpp_components</depend>
+
+  <export>
+    <build_type>ament_cmake</build_type>
+  </export>
+</package>