一、发布者Publish的编程实现
在上一小节中我们创建了工作空间和功能包,那么在这一小节里面我们将再创造一个功能包来实现一定的功能。
二、创建一个新的功能包
如果你是按照上一节的逻辑创建工作空间和功能包的话,那么
cd ~/catkin_ws/src
里面会有你上一节创作的一个叫做test_pkg的功能包,这个功能包没有什么代码,在本节也没有太多用处,我们可以rm -rf test_pkg
再建造一个叫做learning_topic的功能包,当然不是用mkdir,而是
catkin_create_pkg learning_topic std_msgs roscpp rospy geometry_msgs turtlesim
三、编写Publish的代码。
cd ~/catkin_ws/src/learning_pkg/src
touch velocity_publisher.cpp
ifconfig 这个命令如果您是按照我的我的ROS笔记来操作的话应该可以使用,不能的话就用sudo apt install net-tools安装相关工具。
这里使用nodepad++远程连接来编辑代码会方便很多。
/***********************************************************************
Copyright 2020 GuYueHome (www.guyuehome.com).
***********************************************************************/
/**
* 该例程将发布turtle1/cmd_vel话题,消息类型geometry_msgs::Twist
*/
#include <ros/ros.h>
#include <geometry_msgs/Twist.h>
int main(int argc, char **argv)
{
// ROS节点初始化
ros::init(argc, argv, "velocity_publisher");
// 创建节点句柄
ros::NodeHandle n;
// 创建一个Publisher,发布名为/turtle1/cmd_vel的topic,消息类型为geometry_msgs::Twist,队列长度10
ros::Publisher turtle_vel_pub = n.advertise<geometry_msgs::Twist>("/turtle1/cmd_vel", 10);
// 设置循环的频率
ros::Rate loop_rate(10);
int count = 0;
while (ros::ok())
{
// 初始化geometry_msgs::Twist类型的消息
geometry_msgs::Twist vel_msg;
vel_msg.linear.x = 0.5;
vel_msg.angular.z = 0.2;
// 发布消息
turtle_vel_pub.publish(vel_msg);
ROS_INFO("Publsh turtle velocity command[%0.2f m/s, %0.2f rad/s]",
vel_msg.linear.x, vel_msg.angular.z);
// 按照循环频率延时
loop_rate.sleep();
}
return 0;
}
四、修改CMakeLists.txt编译规则
cd ~/catkin_ws/learning_topic/
我们只用在CMakeLists.txt中的#build里面加上这两句话即可(看下图)。
add_executable(velocity_publisher src/velocity_publisher.cpp)
target_link_libraries(velocity_publisher ${catkin_LIBRARIES})
五、编译并运行发布者
cd ~/catkin_ws
catkin_make
source devel/setup.bash 这里设置环境变量可以让系统自动执行,我们可以cd ~ , 使用ls -a可以看到一个名字叫做.bashrc
接下来我们来运行一下我们的代码。一共需要打开三个终端。
第一个终端输入: roscore 打开ROS Master
第二个终端输入: rosrun turtlesim turtlesim_node
第三个终端输入: rosrun learning_topic velocity_publisher
同时你可以 ls ~/catkin_ws/devel/lib/learning_topic 里面有一个velocity_publish的文件,那就是我们编译生成的文件。