ROS 将16进制的数组的每个元素打印到log

在 ROS 中，可以使用 `ROS_INFO`、`ROS_DEBUG`、`ROS_WARN` 等函数将信息打印到 log 中。如果要将一个16进制的数组的每个元素打印到 log 中，可以使用下面的代码：

uint8_t hex_array[] = {0x12, 0x34, 0xAB, 0xCD};
int len = sizeof(hex_array) / sizeof(hex_array[0]);

std::ostringstream oss;
for (int i = 0; i < len; i++) {
  oss << std::hex << std::setw(2) << std::setfill('0') << static_cast<int>(hex_array[i]) << " ";
}
ROS_INFO("Hex array: %s", oss.str().c_str());

以上代码中，我们使用了 `std::ostringstream` 类型的对象 `oss` 来拼接每个元素，最后将拼接好的字符串传给 `ROS_INFO` 函数进行打印。在拼接时，我们使用了 `std::hex` 来指定输出16进制数，`std::setw(2)` 和 `std::setfill('0')` 用于指定输出的宽度和填充字符，最后通过 `static_cast<int>` 将 uint8_t 类型转换为 int 类型。

相关问题

ROS_INFO_STREAM打印16进制显示

要在ROS_INFO_STREAM中打印16进制显示，您可以使用std::hex流控制符来设置输出流的格式。下面是一个示例代码片段：

#include <ros/ros.h>

int main(int argc, char** argv) {
  ros::init(argc, argv, "hex_printer");
  ros::NodeHandle nh;

  int value = 255;

  ROS_INFO_STREAM("Hex value: " << std::hex << value);

  ros::spin();
  
  return 0;
}

在上面的代码中，我们将value设置为255，并使用std::hex流控制符将输出流的格式设置为十六进制。然后，我们使用ROS_INFO_STREAM来打印带有十六进制值的消息。当您运行上述代码时，将在ROS日志中看到类似以下的输出：

[INFO] [node_name]: Hex value: ff

请注意，在使用std::hex流控制符之后，输出流将保持为十六进制格式，直到您显式地更改它。

ROS将接受到的十六进制串口数据 写入自定义的msg类型

在 ROS 中，可以通过自定义消息类型来表示接收到的十六进制串口数据，然后将其发布出去。下面是实现的步骤：

1. 创建一个名为 "MyMessage" 的消息类型，包含一个名为 "data" 的字节数组：

byte[] data

2. 在 ROS 节点中，订阅串口消息。可以使用 ROS 自带的 serial 包或者第三方的库，如 Boost.Asio 库等来实现。在回调函数中，将接收到的十六进制串口数据转换成字节数组，并填充到自定义消息类型的 "data" 变量中。

#include "my_package/MyMessage.h"
#include "ros/ros.h"
#include <boost/asio.hpp>

void serialCallback(const boost::system::error_code& error, std::size_t bytes_transferred, boost::asio::serial_port& serial_port, ros::Publisher& publisher) {
  if (!error) {
    // Read data from serial port
    std::vector<uint8_t> buffer(bytes_transferred);
    boost::asio::read(serial_port, boost::asio::buffer(buffer));

    // Convert hex string to byte array
    std::vector<uint8_t> bytes;
    for (int i = 0; i < buffer.size(); i += 2) {
      std::string hex = std::string(buffer.begin() + i, buffer.begin() + i + 2);
      uint8_t byte = std::stoi(hex, nullptr, 16);
      bytes.push_back(byte);
    }

    // Publish data as MyMessage type
    my_package::MyMessage msg;
    msg.data = bytes;
    publisher.publish(msg);
  } else {
    ROS_ERROR("Error reading serial port: %s", error.message().c_str());
  }
}

int main(int argc, char** argv) {
  ros::init(argc, argv, "my_node");
  ros::NodeHandle nh;
  ros::Publisher my_publisher = nh.advertise<my_package::MyMessage>("my_topic", 10);

  // Open serial port
  boost::asio::io_service io_service;
  boost::asio::serial_port serial_port(io_service, "/dev/ttyUSB0");
  serial_port.set_option(boost::asio::serial_port_base::baud_rate(115200));

  // Start reading from serial port
  boost::asio::async_read(serial_port, boost::asio::buffer(buffer), boost::asio::transfer_at_least(1), boost::bind(&serialCallback, _1, _2, boost::ref(serial_port), boost::ref(my_publisher)));

  ros::spin();
  return 0;
}

在上述代码中，我们使用了 Boost.Asio 库来读取串口数据。在回调函数 serialCallback 中，我们首先将接收到的十六进制串口数据转换成字节数组，然后填充到自定义消息类型 MyMessage 的 "data" 变量中。最后，通过 my_publisher 发布该消息。