两台电脑完成ros串口通信,一台电脑上的串口调试助手发送一组数据,含字节头字节尾和需要输出的数;在另一台电脑的ros写一个C++程序,用于接收发来的字节头与字节尾之间的数据,并在终端显示

时间: 2024-05-03 12:22:45 浏览: 10
程序思路如下: 1. 在另一台电脑上安装ros,并创建一个新的ROS工作空间。 2. 在工作空间中创建一个新的ROS包,并在包中创建一个新的ROS节点,用于接收串口数据。 3. 在节点中订阅串口数据的话题,并编写回调函数。 4. 在回调函数中解析接收到的数据,提取需要输出的数,并在终端显示。 下面是具体的程序实现: 1. 创建ROS工作空间并新建ROS包和节点 打开终端,输入以下命令: ``` mkdir -p ~/ros_serial_test_ws/src cd ~/ros_serial_test_ws/src catkin_init_workspace cd ~/ros_serial_test_ws/ catkin_make source devel/setup.bash cd src catkin_create_pkg serial_test rospy cd serial_test mkdir src cd src touch serial_receiver.py chmod +x serial_receiver.py ``` 2. 编辑serial_receiver.py文件 在serial_receiver.py文件中,添加以下代码: ```python #!/usr/bin/env python import rospy from std_msgs.msg import String def callback(data): # 解析串口数据,提取需要输出的数 serial_data = data.data # 判断数据是否合法 if len(serial_data) >= 3 and serial_data[0] == 0x01 and serial_data[-1] == 0x02: output_data = serial_data[1:-1] output_str = '' for byte in output_data: output_str += str(byte) + ' ' # 在终端显示输出的数 rospy.loginfo("Output data: %s", output_str) else: rospy.logwarn("Invalid serial data: %s", serial_data) def serial_receiver(): # 初始化ROS节点 rospy.init_node('serial_receiver', anonymous=True) # 订阅串口数据的话题 rospy.Subscriber("serial_data", String, callback) # 循环等待回调函数 rospy.spin() if __name__ == '__main__': serial_receiver() ``` 代码注释: - `import rospy`:导入ROS Python库。 - `from std_msgs.msg import String`:导入ROS标准消息库中的String类型。 - `def callback(data)`:定义回调函数,处理接收到的串口数据。 - `serial_data = data.data`:获取串口数据。 - `if len(serial_data) >= 3 and serial_data[0] == 0x01 and serial_data[-1] == 0x02:`:判断串口数据是否合法。合法的数据应该包含字节头、字节尾和需要输出的数,字节头为0x01,字节尾为0x02。 - `output_data = serial_data[1:-1]`:提取需要输出的数。 - `output_str = ''`:初始化输出字符串。 - `for byte in output_data: output_str += str(byte) + ' '`:将需要输出的数转换成字符串。 - `rospy.loginfo("Output data: %s", output_str)`:在终端显示输出的数。 - `rospy.logwarn("Invalid serial data: %s", serial_data)`:在终端显示无效的串口数据。 - `def serial_receiver()`:定义主函数,初始化ROS节点,订阅串口数据的话题,循环等待回调函数。 - `if __name__ == '__main__': serial_receiver()`:如果该模块是程序的入口,则执行主函数。 3. 编写串口调试助手 打开串口调试助手,设置串口参数和发送数据。发送的数据应包含字节头、字节尾和需要输出的数。 例如,发送以下数据: ``` 01 12 34 56 78 02 ``` 其中,0x01表示字节头,0x02表示字节尾,0x12 0x34 0x56 0x78表示需要输出的数。 4. 运行程序 打开终端,输入以下命令: ``` cd ~/ros_serial_test_ws/ source devel/setup.bash rosrun serial_test serial_receiver.py ``` 如果一切正常,终端应该显示输出的数: ``` [INFO] [1631924142.116638]: Output data: 18 52 86 120 ``` 如果串口数据不合法,终端应该显示无效的串口数据: ``` [WARN] [1631924256.524063]: Invalid serial data: 01 12 34 56 ```

