ROS node调用service: ros::service::call/client.call()

最新推荐文章于 2023-02-19 12:31:30 发布

信雪神话

最新推荐文章于 2023-02-19 12:31:30 发布

阅读量8.5k

点赞数 3

分类专栏： Robot Operating System 文章标签： ROS node service ros

本文链接：https://blog.csdn.net/hookie1990/article/details/52235245

版权

Robot Operating System 专栏收录该内容

32 篇文章 8 订阅

订阅专栏

简介：介绍如何在一个node里调用现有的rosservice list查询到的service。

效果：通过talker publish需要调用服务的数据，listener接收到数据后调用服务进行三个整形数据相加，并返回相加和。

环境：ubuntu 14.04 +indigo.

备注：文中未详细介绍的api或ros的基本函数请参看之前博文。

[正文]

创建过程类似wiki教程中msg和srv的测试过程。在beginner_turtorials包下面创建。

1，创建msg文件夹，srv文件夹。

msg 文件夹下创建Num.msg，内容是

int32 A

int32 B

int32 C

srv文件夹下AddTwoInts.srv，内容是

int32 A

int32 B

int32 C

---

int32 sum

该文件表面输入是ABC，返回是 sum，两者通过“---”分割。

2，然后更改CMakeList.txt文件，修改为如下内容，主要设计msg，srv的其他依赖关系及编译运行的相关关系。

## Find catkin macros and libraries
## if COMPONENTS list like find_package(catkin REQUIRED COMPONENTS xyz)
## is used, also find other catkin packages
find_package(catkin REQUIRED COMPONENTS
  roscpp
  rospy
  std_msgs
  message_generation
)

## Generate messages in the 'msg' folder
 add_message_files(
   FILES
   Num.msg
 )


## Generate services in the 'srv' folder
 add_service_files(
   FILES
   AddTwoInts.srv
 )

## Generate added messages and services with any dependencies listed here
 generate_messages(
   DEPENDENCIES
   std_msgs
 )

# include_directories(include)
include_directories(
  ${catkin_INCLUDE_DIRS}
)

catkin_package(
#  INCLUDE_DIRS include
#  LIBRARIES beginner_tutorials
#  CATKIN_DEPENDS roscpp rospy std_msgs
#  DEPENDS system_lib
  CATKIN_DEPENDS message_runtime
)

也可参考，wiki中CreatingMsgAndSrv中过程，名称都没有改变，只是改变了文件中内容，改写完成后可以在catkin_ws目录下catkin_make一次，并source devel/setup.bash下。

3，建立几个cpp的源文件，位于src目录下。

3.1 src/example_srv_request.cpp

作用：主要实现服务的定义，初始化，注释由于ubuntu没装汉语输入，因此注释为英文...聊胜于无。

#include "ros/ros.h"
#include "beginner_tutorials/AddTwoInts.h"

bool add(beginner_tutorials::AddTwoInts::Request &req,
         beginner_tutorials::AddTwoInts::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;
   //init service:
   //Name: add_3_ints,advertise the service. add: call back function
   ros::ServiceServer service=n.advertiseService("add_3_ints",add);
   ROS_INFO("Ready to add 3 ints.");
   ros::spin();// start to deal with the call back event

   return 0;
}

3.2 src/example_srv_response.cpp，该文件并非必要，是典型的client调用服务的形式，并非此文目的，不添加最终目的也可实现，调用示例是(现在还不能调用)：

rosrun beginner_tutorials example_srv_response 1 2 3

#include "ros/ros.h"
#include "beginner_tutorials/AddTwoInts.h"
#include <cstdlib>


int main(int argc,char **argv)
{
    ros::init(argc,argv,"add_3_ints_client");
    if(argc != 4)
    {
        ROS_INFO("usage: add_3_ints_client A B C");
        return 1;
    }
    ros::NodeHandle n;
    ros::ServiceClient client=n.serviceClient<beginner_tutorials::AddTwoInts>("add_3_ints");

    beginner_tutorials::AddTwoInts srv;

    //atoll:convert a string to long long int variable
    srv.request.A=atoll(argv[1]);
    srv.request.B=atoll(argv[2]);
    srv.request.C=atoll(argv[3]);


    if(client.call(srv))
    {
        ROS_INFO("Sum:%ld",(long int)srv.response.sum);
    }
    else
    {
        ROS_ERROR("Failed to call service add_three_ints");
        return 1;

    }
    return 0;
}

3.3 src/example_talker_msg.cpp

该文件主要实现3个参数的发布，此处发布了A=1,B=2,C=3；

