ROS服务通信C++
效果图
结构总览
友情提醒
每一步编辑完,执行一下 Ctrl+Shift+B进行编译,及时排查错误
准备工作
第一步:创建工作空间
配置:roscpp rospy std_msgs
devel/src/sever_client/src/CMakeLists.txt
devel/src/sever_client/src/package.xml
devel/src/sever_client/srv/strings.srv
# 客户端请求时发送的两个字符串
string str1
string str2
---
# 服务器响应发送的数据
string res
devel/src/sever_client/src/server.cpp
// 客户端请求时发送的两个字符串
#include "ros/ros.h"
#include "server_client/strings.h"
#include <string>
#include "std_msgs/String.h"
using namespace std;
using namespace std_msgs;
/*
1.包含头文件
服务端实现
*/
// bool 返回值由于标志是否处理成功
bool doStrings(server_client::strings::Request &request,
server_client::strings::Response &response)
{
// 处理请求
// string str1 = request.str1;
// string str2 = request.str2;
string str1;
str1 = request.str1;
string str2;
str2=request.str2;
ROS_INFO("服务器接收到的请求数据为:str1 = %s, str2 = %s",str1.c_str(), str2.c_str());
// //组织响应
// // static const string res = str1 + str2;
// string res;
// // sprintf(res, "%s%s", str1, str2);
// res = str1 + str2;
// // response.res = res;
response.res = request.str1 + request.str2;
// ROS_INFO("request: str1=%s, str2=%s", request.str1.c_str(), request.str2.c_str());
ROS_INFO("服务器接发送的响应数据为: res = %s", response.res.c_str());
// ros::spin();
return true;
}
int main(int argc, char *argv[])
{
setlocale(LC_ALL,"");
// 2.初始化 ROS 节点
ros::init(argc,argv,"strings_Server");
// 3.创建 ROS 句柄
ros::NodeHandle nh;
// 4.创建 服务 对象
ros::ServiceServer server = nh.advertiseService("strings",doStrings);
ROS_INFO("服务端已经启动....");
// 5.回调函数处理请求并产生响应
// 6.由于请求有多个,需要调用 ros::spin()
ros::spin();
return 0;
}
devel/src/sever_client/src/client.cpp
// 客户端请求时发送的两个字符串
// 1.包含头文件
#include "ros/ros.h"
#include "server_client/strings.h"
#include <iostream>
#include "std_msgs/String.h"
using namespace std;
using namespace std_msgs;
int main(int argc, char *argv[])
{
setlocale(LC_ALL,"");
// 调用时动态传值,如果通过 launch 的 args 传参,需要传递的参数个数 +3
if (argc != 3)
// if (argc != 5)//launch 传参(0-文件路径 1传入的参数 2传入的参数 3节点名称 4日志路径)
{
ROS_ERROR("请提交两个字符串");
return 1;
}
ROS_INFO("客户端已经启动....");
// 2.初始化 ROS 节点
ros::init(argc,argv,"strings_Client");
// 3.创建 ROS 句柄
ros::NodeHandle nh;
// 4.创建 客户端 对象
ros::ServiceClient client = nh.serviceClient<server_client::strings>("strings");
//等待服务启动成功
//方式1
ros::service::waitForService("strings");
//方式2
// client.waitForExistence();
// 5.组织请求数据
server_client::strings ai;
ai.request.str1 = argv[1];
ai.request.str2 = argv[2];
// cout << atoi(argv[1]) << ' ' << atoi(argv[2]);
// ai.request.str1 = 'a';
// ai.request.str2 = 'b';
ROS_INFO("客户端发送的请求数据为:str1 = %s, str2 = %s",ai.request.str1.c_str(), ai.request.str2.c_str());
// 6.发送请求,返回 bool 值,标记是否成功
bool flag = client.call(ai);
// 7.处理响应
if (flag)
{
ROS_INFO("请求正常处理,响应结果: res = %s",ai.response.res.c_str());
}
else
{
ROS_ERROR("请求处理失败....");
return 1;
}
return 0;
}
made by zyl
标签:ROS,str2,str1,request,通信,C++,client,ros From: https://www.cnblogs.com/zylyehuo/p/17176936.html