rclcpp::spin() 和 rclcpp::shutdown()

在ROS 2中,rclcpp::spin()rclcpp::shutdown() 是用于管理节点事件循环的标准函数,它们通常在主线程中使用,以确保节点能够持续处理传入的消息、服务请求和定时器事件。

rclcpp::spin()

rclcpp::spin() 函数会阻塞调用它的线程,直到与它关联的节点被销毁。在函数执行期间,它执行以下操作:

  1. 处理回调

    • 调用所有已注册的回调,包括订阅者的消息回调、服务的请求回调、定时器回调等。
  2. 事件循环

    • 处理所有ROS通信相关的事件,确保节点能够响应外部消息和服务请求。
  3. 阻塞执行

    • 该函数会一直运行,直到节点被销毁或者显式地调用 rclcpp::shutdown()

rclcpp::spin_some()

rclcpp::spin() 类似,rclcpp::spin_some() 也处理回调和事件,但它是非阻塞的。它会处理所有待处理的回调,然后立即返回。这允许在相同的线程中同时运行ROS回调和其他循环或任务。

rclcpp::shutdown()

rclcpp::shutdown() 函数用于关闭ROS 2的通信机制,并清理资源。当调用此函数时:

  1. 停止事件循环

    • 停止 rclcpp::spin()rclcpp::spin_some() 的执行。
  2. 资源清理

    • 释放与ROS 2节点相关的资源,包括关闭所有打开的通信连接、注销定时器、取消所有挂起的服务请求等。
  3. 线程返回

    • 如果 rclcpp::spin() 正在执行,调用 rclcpp::shutdown() 会导致它返回。

示例用法

#include "rclcpp/rclcpp.hpp"

class MyNode : public rclcpp::Node
{
public:
    MyNode() : Node("my_node")
    {
        // 初始化节点和相关操作
    }

    void start()
    {
        // 启动事件循环
        rclcpp::spin(this);
    }
};

int main(int argc, char * argv[])
{
    // 初始化ROS 2
    rclcpp::init(argc, argv);

    // 创建节点实例
    auto node = std::make_shared<MyNode>();

    // 开始处理回调
    node->start();

    // 当节点处理结束,进行清理
    rclcpp::shutdown();

    return 0;
}

在这个示例中:

  • MyNode 类继承自 rclcpp::Node,并有一个 start 方法,用于启动事件循环。
  • main 函数中,初始化ROS 2,创建节点实例,并调用 start 方法来开始处理回调。
  • 当节点的工作完成后,调用 rclcpp::shutdown() 来停止事件循环并进行清理。

注意事项

  • 线程安全

    • rclcpp::spin()rclcpp::shutdown() 都是线程安全的,可以在任何线程中调用。
  • 多线程

    • 如果你的应用程序使用了多个线程,可以在主线程中调用 rclcpp::spin(),而在其他线程中执行其他任务。
  • 资源管理

    • 确保在程序结束前调用 rclcpp::shutdown(),以释放所有资源并正确关闭节点。

