ros tutorial introductorio (siete) - Biblioteca de cliente (bajar)

roscpp diferente demostración de demostración

topic_demo

El modelo básico es similar, puede hacer referencia a la plantilla.

Descripción de la función: dos nodos, un GPS mensaje de liberación simulados (formato personalizado, incluyendo las coordenadas y estado de funcionamiento), el mensaje es aceptada y procesada (para calcular la distancia desde el origen).

pasos:

1. paquete
2. msg
3. talker.cpp
4. listener.cpp
5. CMakeList.txt y package.xml

1. paquete

$ cd ~/catkin_ws/src
$ catkin_create_pkg topic_demo roscpp rospy std_msgs

2. msg

$ cd topic_demo/
$ mkdir msg
$ cd msg
$ vi gps.msg
# gps.msg
float32 x
float32 y
string state

Cuando termine de crear msg, el compilador genera un ~/catkin_ws/devel/include/topic_demo/gps.harchivo. Escribir código incluye en ella

#include<topic_demo/gps.h>
topic_demo::gps msg;

3. talker.cpp

#include <ros/ros.h> 
#include <topic_demo/gps.h> 
int main(int argc, char** argv){
    ros::init(argc, argv, "talker" );    //解析参数，命名节点
    ros::NodeHandle nh;  //创建句柄， 实例化node
    topic_demo::gps msg;  //创建gps消息
    msg.x = 1.0;
    msg.y = 1.0;
    msg.state = "working";
    ros::Publisher pub = nh.advertise<topic_demo::gps>("gps_info", 1);  //用句柄操作创建publisher，<需要publish的类型>
    ros::Rate loop_rate(1.0);   //定义循环发布的频率
    while(ros::ok()){
        msg.x = 1.03 * msg.x;
        msg.y = 1.01 * msg.y;
        ROS_INFO( "Talker: GPS: x = %f, y = %f", msg.x , msg.y);
        pub.publish(msg);  //发布消息
        loop_rate.sleep();  
    }
    return 0；
}

4. listener.cpp

#include <ros/ros.h>
#include <topic_demo/gps.h>
#include <std_msgs/Float32.h>

void gpsCallback(const topic_demo::gps::ConstPtr &msg)  //ConstPtr &msg定义于gps.h文件中
{
    std_msgs::Float32 distance;
    distance.data = sqrt(pow(msg ->x, 2), pow(msg -> y, 2));
    ROS_INFO( " Listener: Distance to origin = %f, state = %s" , distanace.data, msg -> state.c_str() );
 }
int main(int argc, char** argv){
    ros::init(argc, argv, " listener");
    ros::NodeHandle n;
    ros::Subscribe sub = n.subscribe( "gps_info", 1, gpsCallback);  // 'gpsCallback'为该回调函数的指针，接受到消息后会通过该函数处理
    ros::spin();  //反复调用当前可触发的回调函数（阻塞） 
    return 0;
}

Consejos: ros :: spinOnce () con la acción de giro, pero es no bloqueante.

5. CMakeLists.txt

A continuación, puede compilar (catkin_make) y ejecutar (rosrun) a ~

service_demo

El modelo básico es similar, puede hacer referencia a la plantilla.

Descripción de la función: dos nodos, una solicitud de liberación (formato personalizado), otra recibir y procesar la información del mensaje y el retorno.

pasos:

1. paquete
2. msg
3. server.cpp
4. client.cpp
5. CMakeList.txt y package.xml

1. paquete

$ cd ~/catkin_ws/src
$ catkin_create_pkg service_demo roscpp rospy std_msgs

2. srv

$ cd service_demo/
$ mkdir srv
$ vi Greeting.srv
# Greeting.srv
string name
int32 age 
---
string feedback

Cuando termine de crear SRV, el compilador genera ~/catkin_ws/devel/include/service_demo/Greeting.h, .../GreetingRequest.h, .../GreetingResponse.harchivo. Escribir código incluye en ella

3. server.cpp

#include <ros/ros.h> 
#include <service_demo/Greeting.h> 

bool handle_function(service::demo::Greeting::Request &req, service::demo::Greeting::Response &res){
    //显示请求信息
    ROS_INFO( "Request from %s with age %d" . req.name.c_str(), req.age();
    //处理请求，结果写入response
    res.feedback = "Hi" + req.name + ". I' m server!" '
    //返回true，正确处理了请求
    return true;
}
int main(int argc, char** argv){
    ros::init(argc, argv, "greetings_server" );    //解析参数，命名节点
    ros::NodeHandle nh;  //创建句柄， 实例化node
    ros::ServiceServer service = nh.advertiseService("greetings",handle_function); //提供服务，后者同样是函数指针。
    ros::spin();
    return 0;
}

4. client.cpp

#include <ros/ros.h>
#include <service_demo/Greeting.h>

int main(int argc, char** argv){
    ros::init(argc, argv, " greetings_server" ); //解析参数，命名节点
    ros::NodeHandle nh;
    ros::ServiceClient client = nh.serviceClient<service_demo::Greeting>( "greetings" ); //“greetings”是发送的服务名
    
    service_demo::Greeting srv;
    srv.request.name = "HAN" ; 
    srv.request.age = "20" ; 
    
    if (client.call(srv)){  //call 的返回值就是上面Handle_function 的返回值。
        ROS_INFO( " Feedback from server : %s." , srv.response.feedback );
    }
    else{
        ROS_ERROR ( "Failed to call service greetings.") ; 
        return 1;
    }
    
    return 0;
    
}

5. CMakeLists.txt y package.xml

A continuación, puede compilar (catkin_make) y ejecutar (rosrun) a ~

param_demo

Hay dos tipos de API: Ros y Ros param :: :: NodeHandle

Configuración de los parámetros de maneras:

• En el código

#include <ros/ros.h>
int main(int argc, char** argv){
    ros::init(argc,argv, "greetings_server");
    ros::NodeHandle nh;
    int param1, param2, param3, param4, param5;
    //获取参数
    ros::param::get ("param1", param1);
    nh.getParam ("param2", param2);
    nh.param ("param3", param3, 123); //123是默认值
    //设置参数
    ros::param::set( "param4" , param4);
    nh.setParam("param5", param5);
    //检查参数是否存在
    ros::param::has("param5");
    nh.hasParam("param6");
    //删除参数
    ros::param::del("param5");
    nh.deleteParam("param6");
    
    return 0;
    
}

• En el archivo de inicio
  

Por favor indique la fuente.
Este documento resume la Universidad China de MOOC "Android OS Getting Started"
enlace: Enlace .
Imágenes del programa de captura de vídeo