8.编写Subscriber订阅者节点
8.1 创建订阅者节点
cd catkin_ws/src/
catkin_create_pkg atr_pkg rospy roscpp std_msgs
ros::Subscriber sub = nh.subscribe(话题名, 缓存队列长度, 回调函数)
回调函数通常在你创建订阅者时定义。一个订阅者会监听一个话题，并在有消息到达时调用回调函数，而不用手动去执行函数。
#include<ros/ros.h>
#include<std_msgs/String.h>
void chao_callback( std_msgs::String msg)
{
printf(msg.data.c_str());
printf("\n");
}
int main(int argc, char **argv)
{
ros::init(argc, argv, "ma_node");
ros::NodeHandle nh;
ros::Subscriber sub = nh.subscribe("ssr_node_topic", 10,chao_callback);
while(ros::ok())
{
ros::spinOnce();//功能：处理回调函数
}
return 0;
}
打开CMakeList,添加后编译。
add_executable(ma_node src/atr_pkg_node.cpp)
target_link_libraries(ma_node
${catkin_LIBRARIES}
)
打开三个终端分别输入
roscore
rosrun ssr_pkg chao_node
rosrun atr_pkg ma_node
显示接收时间函数
#include<ros/ros.h>
#include<std_msgs/String.h>
void chao_callback( std_msgs::String msg)
{
ROS_INFO(msg.data.c_str());
}
int main(int argc, char **argv)
{
setlocale(LC_ALL,"");//设置中文显示
ros::init(argc, argv, "ma_node");
ros::NodeHandle nh;
ros::Subscriber sub = nh.subscribe("ssr_node_topic", 10,chao_callback);
while(ros::ok())
{
ros::spinOnce();//功能：处理回调函数
}
return 0;
}
再次运行ma_node节点。
8.2 多个订阅者和发布者图形化显示
当存在多个订阅者和发布者时，可以使用rqt_graph来显示逻辑关系。
8.3 小结
9.launch启动多个ROS节点
上一小节中，我们启动多个节点就需要打开多个终端，这非常繁琐。这一小节中我们使用launch来启动多个节点。
luanch文件遵循XML语法
<标记名称 属性名1= "属性值1"...>内容</标记名称>
打开vscode，在工作目录的任意子文件夹下创建launch文件
<launch>
<node pkg ="ssr_pkg" type="yao_node" name="yao_node"/>
<node pkg ="ssr_pkg" type="chao_node" name="chao_node"/>
<node pkg ="atr_pkg" type="ma_node" name="ma_node" output="screen"/>
</launch>
打开终端输入
roslaunch atr_pkg kaihei.launch
9.2 小结
10.ROS机器人运动控制
机器人的运动可以分解为矢量运动和旋转运动。
矢量运动：二维平面中的各种平移。单位：米/每秒。
旋转运动：机器人进行转向。单位：弧度/每秒。
11.机器人运动控制的实现
第一节中我们已经下载过wpr_simulation这个源代码了。
cd catkin_ws
catkin_make #编译源代码文件
roslaunch wpr_simulation #开启演示模拟环境
#再打开一个终端输入
rosrun wpr_simulation demo_vel_ctrl#进行demo演示
本节课就要实现这样的一个效果，实现思路：
cd catkin_ws/src/
catkin_create_pkg vel_pkg roscpp rospy geometry_msgs
打开vscode,在vel_pkg文件夹下的src目录里创建叫vel_node.cpp文件。
#include<ros/ros.h>
#include<geometry_msgs/Twist.h>
int main(int argc,char **argv)
{
ros::init(argc,argv,"vel_node");
ros::NodeHandle n;
ros::Publisher vel_pub = n.advertise<geometry_msgs::Twist>("cmd_vel",10);
geometry_msgs::Twist vel_msg;
vel_msg.linear.x = 0.1;
vel_msg.linear.y = 0.0;
vel_msg.linear.z = 0.0;
vel_msg.angular.x = 0.0;
vel_msg.angular.y = 0.0;
vel_msg.angular.z = 0.0;
ros::Rate r(30);
while(ros::ok())
{
vel_pub.publish(vel_msg);
r.sleep();
}
return 0;
}
cmake里添加后编译。
add_executable(vel_node src/vel_node.cpp)
add_dependencies(vel_node ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS})
target_link_libraries(vel_node
${catkin_LIBRARIES}
)
分别在两个终端里输入：
roslaunch wpr_simulation wpb_simple.launch
rosrun vel_pkg vel_node
便能看到小车在缓慢向前移动。
