【ROS入门】使用 ROS 动作(Action)机制实现目标请求、进度与完成结果的反馈

最新推荐文章于 2023-11-02 10:08:14 发布
最新推荐文章于 2023-11-02 10:08:14 发布
阅读量560 收藏 3
点赞数 1
分类专栏： ROS 文章标签： 机器人 c++
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/puddlerubbish/article/details/133490582
版权

文章结构

任务要求

使用 ROS 动作(Action)机制实现目标请求、进度与完成结果的反馈：

  • 创建服务端，注册 Action
  • 客户端发送action 请求检测 40个零件
  • 服务端接收后，每隔 1s 检测一个零件 (每检测一个打印1次)，并实时给客户端返回检测进度(客户端打印进度百分比)，并在检测完毕时告知客户端目标完成。

话题模型

action 是一种类似于服务通信的实现，其实现模型也包含请求和响应，但是不同的是，在请求和响应的过程中，服务端还可以连续的反馈当前任务进度，客户端可以接收连续反馈并且还可以取消任务。

action结构图解:

请添加图片描述

action结构图解:
请添加图片描述

实现步骤

定义action文件

action、srv、msg 文件内的可用数据类型一致，且三者实现流程类似

按照固定格式创建action文件

首先新建功能包，并导入依赖: roscpp rospy std_msgs actionlib actionlib_msgs

然后功能包下新建 action 目录，新增 check.action文件。

action 文件内容组成分为三部分:请求目标值、最终响应结果、连续反馈，三者之间使用—分割

内容如下:
在这里插入图片描述

编辑配置文件

CMakeLists.txt

find_package
(catkin REQUIRED COMPONENTS
  roscpp
  rospy
  std_msgs
  actionlib
  actionlib_msgs
)

add_action_files(
  FILES
  check.action
)

generate_messages(
  DEPENDENCIES
  std_msgs
  actionlib_msgs
)

catkin_package(
#  INCLUDE_DIRS include
#  LIBRARIES demo04_action
 CATKIN_DEPENDS roscpp rospy std_msgs actionlib actionlib_msgs
#  DEPENDS system_lib
)

编译生成中间文件

编译后会生成一些中间文件。

msg文件(…/工作空间/devel/share/包名/msg/xxx.msg):

在这里插入图片描述

C++ 调用的文件(…/工作空间/devel/include/包名/xxx.h):

在这里插入图片描述

Python 调用的文件(…/工作空间/devel/lib/python3/dist-packages/包名/msg/xxx.py):

在这里插入图片描述

编写服务端和客户端

vscode配置

{
  "configurations": [
    {
      "browse": {
        "databaseFilename": "${default}",
        "limitSymbolsToIncludedHeaders": false
      },
      "includePath": [
        "/opt/ros/noetic/include/**",
        "/home/chenyikeng/demo01_ws/src/helloworld/include/**",
        "/home/chenyikeng/ROS_Topic_Demo/src/topic_demo/include/**",
        "/usr/include/**",
        "/home/chenyikeng/ROS_Topic_Demo/devel/include"
      ],
      "name": "ROS",
      "intelliSenseMode": "gcc-x64",
      "compilerPath": "/usr/bin/gcc",
      "cStandard": "gnu11",
      "cppStandard": "c++14"
    }
  ],
  "version": 4
}

服务端

/*
流程:
    1.包含头文件;
    2.初始化ROS节点;
    3.创建NodeHandle;
    4.创建action服务对象;
    5.处理请求,产生反馈与响应;
      a.获取并解析提交的目标值
      b.产生连续反馈
      c.最终结果响应
    6.spin().
*/


#include "ros/ros.h"
#include "actionlib/server/simple_action_server.h"  //actionlib里头服务端的库
#include "action_demo/checkAction.h"    //自定义action文件时编译生成的库

// 使用模板创建action服务对象并定义
typedef actionlib::SimpleActionServer<action_demo::checkAction> Server;


//请求处理(a.解析提交的目标值;b.产生连续反馈;c.最终结果响应) --- 回调函数
void callBack(const action_demo::checkGoalConstPtr &goalPtr, Server*  server)
{
    // a.获取并解析提交的目标值
    int goal_num = goalPtr -> num;
    ROS_INFO("客户端提交的目标值是: %d",goal_num);

    // b.产生连续反馈
    ros::Rate rate(1); //1Hz
    int result = 0;
    for(int i = 1; i<= goal_num; i++)
    {
        // 累加
        result ++;
        // 休眠
        rate.sleep();
        //产生（封装）连续反馈
        //创建feedback对象
        action_demo::checkFeedback fb;
        fb.progress_bar = i / (double)goal_num;
        //发送
        server->publishFeedback(fb);
        //打印
        ROS_INFO("检测%d个零件", result);
    }

    // c.最终结果响应
    // 创建result对象
    ROS_INFO("检测完成");
    action_demo::checkResult r;
    r.result = result;
    server -> setSucceeded(r);
}

