【自动驾驶】ROS中参数服务器通信（c++）

通信过程

1.Talker 设置参数
Talker 通过 RPC 向参数服务器发送参数(包括参数名与参数值)，ROS Master 将参数保存到参数列表中。

2.Listener 获取参数
Listener 通过 RPC 向参数服务器发送参数查找请求，请求中包含要查找的参数名。

3.ROS Master 向 Listener 发送参数值
ROS Master 根据步骤2请求提供的参数名查找参数值，并将查询结果通过 RPC 发送给 Listener。

参数可使用数据类型:

32-bit integers

booleans

strings

doubles

iso8601 dates

lists

base64-encoded binary data

新建参数服务器包

catkin_create_pkg paramservice std_msgs rospy roscpp

编写测试文件

#include "ros/ros.h"
#include <vector>
#include <map>
int main(int argc, char *argv[])
{
    //使得中文可以生效
    setlocale(LC_ALL,"");
    ros::init(argc,argv,"set_update_param");
    std::vector<std::string> stus;
    stus.push_back("这是元素1");
    stus.push_back("这是元素2");

    std::map<std::string,std::string> friends;
    friends["key"] = "value";

    ros::param::set("param_int",20);
    ros::param::set("param_double",3.14);
    ros::param::set("param_string","Hello Param");
    ros::param::set("param_bool",false);
    ros::param::set("param_vector",stus);
    ros::param::set("param_map",friends);

    //修改演示(相同的键，不同的值)
    ros::param::set("param_int",20000);
    // getParam 函数
    int param_int_value;
    double param_double_value;
    bool param_bool_value;
    std::string param_string_value;
    std::vector<std::string> param_stus;
    std::map<std::string, std::string> param_friends;

    ros::param::get("param_int",param_int_value);
    ros::param::get("param_double",param_double_value);
    ros::param::get("param_bool",param_bool_value);
    ros::param::get("param_string",param_string_value);
    ros::param::get("param_vector",param_stus);
    ros::param::get("param_map",param_friends);

    ROS_INFO("getParam获取的结果:%d,%.2f,%s,%d",
            param_int_value,
            param_double_value,
            param_string_value.c_str(),
            param_bool_value
            );
            
    for (auto &&stu : param_stus)
    {
        ROS_INFO("stus 元素:%s",stu.c_str());        
    }

    for (auto &&f : param_friends)
    {
        ROS_INFO("map 元素:%s = %s",f.first.c_str(), f.second.c_str());
    }

    //  首次调用getCached，这里会订阅参数值，通过缓存获取数据，当数据变化时，将通知节点自动更新
    ros::param::getCached("param_int",param_int_value);
    ROS_INFO("通过缓存获取数据:%d",param_int_value);

    //输出所有的变量名
    std::vector<std::string> param_names2;
    ros::param::getParamNames(param_names2);
    for (auto &&name : param_names2)
    {
        ROS_INFO("名称解析name = %s",name.c_str());        
    }
    ROS_INFO("----------------------------");

    ROS_INFO("存在 param_int 吗? %d",ros::param::has("param_int"));
    ROS_INFO("存在 param_intttt 吗? %d",ros::param::has("param_intttt"));

    std::string key;
    ros::param::search("param_int",key);
    ROS_INFO("搜索键:%s",key.c_str());
    //删除相关的参数
    bool r2 = ros::param::del("param_int");
    ROS_INFO("param 删除结果:%d",r2);
    return 0;

}

修改cmakelist:

add_executable(${PROJECT_NAME}_node src/paramservice.cpp)
target_link_libraries(${PROJECT_NAME}_node
  ${catkin_LIBRARIES}
)

搭配launch文件

<launch>
    <node name="myservice" pkg="service" type="service_node" output="screen"/>
</launch>

启动测试及结果

roslaunch paramservice start.launch

[ INFO] [1723529188.541091451]: getParam获取的结果:20000,3.14,Hello Param,0
[ INFO] [1723529188.541155371]: stus 元素:这是元素1
[ INFO] [1723529188.541178505]: stus 元素:这是元素2
[ INFO] [1723529188.541192963]: map 元素:key = value
[ INFO] [1723529188.542024132]: 通过缓存获取数据:20000
[ INFO] [1723529188.542419343]: 名称解析name = /run_id
[ INFO] [1723529188.542439561]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__34167
[ INFO] [1723529188.542458326]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__41769
[ INFO] [1723529188.542474146]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__45931
[ INFO] [1723529188.542489685]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__45545
[ INFO] [1723529188.542505965]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__44877
[ INFO] [1723529188.542524019]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__42835
[ INFO] [1723529188.542541943]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__46297
[ INFO] [1723529188.542559517]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__41351
[ INFO] [1723529188.542576629]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__43881
[ INFO] [1723529188.542594843]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__43899
[ INFO] [1723529188.542612596]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__34115
[ INFO] [1723529188.542630069]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__39145
[ INFO] [1723529188.542647101]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__43455
[ INFO] [1723529188.542664524]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__33051
[ INFO] [1723529188.542682467]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__35169
[ INFO] [1723529188.542700181]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__46493
[ INFO] [1723529188.542718104]: 名称解析name = /roslaunch/uris/host_yisu_64fc150f8284e__39659
[ INFO] [1723529188.542735557]: 名称解析name = /rosversion
[ INFO] [1723529188.542753210]: 名称解析name = /rosdistro
[ INFO] [1723529188.542771264]: 名称解析name = /param_double
[ INFO] [1723529188.542789378]: 名称解析name = /param_string
[ INFO] [1723529188.542806159]: 名称解析name = /param_bool
[ INFO] [1723529188.542823351]: 名称解析name = /param_vector
[ INFO] [1723529188.542840955]: 名称解析name = /param_map/key
[ INFO] [1723529188.542858317]: 名称解析name = /param_int
[ INFO] [1723529188.542878054]: ----------------------------
[ INFO] [1723529188.543220015]: 存在 param_int 吗? 1
[ INFO] [1723529188.543525068]: 存在 param_intttt 吗? 0
[ INFO] [1723529188.543831122]: 搜索键:/param_int
[ INFO] [1723529188.544247053]: param 删除结果:1