ROS入门教程：使用rostopic发布单次消息与节点存在性判断

1. 引言

在ROS开发过程中，我们经常需要测试消息发布和检查节点状态。本文将详细介绍如何使用rostopic命令发布单次消息，以及如何判断ROS节点是否存在。这些技巧对于调试和监控ROS系统非常实用。

2. 准备工作

在开始之前，确保您已经安装了ROS并启动了ROS Master：

# 启动ROS Master
roscore

3. 使用rostopic发布单次消息

3.1 基本语法

rostopic pub [参数] 话题名称 消息类型 "消息内容"

主要参数：

• -1 或 –once：只发布一次消息

• -r 频率：以指定频率持续发布消息

• -f 文件名：从文件中读取消息内容

3.2 常见消息类型的发布示例

示例1：发布空消息

# 发布Empty消息到/topic_name话题
rostopic pub -1 /topic_name std_msgs/Empty

示例2：发布字符串消息

# 发布字符串消息到/chatter话题
rostopic pub -1 /chatter std_msgs/String "data: 'Hello World'"

示例3：发布整数消息

# 发布整数消息到/counter话题
rostopic pub -1 /counter std_msgs/Int32 "data: 42"

示例4：发布浮点数消息

# 发布浮点数消息到/sensor话题
rostopic pub -1 /sensor std_msgs/Float32 "data: 3.1415"

示例5：发布位姿消息

# 发布位姿消息到/pose话题
rostopic pub -1 /pose geometry_msgs/Pose "
position:
x: 1.0
y: 2.0
z: 0.0
orientation:
x: 0.0
y: 0.0
z: 0.0
w: 1.0"

示例6：发布Twist消息控制机器人

# 发布线速度和角速度命令到/cmd_vel话题
rostopic pub -1 /cmd_vel geometry_msgs/Twist "
linear:
x: 0.5
y: 0.0
z: 0.0
angular:
x: 0.0
y: 0.0
z: 0.4"

示例7：发布激光扫描消息

# 发布简化的激光扫描消息
rostopic pub -1 /scan sensor_msgs/LaserScan "
header:
frame_id: 'laser_frame'
angle_min: -1.57
angle_max: 1.57
angle_increment: 0.017
range_min: 0.1
range_max: 10.0
ranges: [1.0, 2.0, 3.0, 2.0, 1.0]
intensities: [100, 200, 300, 200, 100]"

3.3 高级用法

从文件读取消息内容

# 创建消息文件 message.yaml
cat > message.yaml << EOF
linear:
x: 0.5
y: 0.0
z: 0.0
angular:
x: 0.0
y: 0.0
z: 0.4
EOF

# 从文件发布消息
rostopic pub -1 /cmd_vel geometry_msgs/Twist -f message.yaml

使用管道传递消息

# 结合其他命令生成消息内容
echo "data: 'Hello from pipe'" | rostopic pub -1 /chatter std_msgs/String

4. 判断ROS节点是否存在

4.1 方法一：使用rosnode list和grep

# 基本用法
rosnode list | grep <节点名称>

# 示例：检查/turtlesim节点
rosnode list | grep /turtlesim

# 输出结果：如果节点存在，显示节点名称；否则无输出

4.2 方法二：使用rosnode info

# 基本用法
rosnode info <节点名称> > /dev/null 2>&1 && echo "节点存在" || echo "节点不存在"

# 示例
rosnode info /turtlesim > /dev/null 2>&1 && echo "节点存在" || echo "节点不存在"

# 输出结果：
# 如果节点存在：节点存在
# 如果节点不存在：节点不存在

4.3 方法三：使用rosnode ping

# 基本用法
rosnode ping <节点名称> -c 1 > /dev/null 2>&1 && echo "节点存在" || echo "节点不存在"

# 示例
rosnode ping /turtlesim -c 1 > /dev/null 2>&1 && echo "节点存在" || echo "节点不存在"

# 输出结果：
# 如果节点存在：节点存在
# 如果节点不存在：节点不存在

4.4 方法四：在Shell脚本中使用

#!/bin/bash

# 定义要检查的节点名称
NODE_NAME="/turtlesim"

# 方法1：使用grep
if rosnode list | grep -q "$NODE_NAME"; then
echo "[$(date)] 节点 $NODE_NAME 存在"
else
echo "[$(date)] 节点 $NODE_NAME 不存在"
fi

# 方法2：使用rosnode ping
if rosnode ping "$NODE_NAME" -c 1 2>/dev/null | grep -q "response"; then
echo "[$(date)] 节点 $NODE_NAME 正在响应"
else
echo "[$(date)] 节点 $NODE_NAME 未响应"
fi

