【机器人】ROS1工程案例：基础部分

手把手教你搭建一个传递数字消息的机器人程序。

:sparkles:注意

本文只提供在Linux平台上的代码演示和最基本的注释，不进行逻辑的解释。

:sparkles:安装ROS1环境

:sparkles:搭建环境

cd ~/Desktop
# 在桌面上新建工作区，方便观看过程
mkdir -p rob_dev_ws/src
cd rob_dev_ws/src
catkin_init_workspace

Screenshot from 2021-12-29 09-06-24

:sparkles:创建包

在src路径下执行

1 2	# 这里使用python，所以我们依赖 rospy catkin_create_pkg communicate_bot rospy

:sparkles:开始编程

包内src路径下放置我们的代码。

首先是发送端，文件名叫做：topic_publisher.py

#!/usr/bin/env python3

import rospy
from std_msgs.msg import Int32


class Publisher():
    count = 0

    def Publisher():
        pass

    def publish(self):
        rospy.init_node('topic_publisher') # 初始化节点
        pub = rospy.Publisher('counter', Int32, queue_size=10)
        rate = rospy.Rate(2) # 定义频率单位为：Hz
        while not rospy.is_shutdown():
            pub.publish(self.count)
            self.count += 1
            print(self.count)
            rate.sleep()


if __name__ == '__main__':
    publisher = Publisher()
    publisher.publish()

我们采用面向对象的思想进行编程，方便未来增改需求。

接下来是接收端，文件名称叫做topic_subscriber.py

#!/usr/bin/env python3

import rospy
from std_msgs.msg import Int32

class Subscriber():
    def Subscriber():
        pass

    def listen(self):
        rospy.init_node('topic_subscriber')
        # 最后一个参数传递回调函数，如何处理数据
        sub = rospy.Subscriber('counter', Int32, lambda msg : print(msg.data))
        rospy.spin() # 阻塞等待，将程序交到ROS管理
      
      
if __name__ == "__main__":
    subscriber = Subscriber()
    subscriber.listen()