ROS设置plugin插件

举报
Hermit_Rabbit 发表于 2022/08/04 11:02:48 2022/08/04
【摘要】 为什么要设置plugin插件因为很多时候我们需要对产品进行包装。核心的代码是只留下输入输出接口的,所以我们使用plugin来实现.so文件的封装以及动态调取。在ROS的开发中,常常会接触到一个名词——插件(plugin)。这个名词在计算机软件开发中是常常会提到的,具体含义可以参考百度百科的插件词条。在ROS中,插件的概念类似,简单来讲,ROS中的插件(plugin)就是可以动态加载的扩展功...

为什么要设置plugin插件

因为很多时候我们需要对产品进行包装。核心的代码是只留下输入输出接口的,所以我们使用plugin来实现.so文件的封装以及动态调取。

在ROS的开发中,常常会接触到一个名词——插件(plugin)。这个名词在计算机软件开发中是常常会提到的,具体含义可以参考百度百科的插件词条。在ROS中,插件的概念类似,简单来讲,ROS中的插件(plugin)就是可以动态加载的扩展功能类。ROS中的pluginlib功能包,提供了加载和卸载plugin的C++库,开发者在使用plugin时,不需要考虑plugin类的链接位置,只需要将plugin注册到pluginlib中,即可直接动态加载。这种插件机制非常方便,开发者不需要改动原本软件的代码,直接将需要的功能通过plugin进行扩展即可。本文带你走近plugin,探索如何实现一个简单的plugin。

我们首先通过下边这张图来了解一下pluginlib的工作原理。

plugin_model_副本

假设ROS的功能包中已经存在一个polygon的基类(polygon_interface_package),我们可以通过plugin来实现两种polygon的功能支持:rectangle_plugin(rectangle_plugin_package)和triangle_plugin(triangle_plugin_package),在这两个功能包的package.xml中,需要声明polygon_interface_package中的基类polygon,然后在编译的过程中,会把插件注册到ROS系统,用户可以直接通过rospack的命令进行全局的插件查询,也可以在开发中直接使用这些插件了。

详细流程

pluginlib利用了C++多态的特性,不同的插件只要使用统一的接口,就可以替换使用,用户在使用过程中也不需要修改代码或者重新编译,选择需要使用的插件即可扩展相应的功能。一般来讲,实现一个插件主要需要以下几个步骤:

  1. 创建基类,定义统一的接口。如果是基于现有的基类实现plugin,则不需要这个步骤。
  2. 创建plugin类,继承基类,实现统一的接口。
  3. 注册插件
  4. 编译生成插件的动态链接库
  5. 将插件加入ROS系统

1)创建基类

接下来,我们就根据这几个步骤来实现第一节图示中的plugin功能,在开始之前,你需要建立一个pluginlib_tutorials的功能包,添加依赖pluginlib。

catkin_create_pkg pluginlib_tutorials roscpp pluginlib

此时,工程目录环境如下(注意这里有一些文件是后边步骤中才创建的):

catkin/
|---src/
    |---CMakeLists.txt -> /opt/ros/kinetic/share/catkin/cmake/toplevel.cmake
    |---pluginlib_tutorials_/
        |---CMakeLists.txt
        |---include/
            |---pluginlib_tutorials_/
        |---package.xml
        |---polygon_plugins.xml
        |---src/

在CMakeLists.txt和package.xml中如下图所示会出现pluginlib的库

image-20210513141352751

image-20210513141506281

创建catkin/src/pluginlib_tutorials_/include/pluginlib_tutorials_/polygon_base.h文件,并写入如下代码:

#ifndef PLUGINLIB_TUTORIALS__POLYGON_BASE_H_
#define PLUGINLIB_TUTORIALS__POLYGON_BASE_H_
 
namespace polygon_base
{
  class RegularPolygon
  {
    public:
      virtual void initialize(double side_length) = 0;
      virtual double area() = 0;
      virtual ~RegularPolygon(){}
 
