ROS知识(5)----消息与服务的示例
ROS中已经定义了较多的标准类型的消息,你可以用在这些标准类型的消息上再自定义自己的消息类型。这个在复杂数据传输很有用,例如节点和服务器进行交互时,就可能用到传输多个参数到服务器,并返回相应的结果。为了保证例子的完整,将详述每一步。
基本思路和创建talker和listener的例子类似,步骤如下:
- 建立工作空间workspace(类似于vs下的解决方案,用来管理很多的项目);
- 建立包package(类似于vs下的项目);
- 创建msg和srv文件;
- 编写服务节点和客户节点代码;
- 利用rosmake进行编译(catkin_make也可以,但稍有不同,请参考另一篇博文的ROS知识(3));
- 利用rosrun运行;
1.1、创建工作空间
在开始具体工作之前,首先创建工作空间,并且为工作空间设置环境变量到~/.bashrc中,如果要查看已有的空间路径,可以用查询命令
$ echo $ROS_PACKAGE_PATH
你将会看到如下的信息:
/home/horsetail/dev/rosbook:/home/horsetail/catkin_ws/src:/opt/ros/jade/share:/opt/ros/jade/stacks
这里的创建空间实际上就是先建立一个文件夹,然后把文件夹的路径设置到环境变量~/.bashrc中。例如我们这里创建目录~/dev/rosbook作为工作空间。
首先执行命令:
$ cd ~
$ mkdir -p dev/rosbook
然后将创建的路径加入到环境变量中,执行如下命令:
$ echo "export ROS_PACKAGE_PATH=~/dev/rosbook:${ROS_PACKAGE_PATH}" >> ~/.bashrc
$ . ~/.bashrc
这样,我们就完成了工作空间的配置,注意:ROS安装的时候,一定要把ROS的环境变量也加到~/.bashrc中。这里还需要把ROS。接下来就是在这个空间下创建包了。
1.2、创建包
可以手动创建包,但是非常的繁琐,为了方便,最好使用roscreate-pkg命令行工具,该命令行的格式如下:
roscreate-pkg [package_name] [depend1] [depend2] [depend3] ...
命令行包含了要创建包的名字,依赖包。
我们的例子中,创建一个叫mypacakge1的 新包,命令如下:
$ cd ~/dev/rosbook
$ roscreate-pkg mypackage1 std_msgs roscpp rospy
过一会弹出如下的信息,表示创建成功:
Created package directory /home/horsetail/dev/rosbook/mypackage1
Created include directory /home/horsetail/dev/rosbook/mypackage1/include/mypackage1
Created cpp source directory /home/horsetail/dev/rosbook/mypackage1/src
Created package file /home/horsetail/dev/rosbook/mypackage1/Makefile
Created package file /home/horsetail/dev/rosbook/mypackage1/manifest.xml
Created package file /home/horsetail/dev/rosbook/mypackage1/CMakeLists.txt
Created package file /home/horsetail/dev/rosbook/mypackage1/mainpage.dox Please edit mypackage1/manifest.xml and mainpage.dox to finish creating your package
好了这样就完成了包的创建,我们发现在mypackage1的目录下有一个src文件夹,我们接下来就是网这里添加源程序了。
1.3、创建msg和srv文件
首先,在mypackage1功能包下,创建msg文件夹,并在其中创建一个新的文件mypackage_msg1.msg,将在这个文件里自定义消息的类型,在文件中添加以下代码:
int32 A
int32 B
int32 C
现在编辑CMakeList.txt,从#rosbuild_genmsg()这一行中删除#,然后使用rosmake命令编译功能包:
$ rosmake mypackage1
为了检查正确性,使用rosmsg命令:
$ rosmsg show mypackage1/mypackage1_msg1
如果看到的内容和文件一样,说明编译正确。
现在新建一个srv文件,在mypackage1文件夹下建立srv文件夹,并在srv文件夹下新建一个文件mypackage1_srv1.srv,并添加以下代码:
int32 A
int32 B
int32 C
---
int32 sum
编辑CMakeList.txt,从#rosbuild_genmsg()这一行中删除#,然后使用rosmake命令编译功能包,可以通过一下命令验证正确性:
$ rossrv show mypackage1/mypackage1_srv1
如果看到的内容和文件一样,说明编译正确。
1.4、编写服务节点和客户节点代码
接下来建立用于验证服务中请求响应的代码,在mypackage1/src下新建文件example_srv_request.cpp,添加如下代码:
#include "ros/ros.h"
#include "mypackage1/mypackage_srv1.h" bool add(chapter2_tutorials::chapter2_srv1::Request &req,
chapter2_tutorials::chapter2_srv1::Response &res)
{
res.sum = req.A + req.B + req.C;
ROS_INFO("request: A=%ld, B=%ld C=%ld", (int)req.A, (int)req.B, (int)req.C);
ROS_INFO("sending back response: [%ld]", (int)res.sum);
return true;
} int main(int argc, char **argv)
{
ros::init(argc, argv, "add_3_ints_server");
ros::NodeHandle n; ros::ServiceServer service = n.advertiseService("add_3_ints", add);
ROS_INFO("Ready to add 3 ints.");
ros::spin(); return ;
}
在mypackage1/src下新建文件example_srv_respone.cpp,添加如下代码:
#include "ros/ros.h"
#include "mypackage1/mypackage_srv1.h"
#include <cstdlib> int main(int argc, char **argv)
{
ros::init(argc, argv, "add_3_ints_client");
if (argc != )
{
ROS_INFO("usage: add_3_ints_client A B C ");
return ;
} ros::NodeHandle n;
ros::ServiceClient client = n.serviceClient<chapter2_tutorials::chapter2_srv1>("add_3_ints");
chapter2_tutorials::chapter2_srv1 srv;
srv.request.A = atoll(argv[]);
srv.request.B = atoll(argv[]);
srv.request.C = atoll(argv[]);
if (client.call(srv))
{
ROS_INFO("Sum: %ld", (long int)srv.response.sum);
}
else
{
ROS_ERROR("Failed to call service add_two_ints");
return ;
} return ;
}
接下来建立用于验证消息传递的代码,在mypackage1/src下新建文件example_talker_msg.cpp,添加如下代码:
#include "ros/ros.h"
#include "mypackage1/mypackage1_msg1.h"
#include <sstream> int main(int argc, char **argv)
{
ros::init(argc, argv, "example_talker_msg");
ros::NodeHandle n;
ros::Publisher pub = n.advertise<chapter2_tutorials::chapter2_msg1>("message", );
ros::Rate loop_rate();
while (ros::ok())
{
chapter2_tutorials::chapter2_msg1 msg;
msg.A = ;
msg.B = ;
msg.C = ;
pub.publish(msg);
ros::spinOnce();
loop_rate.sleep();
}
return ;
}
在mypackage1/src下新建文件example_listener_msg.cpp,添加如下代码:
#include "ros/ros.h"
#include "mypackage1/mypackage1_msg1.h" void messageCallback(const chapter2_tutorials::chapter2_msg1::ConstPtr& msg)
{
ROS_INFO("I heard: [%d] [%d] [%d]", msg->A, msg->B, msg->C);
} int main(int argc, char **argv)
{
ros::init(argc, argv, "example_listener_msg");
ros::NodeHandle n;
ros::Subscriber sub = n.subscribe("message", , messageCallback);
ros::spin();
return ;
}
好了,至此完成了服务和消息的测试代码编写。
1.5、利用rosmake进行编译
接下来,要告诉编译器如何去找到这两个文件。你需要打开mypackage1/CMakeLists.txt,在文件的末尾添加两行命令:
rosbuild_add_executable(example_srv_request src/example_srv_request.cpp)
rosbuild_add_executable(example_srv_respone src/example_srv_respone.cpp)
rosbuild_add_executable(example_talker_msg src/example_talker_msg.cpp)
rosbuild_add_executable(example_listener_msg src/example_listener_msg.cpp)
添加后的文件结构是这样的:
cmake_minimum_required(VERSION 2.4.)
include($ENV{ROS_ROOT}/core/rosbuild/rosbuild.cmake) # Set the build type. Options are:
# Coverage : w/ debug symbols, w/o optimization, w/ code-coverage
# Debug : w/ debug symbols, w/o optimization
# Release : w/o debug symbols, w/ optimization
# RelWithDebInfo : w/ debug symbols, w/ optimization
# MinSizeRel : w/o debug symbols, w/ optimization, stripped binaries
#set(ROS_BUILD_TYPE RelWithDebInfo) rosbuild_init() #set the default path for built executables to the "bin" directory
set(EXECUTABLE_OUTPUT_PATH ${PROJECT_SOURCE_DIR}/bin)
#set the default path for built libraries to the "lib" directory
set(LIBRARY_OUTPUT_PATH ${PROJECT_SOURCE_DIR}/lib) #uncomment if you have defined messages
rosbuild_genmsg()
#uncomment if you have defined services
rosbuild_gensrv() #common commands for building c++ executables and libraries
rosbuild_add_executable(example_srv_request src/example_srv_request.cpp)
rosbuild_add_executable(example_srv_respone src/example_srv_respone.cpp)
rosbuild_add_executable(example_talker_msg src/example_talker_msg.cpp)
rosbuild_add_executable(example_listener_msg src/example_listener_msg.cpp)
这样用rosmake命令来编译这个mypackage1包了。执行下面的命令:
$ rosmake mypackage1
输出下面的信息:
horsetail@horsetail-book:~$ roscore
... logging to /home/horsetail/.ros/log/6eae5b9c-628d-11e5-8bd7-3859f9722953/roslaunch-horsetail-book-6447.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB. started roslaunch server http://horsetail-book:44362/
ros_comm version 1.11.13 SUMMARY
======== PARAMETERS
* /rosdistro: jade
* /rosversion: 1.11.13 NODES auto-starting new master
process[master]: started with pid [6459]
ROS_MASTER_URI=http://horsetail-book:11311/
...(内容太长了,省去)
[ rosmake ] Results:
[ rosmake ] Built 26 packages with 0 failures.
[ rosmake ] Summary output to directory
[ rosmake ] /home/horsetail/.ros/rosmake/rosmake_output-20150924-164014
哇,编译通过,大家注意到实际上也是用catkin进行编译的,额。我们来运行一下吧。
1.4、运行
首先打开一个新的终端,启动初始化ROS,执行命令:
$ roscore
先验证一下服务请求和相应的功能,需要在不同窗口分别执行以下命令:
rosrun mypackage1 example_talker_msg
rosrun mypackage1 example_listener_msg
可以看到请求listener的窗口,显示如下信息:
[ INFO] [1443154332.742277621]: I heard:[1][2][3]
[ INFO] [1443164722.557755739]: I heard:[1][2][3]
[ INFO] [1443164744.557858055]: I heard:[1][2][3]
好了至此完成了服务srv和消息msg的验证。
1.5、源码
最后,附上源码:mypackage1.tar.gz(这个是ROS机器人程序设计中第二章的例子,里面包含了消息和服务等例子)
参考资料
[1]. Aaron Martinez Enrique Fern andez, ROS机器人程序设计[B], P14-42, 2014.
ROS知识(5)----消息与服务的示例的更多相关文章
- ROS学习笔记9-创建ros消息和服务
该节内容主要来自于官方文档的两个小节:1.使用rosed来编辑2.创建ros消息的服务 先来看rosed: rosedrosed命令是rosbash的一部分,使用rosed可以直接编辑包中的一个文件, ...
- ROS知识(2)----理解ROS系统结构
学习新事物,方法高于技术本身,如果没有把握"BIG PICTURE"的话很难理解进去.通过以下几点进行理解ROS: ROS实际上不是操作系统,他只是一个通信的框架,一个代码管理的架 ...
- 【阿里云产品公测】消息队列服务MQS java SDK 机器人应用初体验
[阿里云产品公测]消息队列服务MQS java SDK 机器人应用初体验 作者:阿里云用户啊里新人 初体验 之 测评环境 由于MQS支持外网访问,因此我在本地做了一些简单测试(可能有些业余),之后 ...
- 微软微服务eShopOnContainers示例之EventBusRabbitMq解析与实践
eShopOnContainers eShopOnContainers是微软官方的微服务架构示例,GitHub地址https://github.com/dotnet-architecture/eSho ...
- NoSQL初探之人人都爱Redis:(3)使用Redis作为消息队列服务场景应用案例
一.消息队列场景简介 “消息”是在两台计算机间传送的数据单位.消息可以非常简单,例如只包含文本字符串:也可以更复杂,可能包含嵌入对象.消息被发送到队列中,“消息队列”是在消息的传输过程中保存消息的容器 ...
- Redis作为消息队列服务场景应用案例
NoSQL初探之人人都爱Redis:(3)使用Redis作为消息队列服务场景应用案例 一.消息队列场景简介 “消息”是在两台计算机间传送的数据单位.消息可以非常简单,例如只包含文本字符串:也可以更 ...
- 【转】NoSQL初探之人人都爱Redis:(3)使用Redis作为消息队列服务场景应用案例
一.消息队列场景简介 “消息”是在两台计算机间传送的数据单位.消息可以非常简单,例如只包含文本字符串:也可以更复杂,可能包含嵌入对象.消息被发送到队列中,“消息队列”是在消息的传输过程中保存消息的容器 ...
- 使用Redis作为消息队列服务场景应用案例
一.消息队列场景简介 "消息"是在两台计算机间传送的数据单位.消息可以非常简单,例如只包含文本字符串:也可以更复杂,可能包含嵌入对象.消息被发送到队列中,"消息队列&qu ...
- 腾讯云分布式高可靠消息队列服务CMQ架构
在分布式大行其道的今天,我们在系统内部.平台之间广泛运用消息中间件进行数据交换及解耦.CMQ是腾讯云内部自研基于的高可靠.强一致.可扩展分布式消息队列,在腾讯内部包括微信手机QQ业务红包.腾讯话费充值 ...
随机推荐
- java程序out of memory【转】
相信大家都有感触,线上服务内存OOM的问题,是最难定位的问题,不过归根结底,最常见的原因: 本身资源不够 申请的太多 资源耗尽 58到家架构部,运维部,58速运技术部联合进行了一次线上服务内存OOM问 ...
- Apache+jboss群集部署
Jboss default方式上的Cluster配置[二] - 操作系统http://www.myexception.cn/operating-system/862858.html Jboss def ...
- Sublime Text2使用规则
Sublime Text是我发现的有一好用的编辑器,它不单单只支持 python ,几乎支持目前主流的语言,快捷键丰富,可以极大的提高代码开发效率.Sublime Text 网址:http://www ...
- TCP三次链接和四次断开
经典的三次握手示意图:(#add,“握手”即图中左边到右边的连线) 经典的四次握手关闭图: TCP是主机对主机层的传输控制协议,提供可靠的连接服务,采用三次握手确认建立一个连接: 位码即t ...
- leetcode 之Remove Duplicates from Sorted Array(2)
描述 Follow up for ”Remove Duplicates”: What if duplicates are allowed at most twice? For exampl ...
- Ps钢笔操作技巧
鼠标左键单击=新建锚点:Ctrl+鼠标左键=移动锚点/移动调节点: Alt+鼠标左键=锚点/角点转换: 方向键=微调锚点位置: shift+鼠标左键=新建水平/垂直锚点:Ctrl+Alt+鼠标左键=选 ...
- 20165301 2017-2018-2 《Java程序设计》第五周学习总结
20165301 2017-2018-2 <Java程序设计>第五周学习总结 教材学习内容总结 第七章:内部类与异常类 内部类 在一个类中定义另一个类 非内部类不可以是static类 匿名 ...
- Cosbench测试 RGW S3 path_style_access=true模式支持
使用Ceph RGW Cosbench 测试时,文档中没有写如何使用 path_style_access 模式的方法. 查看了一下cosbench源码发现已经支持,只是文档没有写. 提交了一个iss ...
- golang基础之三-字符串,时间,流程控制,函数
strings和strconv的使用 strings strings.HasPrefix(s string,preffix string) bool:判断字符串s是否以prefix开头 stirngs ...
- idea导入或者检出项目时发现编辑器左侧无法显示项目目录结构
按下列步骤操作: 1. 关闭IDEA, 2.然后删除项目文件夹下的.idea文件夹 3.重新用IDEA工具打开项目