ROS 消息通訊——動作action的來龍去脈

創建功能包：

 

 

•  修改功能包說明文件package.xml

<?xml version="1.0"?>
<package>
  <name>action_tutorials</name>
  <version>0.0.0</version>
  <description>The action_tutorials package</description>
  <maintainer email="[e-mail]">hcx</maintainer>
  <license>TODO</license>
  <buildtool_depend>catkin</buildtool_depend>
  <build_depend>actionlib</build_depend>
  <build_depend>actionlib_msgs</build_depend>
  <build_depend>roscpp</build_depend>
  <run_depend>actionlib</run_depend>
  <run_depend>actionlib_msgs</run_depend>
  <run_depend>roscpp</run_depend>
  <export>  </export>
</package>

• CMake編譯配置文件CMakeLists.txt

cmake_minimum_required(VERSION 2.8.3)
project(action_tutorials)


find_package(catkin REQUIRED COMPONENTS
  actionlib
  actionlib_msgs
  roscpp
)


find_package(catkin REQUIRED genmsg actionlib_msgs actionlib)
add_action_files(DIRECTORY action FILES DoDishes.action)
generate_messages(DEPENDENCIES actionlib_msgs)

include_directories(
  ${catkin_INCLUDE_DIRS}
)


add_executable(DoDishes_client src/DoDishes_client.cpp)
target_link_libraries( DoDishes_client ${catkin_LIBRARIES})
add_dependencies(DoDishes_client ${${PROJECT_NAME}_EXPORTED_TARGETS})

add_executable(DoDishes_server src/DoDishes_server.cpp)
target_link_libraries( DoDishes_server ${catkin_LIBRARIES})
add_dependencies(DoDishes_server ${${PROJECT_NAME}_EXPORTED_TARGETS})

• 添加動作文件：與CMakeLists.txt對應，add_action_files(DIRECTORY action FILES DoDishes.action)

 

 　　內容如下：---用於分割目標、結果、反饋，順序不能打亂

# Define the goal
uint32 dishwasher_id  # Specify which dishwasher we want to use
---
# Define the result
uint32 total_dishes_cleaned
---
# Define a feedback message
float32 percent_complete

• 創建動作客戶端節點：與CMakeLists.txt對應，add_executable(DoDishes_client src/DoDishes_client.cpp)

 

 　　內容如下：

#include <actionlib/client/simple_action_client.h>
#include "action_tutorials/DoDishesAction.h"

typedef actionlib::SimpleActionClient<action_tutorials::DoDishesAction> Client;

// 當action完成后會調用該回調函數一次
void doneCb(const actionlib::SimpleClientGoalState& state,
        const action_tutorials::DoDishesResultConstPtr& result)
{
    ROS_INFO("Yay! The dishes are now clean");
    ros::shutdown();
}

// 當action激活后會調用該回調函數一次
void activeCb()
{
    ROS_INFO("Goal just went active");
}

// 收到feedback后調用該回調函數
void feedbackCb(const action_tutorials::DoDishesFeedbackConstPtr& feedback)
{
    ROS_INFO(" percent_complete : %f ", feedback->percent_complete);
}

int main(int argc, char** argv)
{
    ros::init(argc, argv, "do_dishes_client");

    // 定義一個客戶端
    Client client("do_dishes", true);

    // 等待服務器端
    ROS_INFO("Waiting for action server to start.");
    client.waitForServer();
    ROS_INFO("Action server started, sending goal.");

    // 創建一個action的goal
    action_tutorials::DoDishesGoal goal;
    goal.dishwasher_id = 1;

    // 發送action的goal給服務器端，並且設置回調函數
    client.sendGoal(goal,  &doneCb, &activeCb, &feedbackCb);

    ros::spin();

    return 0;
}

• 創建動作服務器節點：與CMakeLists.txt對應，add_executable(DoDishes_server src/DoDishes_server.cpp)

 

　　內容如下：

#include <ros/ros.h>
#include <actionlib/server/simple_action_server.h>
#include "action_tutorials/DoDishesAction.h"

typedef actionlib::SimpleActionServer<action_tutorials::DoDishesAction> Server;

// 收到action的goal后調用該回調函數
void execute(const action_tutorials::DoDishesGoalConstPtr& goal, Server* as)
{
    ros::Rate r(1);
    action_tutorials::DoDishesFeedback feedback;

    ROS_INFO("Dishwasher %d is working.", goal->dishwasher_id);

    // 假設洗盤子的進度，並且按照1hz的頻率發布進度feedback
    for(int i=1; i<=10; i++)
    {
        feedback.percent_complete = i * 10;
        as->publishFeedback(feedback);
        r.sleep();
    }

    // 當action完成后，向客戶端返回結果
    ROS_INFO("Dishwasher %d finish working.", goal->dishwasher_id);
    as->setSucceeded();
}

int main(int argc, char** argv)
{
    ros::init(argc, argv, "do_dishes_server");
    ros::NodeHandle n;

    // 定義一個服務器
    Server server(n, "do_dishes", boost::bind(&execute, _1, &server), false);
    
    // 服務器開始運行
    server.start();

    ros::spin();

    return 0;
}

• 運行效果：

•  運行rqt_graph查看節點關系：

 

 

 

 話題列表如圖所示：