int main(int argc, char *argv[])
{
    setlocale(LC_ALL,"");

    ros::init(argc,argv,"check_server");

    ros::NodeHandle n;

    // 创建action服务对象
    /*SimpleActionServer(ros::NodeHandle n,     #句柄
                        std::string name,       #话题名称
                        boost::function<void (const action_demo::checkGoalConstPtr &)> execute_callback,    
                        #回调函数，可以解析传入的目标值，产生连续反馈，以及响应最终结果
                        bool auto_start)        #布尔值，是否自动启动
    */
    Server server(n,"check",boost::bind(&callBack,_1,&server),false);

    //如果auto_start为false，那么需要手动调用该函数启动服务
    server.start();     
    ROS_INFO("服务启动……");

    //spin()回旋
    ros::spin();
    return 0;
}

客户端

/*
流程:
    1.包含头文件;
    2.初始化ROS节点;
    3.创建NodeHandle;
    4.创建action客户端对象;
    5.发送目标，处理反馈以及最终结果;
      a.连接建立 --- 回调函数
      b.处理连续反馈 --- 回调函数
      c.处理最终响应 --- 回调函数
    6.spin().
*/
#include "ros/ros.h"
#include "actionlib/client/simple_action_client.h"  //actionlib里头服务端的库
#include "action_demo/checkAction.h"    //自定义action文件时编译生成的库


// 创建action客户端对象
typedef actionlib::SimpleActionClient<action_demo::checkAction> Client;

// 服务端返回最终响应结果时候触发的回调
void done_cb(const actionlib::SimpleClientGoalState &state, const action_demo::checkResultConstPtr &result)
{
    // 判断响应状态是否成功
    if (state.state_ == state.SUCCEEDED)
        ROS_INFO("检测完成");
    else 
        ROS_INFO("任务失败！");
}

// 连接被激活的时候触发的回调
void active_cb()
{
    ROS_INFO("服务已经被激活....");
}

// 连续反馈时的回调函数
void feedback_cb(const action_demo::checkFeedbackConstPtr &feedback)
{   
    float progress_bar_percentage = feedback->progress_bar*100;
    if(progress_bar_percentage-(int)progress_bar_percentage==0)
        ROS_INFO("当前进度:%d%%",(int)progress_bar_percentage);
    else
        ROS_INFO("当前进度:%.1f%%",progress_bar_percentage);
}

int main(int argc, char *argv[])
{
    setlocale(LC_ALL,"");

    ros::init(argc,argv,"check_client");

    ros::NodeHandle n;

    // 创建action客户端对象;
    // SimpleActionClient(ros::NodeHandle & n, const std::string & name, bool spin_thread = true)
    // actionlib::SimpleActionClient<demo01_action::AddIntsAction> client(nh,"addInts");
    Client client(n,"check",true);

    //等待服务启动
    ROS_INFO("等待服务器启动……");
    client.waitForServer();

    // 发送目标，处理反馈以及最终结果;
    /*  
        void sendGoal(const demo01_action::AddIntsGoal &goal, 
            boost::function<void (const actionlib::SimpleClientGoalState &state, const demo01_action::AddIntsResultConstPtr &result)> done_cb, 
            用于处理最终响应
            boost::function<void ()> active_cb, 
            连接被激活的时候使用的回调
            boost::function<void (const demo01_action::AddIntsFeedbackConstPtr &feedback)> feedback_cb)
            处理连续反馈时相关的回调函数
    */

    // 设置目标值：40个零件
    // 声明对象
    action_demo::checkGoal goal;
    goal.num = 40;

    // 发送目标数据
    client.sendGoal(goal,&done_cb,&active_cb,&feedback_cb);


    // spin()回旋
    ros::spin();
    return 0;
}

编译配置文件

add_executable(check_server_c src/check_server_c.cpp)
add_executable(check_client_c src/check_client_c.cpp)
...

add_dependencies(check_server_c ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS})
add_dependencies(check_client_c ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS})
...

target_link_libraries(check_server_c
  ${catkin_LIBRARIES}
)
target_link_libraries(check_client_c
  ${catkin_LIBRARIES}
)