#include "ros/ros.h"
#include "beginner_tutorials/Num.h"
#include <sstream>
//Usage:publish a msg with topic named message


int main(int argc, char **argv)
{
  ros::init(argc, argv, "example_talker_msg");
  ros::NodeHandle n;
  //advertise a topic named "message"
  ros::Publisher pub=n.advertise<beginner_tutorials::Num>("message",1000);
  ros::Rate loop_rate(10);
  while (ros::ok())
  {
    beginner_tutorials::Num msg;
    msg.A=1;
    msg.B=2;
    msg.C=3;
    pub.publish(msg);

    ros::spinOnce();
    loop_rate.sleep();
  }
  return 0;
}

3.4 src/example_listener_msg.cpp

该文件主要实现对前文talker发布的数据的监听，监听到Num类型定义数据后，通过service: ros::service::call / client.call()两种方式进行add_3_ints服务的调用。

#include "ros/ros.h"
#include "beginner_tutorials/Num.h"
#include "beginner_tutorials/AddTwoInts.h"

//declaration of the Example class:construct function, member and so on.
class Example{
public:
    Example();
private:
    ros::NodeHandle nh;
    ros::ServiceClient client;
    ros::Subscriber listener;
    void messageCallback(const beginner_tutorials::Num::ConstPtr& msg);

};

//implementation of construct function.
Example::Example()
{
    client=nh.serviceClient<beginner_tutorials::AddTwoInts>("add_3_ints");
    //monitor a topic named "message",this -> current object,pointer
    listener=nh.subscribe("message",1000,&Example::messageCallback,this);

}

//implementation of one of the Example class memeber.
void Example::messageCallback( const beginner_tutorials::Num::ConstPtr& msg)
{
//    ROS_INFO("I heard:[%d] [%d] [%d]",msg->A,msg->B,msg->C);
    beginner_tutorials::AddTwoInts srv;
    srv.request.A=msg->A;
    srv.request.B=msg->B;
    srv.request.C=msg->C;
    if(ros::service::call("add_3_ints",srv))
        ROS_INFO("SUM: %ld",(long int)srv.response.sum);
    else
        ROS_ERROR("Failed to call service add_three_ints");
    /*
    if(client.call(srv))
    {
        ROS_INFO("SUM: %ld",(long int)srv.response.sum);
    }
    else
    {
        ROS_ERROR("Failed to call service add_three_ints");

    }
    */
}



int main(int argc, char **argv)
{
  ros::init(argc, argv, "example_listener_msg");
  Example exp;
  ros::spin();
  return 0;
}

4 再次修改CMakeList.txt文件
添加编译链接的相关控制语句。

add_executable(example_srv_request src/example_srv_request.cpp)
target_link_libraries(example_srv_request ${catkin_LIBRARIES})

add_executable(example_srv_response src/example_srv_response.cpp)
target_link_libraries(example_srv_response ${catkin_LIBRARIES})

add_executable(example_talker_msg src/example_talker_msg.cpp)
target_link_libraries(example_talker_msg ${catkin_LIBRARIES})

add_executable(example_listener_msg src/example_listener_msg.cpp)
target_link_libraries(example_listener_msg ${catkin_LIBRARIES})

添加后在工作空间主目录cd ~/catkin_ws下进行catkin_make编译，理论上不会出现问题，若有问题检查自己包和msg，srv的生成及cmakelist文件。
5 测试

一个终端运行命令：roscore,

一个终端运行命令（注意此时近乎所有命令和包的名称及可执行文件名称都可以<table>自动补全）：rosrun beginner_tutorials example_srv_request；会返回： [INFO][时间戳]：Ready to add 3 ints. 此时若通过roservice list查询ros提供的服务则会返回add_3_ints等几个服务。

一个终端运行命令：rosrun beginner_tutorials example_talker_msg

一个终端运行命令：rosrun beginner_tutorials example_listener_msg；此时会返回： [INFO][时间戳]：SUM: 6

在此文件中，我们实现了在一个node中以下面两种方式对add_3_ints的服务调用，而不是在命令行中通过rosrun beginner_tutorials example_srv_response 1 2 3调用。

 if(ros::service::call("add_3_ints",srv))
        ROS_INFO("SUM: %ld",(long int)srv.response.sum);
    else
        ROS_ERROR("Failed to call service add_three_ints");
    /*
    if(client.call(srv))
    {
        ROS_INFO("SUM: %ld",(long int)srv.response.sum);
    }
    else
    {
        ROS_ERROR("Failed to call service add_three_ints");

    }
    */