以下是对使用 `rospy` 库订阅 ROS 话题消息实现监听功能的 Python 代码的详细解释和优化建议： ### 代码示例 ```python #!/usr/bin/env python import rospy from std_msgs.msg import String def callback(data): rospy.loginfo(rospy.get_caller_id() + "I heard %s", data.data) def listener(): # 初始化订阅者节点 rospy.init_node('listener', anonymous=True) # 创建一个订阅者，订阅"chatter"话题，消息类型为String rospy.Subscriber("chatter", String, callback) # 保持节点运行，直到被关闭 rospy.spin() if __name__ == '__main__': listener() ``` ### 代码解释 1. **导入必要的库**： ```python import rospy from std_msgs.msg import String ``` `rospy` 是 ROS 的 Python 客户端库，用于与 ROS 系统进行交互。`std_msgs.msg.String` 是标准消息类型，用于表示字符串消息。 2. **定义回调函数**： ```python def callback(data): rospy.loginfo(rospy.get_caller_id() + "I heard %s", data.data) ``` 当订阅的话题接收到新消息时，会调用这个回调函数。`rospy.loginfo` 用于记录日志信息，`rospy.get_caller_id()` 获取当前节点的标识符，`data.data` 是接收到的消息内容。 3. **初始化节点并创建订阅者**： ```python rospy.init_node('listener', anonymous=True) rospy.Subscriber("chatter", String, callback) ``` `rospy.init_node` 初始化一个名为 `listener` 的节点，`anonymous=True` 表示节点名后面会添加一个随机数，确保节点名的唯一性。`rospy.Subscriber` 创建一个订阅者，订阅 `chatter` 话题，消息类型为 `String`，当接收到消息时调用 `callback` 函数。 4. **保持节点运行**： ```python rospy.spin() ``` `rospy.spin()` 使节点进入循环，持续监听话题消息，直到节点被关闭。 ### 优化建议 1. **错误处理**： 在 `listener` 函数中添加异常处理，以捕获可能的 `ROSInterruptException` 异常，当节点被关闭时可以正常退出。 ```python def listener(): try: rospy.init_node('listener', anonymous=True) rospy.Subscriber("chatter", String, callback) rospy.spin() except rospy.ROSInterruptException: pass ``` 2. **日志级别设置**： 可以根据需要设置日志级别，例如将日志级别设置为 `rospy.DEBUG` 以获取更详细的调试信息。 ```python rospy.init_node('listener', anonymous=True) rospy.logdebug("Starting listener node...") ``` 3. **订阅多个话题**： 如果需要订阅多个话题，可以创建多个 `rospy.Subscriber` 对象。 ```python def callback1(data): rospy.loginfo("Received message from topic1: %s", data.data) def callback2(data): rospy.loginfo("Received message from topic2: %s", data.data) rospy.init_node('listener', anonymous=True) rospy.Subscriber("topic1", String, callback1) rospy.Subscriber("topic2", String, callback2) rospy.spin() ```