执行

首先启动 roscore，然后分别启动action服务端与action客户端，最终运行结果与案例类似。

结果如下：

在这里插入图片描述

趴抖
关注
  • 1
    点赞
  • 踩
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
专栏目录
古月居ros入门21讲课件
06-12
古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ros入门21讲古月居ro
ROS与C++入门教程.pdf
07-27
介绍利用 C++来编写 ROS 程序，编写 ROS 参数，ROS 服务，ROS 发布器，ROS 订阅器，分析 C++例程，分析 roscpp 类 API
【ROS入门-5】深入了解ROS话题通信机制的过程
01-06
文章目录前言ROS系列文章节点的连接①发布者`Talker`注册②订阅者`Listener`注册③节点管理器`ROS Master`进行话题匹配④订阅者`Listener`向`Talker`发送连接请求⑤发布者`Talker`确认连接请求⑥`Listener`尝试与`Talker`建立网络连接⑦`Talker`向`Listener`发布消息总结引用说明参考 前言 在上一篇文章中简单了解了ROS话题通信机制，但是它内部的通信过程，很多人都是不知道的，今天我看了 胡春旭的书籍——《ROS机器人开发实践》，又加深了对ROS话题通信的理解，打算接着讲解一下其过程是怎么样的。 ROS系列文章 【ROS
rosaction:ROS动作命令行工具
05-02
ROS动作命令行工具 这是一个ROS操作命令行工具，其功能类似于内置的rostopic和rosservice命令。 目前，除了自动补全功能之外，所有功能都在那里。
ROS：动作(action)通信
OceanStar的博客
10-06 1352
ROS引入通信机制，是为了实现ROS节点(进程)之间的通信。利用ROS进程的分布式框架，可以使得每个进程独立的工作，甚至分布于不同的主机工作。机器人上的各种传感器，比如雷达、GPS等，需要传递数据以实现对机器人的合理控制，进程通信的实现是传输数据的关键。
ROS action
穿着帆布鞋也能走猫步
04-11 4459
Actionlib是ROS非常重要的库，像执行各种运动的动作，例如控制手臂去抓取一个杯子，这个过程可能复杂而漫长，执行过程中还可能强制中断或反馈信息，这时Actionlib就能大展伸手了。 1.主要作用在ros中，如果想要发送一个request给一个节点该节点完成一些任务，并且给出一个回复，这样可以使用ros中的service完成。但是有一些应用中任务执行的时间很长，用户需要查看执行的进度如何，以
ROS 动作Action
TTTTTTTTTSS的博客
05-09 1103
ROS 动作
ROS action简单使用示例
YiYeZhiNian的博客
12-12 1334
像是在service中，当我们请求一个程序运行的时候，如果中途我们发现运行的轨迹偏离了预期，是无法请求停止的，需要让其主动返回失败才可以。另外注意到cliect端还可以用于控制action在特定的时候关闭，比如运行到一半的时候，不想继续执行的时候我们可以通过cancel的topic停止当前循环，在isPreemptRequested()函数接收到cancel请求时会进入函数处理。在ros中，大部分情况下的信息我们使用publisher与subscriber的机制来处理，也就是topic的机制。
ROS高效进阶第六章 -- Ros Action通信机制
最新发布
cy1641395022的博客
11-02 372
ROS高效进阶第六章 -- 机器人SLAM建图与自主导航之Ros Action通信机制
《动手学ROS2》5.4ROS2_Action介绍
生活不止眼前的苟且
11-12 1205
本系列教程作者：小鱼 公众号：鱼香ROS QQ交流群：139707339 教学视频地址：小鱼的B站 完整文档地址：鱼香ROS官网 版权声明：如非允许禁止转载与商业用途。 5.4 ROS2_Action介绍 你好，我是小鱼。通过前面章节的学习，你已经掌握了ROS2中四大通信利器中话题、服务、参数这三个，还差最后一个就能将ROS2的通信机制全部打包带回家了，这节课小鱼就带你一起认识一下Action，并带你动手体验一下Action通信。 1.Action背景 前面章节学习了话题、服务、参数。 话题适用于节点.
ROS入门与实战
09-22
《ROS入门与实战》深入浅出地介绍了ROS的特点、基本使用方法以及实际应用，内容涉及移动机器人自主导航、视觉识别、机械臂运动规划等，可帮助不同领域的机器人开发人员了解并熟练使用ROS。 　《ROS入门与实战》内容...
Actionbar入门（二）
飞鸟
03-04 827
溢出菜单         在别的一些应用中，经常看到在actionbar的最右边会出现一竖着排列的三个点(把有些功能选项给折叠起来了)里面放着一些操作选项，这被折叠起来的选项叫做溢出菜单(action overflow)。图如下：         由于actionbar的长度是有限的。当空间不够时，如果手机没有物理菜单键，多余的action button(上图中有2)会自动收缩到a
Android ActionBar的基本用法
热门推荐
bigconvience的专栏
06-06 11万+
本文翻译了这篇文章：Using the Android action bar (ActionBar) - Tutorial 1、ActionBar的简介 ActionBar位于Activity的顶部，可用来显示activity的标题、Icon、Actions和一些用于交互的View。它也可被用于应用的导航。 ActionBar 是在Android 3.0(API 11）中加入到SK中的，
ROS通信机制之动作(Action)服务的实践
深度学习领域优质创作者，CSDN博客专家
09-04 629
介绍ROS通信中非常重要的机制：动作.action
android 自定义 进度条 旋转,Android_Android ProgressBar进度条使用详解，ProgressBar进度条，分为旋转进 - phpStudy...
weixin_39640008的博客
05-26 357
Android ProgressBar进度条使用详解ProgressBar进度条，分为旋转进度条和水平进度条，进度条的样式根据需要自定义，之前一直不明白进度条如何在实际项目中使用，网上演示进度条的案例大多都是通过Button点击增加、减少进度值，使用方法incrementProgressBy(int)，最简单的做法是在xml布局文件中放置ProgressBar空间，然后再MainActivity中...
ROS入门之——action
沐棋的博客
08-13 1万+
a
ROS通信机制(四) —— 动作(action)与action文件
画茧自缚
11-03 3164
文章主要记录了ROS使用动作进行通信的过程及知识点，以及自定义action文件。
ROS2学习——（ACTION）
Siva5的博客
06-06 2662
action 是 ROS 2 中的一种通信类型，适用于长时间运行的任务。 它们由三个部分组成：目标(goal)、反馈（feedback）和结果（result）。action 建立在主题(topic)和服务（service）之上。 它们的功能类似于服务(service)，除了操作是可抢占的（您可以在执行时取消它们）。 它们还提供稳定的反馈，而不是返回单一响应的服务。action 使用客户端（Client）-服务器(Server)模型，类似于发布者（publisher）-订阅者(subscriber)模型（在主
ROS之Action动作通信详解（分析+源码）
超级霸霸强的博客
01-16 1万+
话题通信：异步通信 话题通信的好处在于：只要双方通过同一个topic建立联系，talker就可以向topic一直发送数据，listener也可以从topic中实时的获取数据。只要这个联系一直存在，那么数据的单向传输就不会中断。 那现在我们试想一下这样的情况：我想要控制机械臂一直在空中旋转并且实时的获取机械臂的运动位姿，那作为单向传输的话题通信就有些复杂了： 要用到两个topic才可以实现，这样一看确实有些复杂。 服务通信：同步通信 ...
简述ROS通信机制的话题服务动作实现流程并写出相同点
06-12
ROS通信机制包括话题（Topic）、服务（Service）和动作（Action）三种方式。 1. 话题：话题是一种发布/订阅（Publish/Subscribe）机制，发布者（Publisher）将消息发布到话题中，订阅者（Subscriber）从话题中接收消息。话题的实现流程如下： - 发布者指定话题名、消息类型和队列长度。 - 发布者将消息发布到话题中。 - 订阅者从话题中接收消息。 2. 服务：服务是一种请求/响应（Request/Response）机制，客户端（Client）向服务器（Server）发送请求，服务器对请求进行处理并返回响应。服务的实现流程如下： - 定义服务类型和服务名。 - 服务器等待客户端请求。 - 客户端向服务器发送请求。 - 服务器对请求进行处理并返回响应。 3. 动作：动作是一种异步请求/响应机制，客户端向服务器发送请求，服务器对请求进行处理并返回响应，但在响应返回之前，客户端可以取消请求或者向服务器发送取消请求。动作的实现流程如下： - 定义动作类型和动作名。 - 服务器等待客户端请求。 - 客户端向服务器发送请求。 - 服务器对请求进行处理并返回响应。 - 在响应返回之前，客户端可以取消请求或者向服务器发送取消请求。 相同点：话题、服务和动作都是ROS通信机制的一部分，它们都实现了不同的通信机制，使得ROS系统中的组件能够进行数据交换和协作。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值