通过使用 rclcpp::spin()rclcpp::shutdown(),可以确保ROS 2节点能够响应所有传入的通信事件,并在适当的时候正确地清理资源。

  • 3
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
class ArmConnect: public rclcpp::Node { public: ArmConnect(const arm_connect::TopicType &topic_param); ~ArmConnect() = default; Camera::ImageInfo& GetImageInfo(Camera::CameraNum num); std::vector<std::vector<double>>& GetPointCloudInfo(); void SaveCalibrationDataInfo(const std::string &filename); std::vector<CalibrationData::detection>& GetCalibrationDataInfo(); bool IsGetCalibrationIdInfo(); bool IsGetCakubrationDataInfo(); private: void ImageCallback(const sensor_msgs::msg::Image &msg); void PointCloudCallback(const sensor_msgs::msg::PointCloud2 &msg); void CalibrationDataCallback(const apriltag_msgs::msg::AprilTagDetectionArray &msg); private: rclcpp::Subscription<sensor_msgs::msg::Image>::SharedPtr image_subscriber_; Camera::ImageInfo camera_image_; std::mutex image_lock_; rclcpp::Subscription<sensor_msgs::msg::PointCloud2>::SharedPtr pointcloud_subscriber_; rclcpp::Publisher<sensor_msgs::msg::PointCloud2>:: SharedPtr pointcloud_publisher_; std::vector<std::vector<double>> pointcloud_vector_; pcl::PointCloud<pcl::PointXYZ>::Ptr point_cloud_; std::mutex pointcloud_lock_; rclcpp::Subscription<apriltag_msgs::msg::AprilTagDetectionArray>::SharedPtr calibrationdata_subscriber_; std::vector<CalibrationData::detection> calibrationdata_vector_; mutable bool calibrationdata_flag_ = false; mutable bool calibrationboard_flag_ = false; std::mutex Calibrationdata_lock_; int CalibrationID; }; 上述是一个类的定义,如何在main函数中给上述类中的 int CalibrationID 赋值
06-09
解释以下代码bool ret = laser.initialize(); if (ret) { ret = laser.turnOn(); } else { RCLCPP_ERROR(node->get_logger(), "%s\n", laser.DescribeError()); } auto laser_pub = node->create_publisher<sensor_msgs::msg::LaserScan>("scan", rclcpp::SensorDataQoS()); auto stop_scan_service = [&laser](const std::shared_ptr<rmw_request_id_t> request_header, const std::shared_ptr<std_srvs::srv::Empty::Request> req, std::shared_ptr<std_srvs::srv::Empty::Response> response) -> bool { return laser.turnOff(); }; auto stop_service = node->create_service<std_srvs::srv::Empty>("stop_scan",stop_scan_service); auto start_scan_service = [&laser](const std::shared_ptr<rmw_request_id_t> request_header, const std::shared_ptr<std_srvs::srv::Empty::Request> req, std::shared_ptr<std_srvs::srv::Empty::Response> response) -> bool { return laser.turnOn(); }; auto start_service = node->create_service<std_srvs::srv::Empty>("start_scan",start_scan_service); rclcpp::WallRate loop_rate(20); while (ret && rclcpp::ok()) { LaserScan scan;// if (laser.doProcessSimple(scan)) { auto scan_msg = std::make_shared<sensor_msgs::msg::LaserScan>(); scan_msg->header.stamp.sec = RCL_NS_TO_S(scan.stamp); scan_msg->header.stamp.nanosec = scan.stamp - RCL_S_TO_NS(scan_msg->header.stamp.sec); scan_msg->header.frame_id = frame_id; scan_msg->angle_min = scan.config.min_angle; scan_msg->angle_max = scan.config.max_angle; scan_msg->angle_increment = scan.config.angle_increment; scan_msg->scan_time = scan.config.scan_time; scan_msg->time_increment = scan.config.time_increment; scan_msg->range_min = scan.config.min_range; scan_msg->range_max = scan.config.max_range; int size = (scan.config.max_angle - scan.config.min_angle)/ scan.config.angle_increment + 1; scan_msg->ranges.resize(size); scan_msg->intensities.resize(size); for(size_t i=0; i < scan.points.size(); i++) { int index = std::ceil((scan.points[i].angle - scan.config.min_angle)/scan.config.angle_increment); if(index >=0 && index < size) { scan_msg->ranges[index] = scan.points[i].range; scan_msg->intensities[index] = scan.points[i].intensity; } } laser_pub->publish(*scan_msg); } else { RCLCPP_ERROR(node->get_logger(), "Failed to get scan"); } if(!rclcpp::ok()) { break; } rclcpp::spin_some(node); loop_rate.sleep(); } RCLCPP_INFO(node->get_logger(), "[YDLIDAR INFO] Now YDLIDAR is stopping ......."); laser.turnOff(); laser.disconnecting(); rclcpp::shutdown(); return 0; }
05-30
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值