1.编写Service节点
节点名叫:add_two_ints_server。先把目录转到beginner_tutorials
在src文件夹下面新建add_two_ints_server.cpp 。复制代码
#include "ros/ros.h"
#include "beginner_tutorials/AddTwoInts.h"
bool add(beginner_tutorials::AddTwoInts::Request &req, beginner_tutorials::AddTwoInts::Request &res)
{
res.sum=req.a+req.b;
ROS_INFO("request: x=%ld, y=%ld", (long int)req.a, (long int)req.b);
ROS_INFO("sending back response: [%ld]", (long int)res.sum);
return