# 方法3：使用rosnode info
if rosnode info "$NODE_NAME" 2>/dev/null >/dev/null; then
echo "[$(date)] 节点 $NODE_NAME 信息可查询"
else
echo "[$(date)] 节点 $NODE_NAME 信息不可查询"
fi

4.5 方法五：使用ROS Python API

#!/usr/bin/env python
# -*- coding: utf-8 -*-

import rospy
import sys

def check_node_exists(node_name):
"""
检查ROS节点是否存在

参数:
node_name: 节点名称（字符串）

返回:
bool: 节点存在返回True，否则返回False
"""
try:
# 获取节点列表
nodes = rospy.get_node_names()
return node_name in nodes
except Exception as e:
rospy.logerr("检查节点时出错: %s", str(e))
return False

def main():
# 初始化节点
rospy.init_node('node_checker', anonymous=True)

# 要检查的节点名称
target_node = '/turtlesim'

# 检查节点
if check_node_exists(target_node):
rospy.loginfo("节点 %s 存在", target_node)
else:
rospy.loginfo("节点 %s 不存在", target_node)

# 获取所有节点
all_nodes = rospy.get_node_names()
rospy.loginfo("当前所有节点: %s", all_nodes)

if __name__ == '__main__':
main()

5. 综合实战示例

5.1 场景：发布消息前检查节点状态

#!/bin/bash

# 综合脚本：检查节点是否存在，如果存在则发布消息

NODE_NAME="/turtlesim"
TOPIC_NAME="/cmd_vel"
MSG_TYPE="geometry_msgs/Twist"

# 检查节点是否存在
if rosnode list | grep -q "$NODE_NAME"; then
echo "✅ 节点 $NODE_NAME 存在"

# 检查话题是否存在订阅者
if rostopic info "$TOPIC_NAME" 2>/dev/null | grep -q "Subscribers"; then
echo "✅ 话题 $TOPIC_NAME 有订阅者"

# 发布单次消息
echo "发布控制命令…"
rostopic pub -1 "$TOPIC_NAME" "$MSG_TYPE" "
linear:
x: 0.5
y: 0.0
z: 0.0
angular:
x: 0.0
y: 0.0
z: 0.4"

echo "✅ 消息发布完成"
else
echo "❌ 话题 $TOPIC_NAME 没有订阅者，消息可能被丢弃"
exit 1
fi
else
echo "❌ 节点 $NODE_NAME 不存在"
exit 1
fi

5.2 场景：等待节点启动

#!/bin/bash

# 等待节点启动脚本

NODE_NAME="/turtlesim"
TIMEOUT=30 # 超时时间（秒）
INTERVAL=2 # 检查间隔（秒）

echo "等待节点 $NODE_NAME 启动…"
start_time=$(date +%s)

while true; do
if rosnode list | grep -q "$NODE_NAME"; then
echo "✅ 节点 $NODE_NAME 已启动"
break
fi

current_time=$(date +%s)
elapsed=$((current_time – start_time))

if [ $elapsed -ge $TIMEOUT ]; then
echo "❌ 等待节点 $NODE_NAME 启动超时"
exit 1
fi

echo "仍在等待… (已等待 ${elapsed}秒)"
sleep $INTERVAL
done

# 节点已启动，发布初始化消息
echo "发布初始化消息…"
rostopic pub -1 /chatter std_msgs/String "data: 'Node started successfully'"
echo "✅ 完成"

6. 常见问题与解决方案

6.1 问题1：发布消息时提示"Topic is not published yet"

原因：话题还没有任何发布者或订阅者。

解决方案：

# 确保有节点订阅了该话题
rostopic echo /chatter # 启动监听
# 在另一个终端发布消息
rostopic pub -1 /chatter std_msgs/String "data: 'Hello'"

6.2 问题2：节点存在但rosnode ping失败

原因：节点可能已经停止响应或网络问题。

解决方案：

# 使用rosnode info获取详细信息
rosnode info /节点名称

# 清理失效节点信息
rosnode cleanup

6.3 问题3：消息格式错误

原因：YAML格式不正确。

解决方案：

# 使用rostopic pub自动补全格式
rostopic pub /chatter std_msgs/String "data: 'Hello'" # 按Tab键自动补全格式

7. 总结

本文详细介绍了ROS中两个实用的操作：

这些技巧在日常ROS开发和调试中非常实用，能够帮助开发者快速测试和监控ROS系统。建议在实际项目中根据需要选择合适的方法，并结合脚本自动化提高工作效率。

8. 参考资料

• ROS Wiki: http://wiki.ros.org/rostopic

• ROS Wiki: http://wiki.ros.org/rosnode

• ROS消息类型文档: http://wiki.ros.org/std_msgs

• YAML格式说明: https://yaml.org/