相关推荐

帮我修改#include <ros/console.h> #include <ros/ros.h> #include <serial/serial.h> #include <iostream> #include <std_msgs/String.h> #include <std_msgs/Empty.h> serial::Serial sp; //回调函数 void write_callback(const std_msgs::String::ConstPtr& msg) { ROS_INFO_STREAM("Writing to serial port" <<msg->data); sp.write(msg->data); //发送串口数据 } int main(int argc, char** argv) { ros::init(argc, argv, "serial_port_servos"); ros::NodeHandle nnode; ros::Subscriber write_sub = nnode.subscribe("write", 1000, write_callback); ros::Publisher read_pub = nnode.advertise<std_msgs::String>("read", 1000); serial::Timeout to = serial::Timeout::simpleTimeout(100); //设置要打开的串口名称 sp.setPort("/dev/ttyUSB0"); //设置串口通信的波特率 sp.setBaudrate(9600); //串口设置timeout serial::Timeout to = serial::Timeout::simpleTimeout(1000); sp.setTimeout(to); try { //打开串口 sp.open(); } catch(serial::IOException& e) { ROS_ERROR_STREAM("Unable to open port."); return -1; } //判断串口是否打开成功 if(sp.isOpen()) { ROS_INFO_STREAM("/dev/ttyUSB0 is opened."); } else { return -1; } ros::Rate loop_rate(500); while(ros::ok()) { //获取缓冲区内的字节数 size_t n = sp.available(); if(n!=0) { ROS_INFO_STREAM("Reading from serial port\n"); uint8_t buffer[1024]; //读出数据 n = sp.read(buffer, n); std_msgs::String result; result.data = sp.read(sp.available()); ROS_INFO_STREAM("Read: " << result.data); read_pub.publish(result); /* for(int i=0; i<n; i++) { //16进制的方式打印到屏幕 std::cout << std::hex << (buffer[i] & 0xff) << " "; } std::cout << std::endl; //把数据发送回去 sp.write(buffer, n); } */ ros::spinOnce(); loop_rate.sleep(); } //关闭串口 sp.close(); return 0; }

#include <ros/console.h> #include <ros/ros.h> #include <serial/serial.h> #include <iostream> #include <std_msgs/String.h> #include <std_msgs/Empty.h> #include <std_msgs/ByteMultiArray.h> serial::Serial sp;// 回调函数 void write_callback(const std_msgs::String::ConstPtr& msg) { ROS_INFO_STREAM("Writing to serial port " << msg->data); sp.write(msg->data); } int main(int argc, char** argv) { ros::init(argc, argv, "serial_port_servos"); ros::NodeHandle nnode; ros::Subscriber write_sub = nnode.subscribe("write", 1000, write_callback); ros::Publisher read_pub = nnode.advertise<std_msgs::ByteMultiArray>("read", 1000); serial::Timeout to = serial::Timeout::simpleTimeout(100); // 设置要打开的串口名称 sp.setPort("/dev/ttyUSB0"); // 设置串口通信的波特率 sp.setBaudrate(9600); // 串口设置timeout sp.setTimeout(to); try { // 打开串口 sp.open(); } catch(serial::IOException& e) { ROS_ERROR_STREAM("Unable to open port."); return -1; } // 判断串口是否打开成功 if(sp.isOpen()) { ROS_INFO_STREAM("/dev/ttyUSB0 is opened."); } else { return -1; } ros::Rate loop_rate(500); while(ros::ok()) { // 获取缓冲区内的字节数 size_t n = sp.available(); if(n != 0) { ROS_INFO_STREAM("Reading from serial port"); uint8_t buffer[1024]; // 读出数据 n = sp.read(buffer, n); std_msgs::ByteMultiArray data; for(int t = 0; i < n; i++) { uint8_t byte; sscanf(&buffer[i], "%2hhx", &byte); data.data.push_back(byte); read_pub.publish(data); /* for(int i = 0; i < n; i++) { // 16进制的方式打印到屏幕 std::cout << std::hex << (buffer[i] & 0xff) << " "; } std::cout << std::endl; // 把数据发送回去 sp.write(buffer, n); */ } ros::spinOnce(); loop_rate.sleep(); } // 关闭串口 sp.close(); return 0; }