    protected:
      RegularPolygon(){}
  };
};
#endif

这里创建了个RegularPolygon抽象基类,后边的插件类就是继承该类。

2)创建插件

在include目录下创建include/pluginlib_tutorials_/polygon_plugins.h文件,并写入如下代码:

#ifndef PLUGINLIB_TUTORIALS__POLYGON_PLUGINS_H_
#define PLUGINLIB_TUTORIALS__POLYGON_PLUGINS_H_
#include <pluginlib_tutorials_/polygon_base.h>
#include <cmath>
 
namespace polygon_plugins
{
  class Triangle : public polygon_base::RegularPolygon
  {
    public:
      Triangle(){}
 
      void initialize(double side_length)
      {
        side_length_ = side_length;
      }
 
      double area()
      {
        return 0.5 * side_length_ * getHeight();
      }
 
      double getHeight()
      {
        return sqrt((side_length_ * side_length_) - ((side_length_ / 2) * (side_length_ / 2)));
      }
 
    private:
      double side_length_;
  };
 
  class Square : public polygon_base::RegularPolygon
  {
    public:
      Square(){}
 
      void initialize(double side_length)
      {
        side_length_ = side_length;
      }
 
      double area()
      {
        return side_length_ * side_length_;
      }
 
    private:
      double side_length_;
 
  };
};
#endif

这里创建了两个继承自基础类RegularPolygon的插件子类Triangle和Square。

3)注册插件

在2)中已经创建了两个类Triangle和Square,接下来需要使用pluginlib将这两个类声明为插件。

创建src/polygon_plugins.cpp文件,并写入以下代码:

#include <pluginlib/class_list_macros.h>
#include <pluginlib_tutorials_/polygon_base.h>
#include <pluginlib_tutorials_/polygon_plugins.h>
 
//注册插件,宏参数:plugin的实现类,plugin的基类
PLUGINLIB_EXPORT_CLASS(polygon_plugins::Triangle, polygon_base::RegularPolygon)
PLUGINLIB_EXPORT_CLASS(polygon_plugins::Square, polygon_base::RegularPolygon)

这里前三行include分别引入的头文件,是为了以下内容PLUGINLIB_EXPORT_CLASS、polygon_base::RegularPolygon、polygon_plugins::Triangle、polygon_plugins::Square能够找到。

后边两行代码,使用pluginlib中提供的PLUGINLIB_EXPORT_CLASS来将polygon_plugins::Triangle、polygon_plugins::Square注册为插件,这两个类的父类为polygon_base::RegularPolygon。

4)编译插件

在CMakeLists.txt文件中写入下面两行代码:

include_directories(include)
add_library(polygon_plugins src/polygon_plugins.cpp)

#可以考虑下面的使用install实现将插件放置到可执行文件或者库文件中
install(FILES blp_plugin.xml
    DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}
)

install具体可以参照《CMakeLists文件install的使用》进行设置,ROS当中的CATKIN_PACKAGE_SHARE_DESTINATION可以参照下文

此时,可以在命令行窗口的工作空间顶目录下输入catkin_make命令进行编译:

img

通过编译日志可以看出,编译完成后生成了动态库libpolygon_plugins.so,存放在devel/lib下面。这个也就是我们创建成功的插件文件。

至此,插件创建成功了,下面徐亚创建插件描述文件以让ROS中插件加载器找到这个插件并提供给每个应用程序中来使用。

5)将创建的插件添加到ROS的工具链当中

(1)创建插件描述文件

在catkin/src/pluginlib_tutorials_/路径下创建polygon_plugins.xml文件,并写入以下代码:

<library path="lib/libpolygon_plugins">
  <class type="polygon_plugins::Triangle" base_class_type="polygon_base::RegularPolygon">
    <description>This is a triangle plugin.</description>
  </class>
  <class type="polygon_plugins::Square" base_class_type="polygon_base::RegularPolygon">
    <description>This is a square plugin.</description>
  </class>
