实操03_服务调用

需求描述:编码实现向 turtlesim 发送请求,在乌龟显示节点的窗体指定位置生成一乌龟,这是一个服务请求操作。

1.服务名称与服务消息获取

获取话题:/spawn

rosservice list

实操03_服务调用_第1张图片

查看/spawn

rosservice info /spawn

实操03_服务调用_第2张图片
实操03_服务调用_第3张图片### 查看消息的格式

rossrv info turtlesim/Spawn

实操03_服务调用_第4张图片

响应结果:

float32 x
float32 y
float32 theta
string name
---
string name

再生成一个小乌龟

rosservice call /spawn "x: 1.0      
y: 0.8
theta: 0.5
name: 'turtle3'" 

2.服务客户端实现

创建功能包需要依赖的功能包: roscpp rospy std_msgs turtlesim

实现方案A:C++

/*
    生成一只小乌龟
    准备工作:
        1.服务话题 /spawn
        2.服务消息类型 turtlesim/Spawn
        3.运行前先启动 turtlesim_node 节点

    实现流程:
        1.包含头文件
          需要包含 turtlesim 包下资源,注意在 package.xml 配置
        2.初始化 ros 节点
        3.创建 ros 句柄
        4.创建 service 客户端
        5.等待服务启动
        6.发送请求
        7.处理响应

*/

#include "ros/ros.h"
#include "turtlesim/Spawn.h"

int main(int argc, char *argv[])
{
    setlocale(LC_ALL,"");
    // 2.初始化 ros 节点
    ros::init(argc,argv,"set_turtle");
    // 3.创建 ros 句柄
    ros::NodeHandle nh;
    // 4.创建 service 客户端
    ros::ServiceClient client = nh.serviceClient<turtlesim::Spawn>("/spawn");
    // 5.等待服务启动
    // client.waitForExistence();
    ros::service::waitForService("/spawn");
    // 6.发送请求
    turtlesim::Spawn spawn;
    spawn.request.x = 1.0;
    spawn.request.y = 1.0;
    spawn.request.theta = 1.57;
    spawn.request.name = "my_turtle";
    bool flag = client.call(spawn);
    // 7.处理响应结果
    if (flag)
    {
        ROS_INFO("新的乌龟生成,名字:%s",spawn.response.name.c_str());
    } else {
        ROS_INFO("乌龟生成失败!!!");
    }


    return 0;
}

配置文件此处略

实现方案B:Python

#! /usr/bin/env python
"""
    生成一只小乌龟
    准备工作:
        1.服务话题 /spawn
        2.服务消息类型 turtlesim/Spawn
        3.运行前先启动 turtlesim_node 节点

    实现流程:
        1.导包
          需要包含 turtlesim 包下资源,注意在 package.xml 配置
        2.初始化 ros 节点
        3.创建 service 客户端
        4.等待服务启动
        5.发送请求
        6.处理响应

"""

import rospy
from turtlesim.srv import Spawn,SpawnRequest,SpawnResponse

if __name__ == "__main__":
    # 2.初始化 ros 节点
    rospy.init_node("set_turtle_p")
    # 3.创建 service 客户端
    client = rospy.ServiceProxy("/spawn",Spawn)
    # 4.等待服务启动
    client.wait_for_service()
    # 5.发送请求
    req = SpawnRequest()
    req.x = 2.0
    req.y = 2.0
    req.theta = -1.57
    req.name = "my_turtle_p"#乌龟名字
    try:
        response = client.call(req)#类型不对的时候抛出异常,请求没有被正常处理的时候也会抛出异常
        # 6.处理响应
        rospy.loginfo("乌龟创建成功!,叫:%s",response.name)
    except expression as identifier:
        rospy.loginfo("服务调用失败")


命令实现

source ./devel/setup.bash 
roslaunch plumbing_test  start_turtle.launch
rosrun plumbing_test test03_service_client_p.py 

实操04_参数设置

1.参数名获取

获取参数列表:

roscore
rosrun turtlesim turtlesim_node
rosparam list

查看实体参数命令



rosparam get /turtle1/background_b     #查看背景颜色
rosparam set /turtlesim/background_b 0 #修改颜色

c++处理背景颜色

/*
    注意命名空间的使用。
    不一定创建句柄,

*/
#include "ros/ros.h"


int main(int argc, char *argv[])
{
    ros::init(argc,argv,"haha");

    ros::NodeHandle nh("turtlesim");
    //ros::NodeHandle nh;

    // ros::param::set("/turtlesim/background_r",0);
    // ros::param::set("/turtlesim/background_g",0);
    // ros::param::set("/turtlesim/background_b",0);

    nh.setParam("background_r",0);
    nh.setParam("background_g",0);
    nh.setParam("background_b",0);


    return 0;
}

你可能感兴趣的:(linux,linux)