【ros/ros2】LCN及ros2节点的LCN改写

lcn, lifecycle node, lmn, ros2节点lcn改写
摘要由CSDN通过智能技术生成

序言

  • 背景:ros2节点改写为lifecycle node节点

1. ros2两种节点类型

  • Node:和ros1中一样的节点基类
  • LifecycleNode:可管理状态的节点基类

2. LCN是什么

  • LCN = lifecycle node,生命周期节点,或者受控节点
  • 为了解决ros1中节点启动顺序无法控制的问题,ros2引入了生命周期节点的概念;与LCN相对应的是,LMN = lifecycle management node,控制节点
  • 支持控制节点LMN对各个受控节点LCN节点的管理

3. LCN状态转换

  • 有4个基础状态和6个切换状态,不同状态之间转换关系如下
  • 4个主状态:unconfigured + inactive + active + shutdown
  • 6个切换状态:Configuring + Activating + Deactivating + CleaningUp + ShuttingDown + ErrorProcessing

状态转换说明:

  • 不同状态之间的转换需要调用对应的回调函数如OnConfigure()等来实现,这些函数在对节点进行LCN改写时需要重新实现,即将不同功能划分到不同函数进行控制;
  • LMN和LCN之间通过service模式进行通信,LMN作为client,LCN作为server,LMN发起service request给LCN请求LCN状态转移操作
  • 节点运行时ros2会为每个节点配置默认的service,LCN会有特殊的service配置如
    change_state、get_state等

4. LCN状态转换要做的事

  • Configuring状态:调用on_configure回调函数

    • 加载配置:生命周期中必须被执行一次的任务,比如申请内存、配置topic订阅/发布等
    • 以及必要的设置:初始的配置参数,整个生命周期中必须保留的topic订阅器/发布器等
  • Activating状态:调用on_activate回调函数,尝试激活节点,为进入active状态做最后准备

    • 获取只在节点active期间会用到的资源,比如对硬件的访问权限
    • 避免执行需要很耗时的准备工作
  • Deactivating状态:调用on_deactivate函数,为后续 CleaningUp 做准备

    • 执行清理操作
    • 做与on_activate相反的操作,去激活与释放资源
  • CleaningUp状态:调用on_cleanup回调函数

    • 回调函数中应清除所有状态,并返回与初次创建时一样的状态
  • ShuttingDown状态:调用

  • 1
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
ROS 2中,创建节点需要进行以下步骤: 1. 创建一个ROS 2包(package) 在ROS 2中,使用`colcon`来编译ROS 2程序,因此在创建ROS 2包之前,需要先安装`colcon`。安装完成后,在终端中输入以下命令来创建ROS 2包: ``` mkdir -p ~/ros2_ws/src cd ~/ros2_ws/src ros2 pkg create my_package --build-type ament_cmake ``` 这个命令会在`~/ros2_ws/src`目录下创建一个名为`my_package`的ROS 2包,并使用`ament_cmake`作为构建类型。 2. 创建一个ROS 2节点ROS 2包中,可以创建多个节点。在`my_package`包中,使用以下命令来创建一个名为`my_node`的节点: ``` cd ~/ros2_ws/src/my_package ros2 pkg create my_node --build-type ament_cmake --node-name my_node ``` 这个命令会在`my_package`包中创建一个名为`my_node`的目录,并在其中生成一个C++源文件`my_node.cpp`,并且在`CMakeLists.txt`中添加了编译`my_node`节点所需的相关代码。 3. 编写节点代码 在`my_node.cpp`文件中编写节点代码。节点代码应该包含节点初始化、消息订阅和发布、消息处理等功能。例如,以下代码会创建一个ROS 2节点,订阅名为`/input`的字符串消息,并将消息添加到名为`/output`的字符串消息中进行发布: ```cpp #include "rclcpp/rclcpp.hpp" #include "std_msgs/msg/string.hpp" class MyNode : public rclcpp::Node { public: MyNode() : Node("my_node") { pub_ = create_publisher<std_msgs::msg::String>("output", 10); sub_ = create_subscription<std_msgs::msg::String>("input", 10, std::bind(&MyNode::onInput, this, std::placeholders::_1)); } private: void onInput(const std_msgs::msg::String::SharedPtr msg) { auto output_msg = std_msgs::msg::String(); output_msg.data = "Received message: " + msg->data; pub_->publish(output_msg); } rclcpp::Publisher<std_msgs::msg::String>::SharedPtr pub_; rclcpp::Subscription<std_msgs::msg::String>::SharedPtr sub_; }; int main(int argc, char** argv) { rclcpp::init(argc, argv); auto node = std::make_shared<MyNode>(); rclcpp::spin(node); rclcpp::shutdown(); return 0; } ``` 4. 编译节点 在终端中,使用以下命令编译ROS 2节点: ``` cd ~/ros2_ws colcon build --packages-select my_package ``` 这个命令会在`~/ros2_ws/build`目录下编译`my_package`包,并生成`my_node`节点的可执行文件。 5. 运行节点 在终端中,使用以下命令运行`my_node`节点: ``` cd ~/ros2_ws source install/setup.bash ros2 run my_package my_node ``` 这个命令会启动`my_node`节点,并开始订阅`/input`话题,并在`/output`话题中发布消息。 这是一个简单的ROS 2节点创建和使用的例子,实际情况中可能需要更复杂的节点和功能。同时,需要注意编写好`package.xml`和`CMakeLists.txt`文件,以正确配置ROS 2节点的依赖和编译选项。

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值