</library>

可以仔细看一下这个xml文件中的内容。

<library path="lib/libpolygon_plugins"> library标签写明了要输出的lib文件所在的相对路径;

<class></class> class标签内容写明了插件的信息。

type:插件的完整类型,例如polygon_plugins::Triangle;

base_class_type:插件完整类型的父类,例如polygon_base::RegularPolygon;

description:描述插件是做什么的;

(2)导出插件

在package.xml文件中写入以下代码,将创建的插件导出:

<export>
    <pluginlib_tutorials_ plugin="${prefix}/polygon_plugins.xml" />
</export>

可以看出,这里使用export标签将插件导出,里边指定了以上创建的插件描述文件的路径,其中pluginlib_tutorials_为基类所在的包名称

此时,再次进行编译:

img

验证创建的插件是否有效:

这里,先source一下setup.bash文件,然后输入以下命令:

rospack plugins --attrib=plugin pluginlib_tutorials_

可以看出输出结果为创建的插件polygon_plugins.xml的绝对路径,这表明ROS工具链设置正确,可以和创建的插件一起使用。

在ROS程序中使用插件

插件已经创建好了,怎么使用插件呢?这里需要写一个插件测试程序来使用插件。

打开src/polygon_loader.cpp文件,并写入以下内容:

#include <pluginlib/class_loader.h>
#include <pluginlib_tutorials_/polygon_base.h>
 
int main(int argc, char** argv)
{
    // 创建一个ClassLoader,用来加载plugin
  pluginlib::ClassLoader<polygon_base::RegularPolygon> poly_loader("pluginlib_tutorials_", "polygon_base::RegularPolygon");
 
  try
  {
    // 加载Triangle插件类,路径在polygon_plugins.xml中定义
    boost::shared_ptr<polygon_base::RegularPolygon> triangle = poly_loader.createInstance("polygon_plugins::Triangle");
    // 初始化边长
    triangle->initialize(10.0);
 
    boost::shared_ptr<polygon_base::RegularPolygon> square = poly_loader.createInstance("polygon_plugins::Square");
    square->initialize(10.0);
 
    ROS_INFO("Triangle area: %.2f", triangle->area());
    ROS_INFO("Square area: %.2f", square->area());
  }
  catch(pluginlib::PluginlibException& ex)
  {
    ROS_ERROR("The plugin failed to load for some reason. Error: %s", ex.what());
  }
 
  return 0;
}

从上边的代码中我们可以看到,plugin可以在程序中动态加载,成功加载之后就可以调用plugin的接口来实现相应的功能了。

修改CMakefile.txt,添加上边代码的编译规则:

add_executable(polygon_loader src/polygon_loader.cpp) 
target_link_libraries(polygon_loader ${catkin_LIBRARIES})

然后编译并运行,可以看到如下结果:

img

参考链接

https://www.guyuehome.com/920

https://blog.csdn.net/moyu123456789/article/details/107907196?spm=1001.2014.3001.5501

【版权声明】本文为华为云社区用户原创内容,转载时必须标注文章的来源(华为云社区)、文章链接、文章作者等基本信息, 否则作者和本社区有权追究责任。如果您发现本社区中有涉嫌抄袭的内容,欢迎发送邮件进行举报,并提供相关证据,一经查实,本社区将立刻删除涉嫌侵权内容,举报邮箱: cloudbbs@huaweicloud.com
  • 点赞
  • 收藏
  • 关注作者

评论(0

0/1000
抱歉,系统识别当前为高风险访问,暂不支持该操作

全部回复

上滑加载中

设置昵称

在此一键设置昵称,即可参与社区互动!

*长度不超过10个汉字或20个英文字符,设置后3个月内不可修改。

*长度不超过10个汉字或20个英文字符,设置后3个月内不可修改。