修改代码 ROS_ERROR_STREAM("Unable to open port."); return -1; } // 判断串口是否打开成功 if(sp.isOpen()) { ROS_INFO_STREAM("/dev/ttyUSB0 is opened."); } else { return -1; } //初始化数组 dataBuffer = new unsigned char[1024]; hexArray = new int[1024]; ros::Rate loop_rate(500); while(ros::ok()) { // 获取缓冲区内的字节数 size_t n = sp.available(); if(n != 0) { ROS_INFO_STREAM("Reading from serial port"); // 读出数据 n = sp.read(dataBuffer, n); for(int i = 0; i < n; i++) { hexArray[i] = std::stoi(std::to_string(dataBuffer[i]),0,16); }使得hexArray全为十进制整型存储
时间: 2024-01-24 10:04:44 浏览: 147
以下是修改后的代码,可以将 dataBuffer 数组中的每个元素转换为十进制整型,并将结果存储在 hexArray 数组中:
```
ROS_ERROR_STREAM("Unable to open port.");
return -1;
// 判断串口是否打开成功
if(sp.isOpen())
{
ROS_INFO_STREAM("/dev/ttyUSB0 is opened.");
}
else
{
return -1;
}
//初始化数组
dataBuffer = new unsigned char[1024];
hexArray = new int[1024];
ros::Rate loop_rate(500);
while(ros::ok())
{
// 获取缓冲区内的字节数
size_t n = sp.available();
if(n != 0)
{
ROS_INFO_STREAM("Reading from serial port");
// 读出数据
n = sp.read(dataBuffer, n);
// 将每个字符转换为十进制整型,并存储到 hexArray 中
for(int i = 0; i < n; i++)
{
hexArray[i] = static_cast<int>(dataBuffer[i]);
}
}
loop_rate.sleep();
}
```
在修改后的代码中,使用 static_cast<>() 将每个字符转换为其对应的十进制整型,并将结果存储在 hexArray 数组中。需要注意的是,由于 dataBuffer 数组中的元素类型为 unsigned char,因此转换后存储到 hexArray 数组中的元素类型也为 int。
阅读全文