完善代码#include <ros/console.h> #include <ros/ros.h> #include <serial/serial.h> #include <sstream> #include <std_msgs/String.h> #include <std_msgs/Empty.h> #include <std_msgs/ByteMultiArray.h> serial::Serial sp; int main(int argc, char** argv) { ros::init(argc, argv, "serial_port_servos"); ros::NodeHandle nnode; ros::Publisher read_pub = nnode.advertise<std_msgs::String>("hex_values", 1000); serial::Timeout to = serial::Timeout::simpleTimeout(100); // 设置要打开的串口名称 sp.setPort("/dev/ttyUSB0"); // 设置串口通信的波特率 sp.setBaudrate(9600); // 串口设置timeout sp.setTimeout(to); try { // 打开串口 sp.open(); } catch(serial::IOException& e) { ROS_ERROR_STREAM("Unable to open port."); return -1; } // 判断串口是否打开成功 if(sp.isOpen()) { ROS_INFO_STREAM("/dev/ttyUSB0 is opened."); } else { return -1; } ros::Rate loop_rate(500); while(ros::ok()) { byte[] dataBuffer; int[] hexArray; std::stringstream ss; // 获取缓冲区内的字节数 size_t n = sp.available(); if(n != 0) { ROS_INFO_STREAM("Reading from serial port"); uint8_t buffer[2048]; // 读出数据 n = sp.read(buffer, n); dataBuffer = new byte[1024]; hexArray = new int[1024]; for(int i = 0; i < n; i++) { hexArray[i] = dataBuffer[i].Tostring("X2"); } /*for(int i = 0; i < n; i++) { // 16进制ROS发布 ss << std::setfill('0') << std::setw(2) << std::hex << (buffer[i] & 0xff) << " "; // 16进制打印到屏幕 std::cout <<std::setfill('0') << std::setw(2) << std::hex << (buffer[i] & 0xff) << " "; }*/ std::cout << std::endl; std_msgs::String msg; msg.data = ss.str(); read_pub.publish(msg); ros::spinOnce(); loop_rate.sleep(); } } // 关闭串口 sp.close(); return 0; }

最新推荐

recommend-type

Java_Spring Boot 3主分支2其他分支和Spring Cloud微服务的分布式配置演示Spring Cl.zip

Java_Spring Boot 3主分支2其他分支和Spring Cloud微服务的分布式配置演示Spring Cl
recommend-type

ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计

ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)+编程项目+毕业设计ERP客户关系系统设计(含源代码+毕业设计文档)
recommend-type

基于MATLAB实现的V两幅图像中有重叠部分,通过数字图像相关算法可以找到两幅图像相同的点+使用说明文档.rar

CSDN IT狂飙上传的代码均可运行,功能ok的情况下才上传的,直接替换数据即可使用,小白也能轻松上手 【资源说明】 基于MATLAB实现的V两幅图像中有重叠部分,通过数字图像相关算法可以找到两幅图像相同的点+使用说明文档.rar 1、代码压缩包内容 主函数:main.m; 调用函数:其他m文件;无需运行 运行结果效果图; 2、代码运行版本 Matlab 2020b;若运行有误,根据提示GPT修改;若不会,私信博主(问题描述要详细); 3、运行操作步骤 步骤一:将所有文件放到Matlab的当前文件夹中; 步骤二:双击打开main.m文件; 步骤三:点击运行,等程序运行完得到结果; 4、仿真咨询 如需其他服务,可后台私信博主; 4.1 期刊或参考文献复现 4.2 Matlab程序定制 4.3 科研合作 功率谱估计: 故障诊断分析: 雷达通信:雷达LFM、MIMO、成像、定位、干扰、检测、信号分析、脉冲压缩 滤波估计:SOC估计 目标定位:WSN定位、滤波跟踪、目标定位 生物电信号:肌电信号EMG、脑电信号EEG、心电信号ECG 通信系统:DOA估计、编码译码、变分模态分解、管道泄漏、滤波器、数字信号处理+传输+分析+去噪、数字信号调制、误码率、信号估计、DTMF、信号检测识别融合、LEACH协议、信号检测、水声通信 5、欢迎下载,沟通交流,互相学习,共同进步!
recommend-type

全球国家列表和国家代码最详细版本

全球国家列表和国家代码最全最详细版本,国家country,code
recommend-type

grpcio-1.47.0-cp37-cp37m-manylinux_2_17_aarch64.whl

Python库是一组预先编写的代码模块,旨在帮助开发者实现特定的编程任务,无需从零开始编写代码。这些库可以包括各种功能,如数学运算、文件操作、数据分析和网络编程等。Python社区提供了大量的第三方库,如NumPy、Pandas和Requests,极大地丰富了Python的应用领域,从数据科学到Web开发。Python库的丰富性是Python成为最受欢迎的编程语言之一的关键原因之一。这些库不仅为初学者提供了快速入门的途径,而且为经验丰富的开发者提供了强大的工具,以高效率、高质量地完成复杂任务。例如,Matplotlib和Seaborn库在数据可视化领域内非常受欢迎,它们提供了广泛的工具和技术,可以创建高度定制化的图表和图形,帮助数据科学家和分析师在数据探索和结果展示中更有效地传达信息。
recommend-type

zigbee-cluster-library-specification

最新的zigbee-cluster-library-specification说明文档。
recommend-type

管理建模和仿真的文件

管理Boualem Benatallah引用此版本:布阿利姆·贝纳塔拉。管理建模和仿真。约瑟夫-傅立叶大学-格勒诺布尔第一大学,1996年。法语。NNT:电话:00345357HAL ID:电话:00345357https://theses.hal.science/tel-003453572008年12月9日提交HAL是一个多学科的开放存取档案馆,用于存放和传播科学研究论文,无论它们是否被公开。论文可以来自法国或国外的教学和研究机构,也可以来自公共或私人研究中心。L’archive ouverte pluridisciplinaire
recommend-type

【实战演练】MATLAB用遗传算法改进粒子群GA-PSO算法

![MATLAB智能算法合集](https://static.fuxi.netease.com/fuxi-official/web/20221101/83f465753fd49c41536a5640367d4340.jpg) # 2.1 遗传算法的原理和实现 遗传算法(GA)是一种受生物进化过程启发的优化算法。它通过模拟自然选择和遗传机制来搜索最优解。 **2.1.1 遗传算法的编码和解码** 编码是将问题空间中的解表示为二进制字符串或其他数据结构的过程。解码是将编码的解转换为问题空间中的实际解的过程。常见的编码方法包括二进制编码、实数编码和树形编码。 **2.1.2 遗传算法的交叉和
recommend-type

openstack的20种接口有哪些

以下是OpenStack的20种API接口: 1. Identity (Keystone) API 2. Compute (Nova) API 3. Networking (Neutron) API 4. Block Storage (Cinder) API 5. Object Storage (Swift) API 6. Image (Glance) API 7. Telemetry (Ceilometer) API 8. Orchestration (Heat) API 9. Database (Trove) API 10. Bare Metal (Ironic) API 11. DNS
recommend-type

JSBSim Reference Manual

JSBSim参考手册,其中包含JSBSim简介,JSBSim配置文件xml的编写语法,编程手册以及一些应用实例等。其中有部分内容还没有写完,估计有生之年很难看到完整版了,但是内容还是很有参考价值的。