首页 > 其他分享 >cartographer之MapBuilder类

cartographer之MapBuilder类

时间:2024-08-04 13:18:18浏览次数:12  
标签:node map cartographer cc builder MapBuilder options

node_main.cc

 node_main.cc--->node.cc--->map_builder_bridge.cc--->map_builder.cc

node_main.cc:cartographer_ros/cartographer_ros/cartographer_ros/node_main.cc

  // MapBuilder类是完整的SLAM算法类,包含前端(TransformingTrajectoryBuilder,scan to submap)、后端(用于查找回环的PoseGraph)、优化器等模块。
  auto map_builder =
      cartographer::mapping::CreateMapBuilder(node_options.map_builder_options);
  // 输入:
  // node_options:节点选项
  // map_builder:地图构建器
  // tf_buffer:tf缓存
  // collect_metrics:是否收集运行时指标
  // 输出:
  // node:Cartographer节点
  // 这里使用了std::move()函数,将map_builder转移到Node对象中,避免map_builder被销毁。
  // std::move()函数将左值(左值引用)转移到右值(右值引用)并返回右值。
  Node node(node_options, std::move(map_builder), &tf_buffer,
            FLAGS_collect_metrics); //node.cc

 

Node类的构造函数:cartographer_ros/cartographer_ros/cartographer_ros/node.cc

// 该构造函数主要是初始化Node对象,包括初始化ROS节点句柄、地图构建器桥接、TF缓冲区、度量注册表、发布者、服务服务器、定时器等。
// 其中,初始化ROS节点句柄、地图构建器桥接、TF缓冲区、发布者、服务服务器、定时器等的过程,均是通过调用相应的初始化函数完成。
// 其中,初始化地图构建器桥接的过程,主要是创建地图构建器接口对象,并将其传递给地图构建器桥接对象。
// 作用:创建Node对象,并初始化Node对象。
Node::Node(
    const NodeOptions& node_options,  // 节点选项
    std::unique_ptr<cartographer::mapping::MapBuilderInterface> map_builder,  // 地图构建器接口
    tf2_ros::Buffer* const tf_buffer,  // TF缓冲区
    const bool collect_metrics)  // 是否收集度量
    // 
    : node_options_(node_options),  // 初始化节点选项只是赋值给成员变量
      map_builder_bridge_(node_options_, std::move(map_builder), tf_buffer) // map_builder_bridge.cc

MapBuilderBridge类的构造函数:cartographer_ros/cartographer_ros/cartographer_ros/map_builder_bridge.cc

// MapBuilderBridge类的构造函数,用于初始化MapBuilderBridge对象。
// 参数:
//   node_options: NodeOptions对象,包含节点配置选项。
//   map_builder: 指向cartographer::mapping::MapBuilderInterface对象的智能指针,用于地图构建。
//   tf_buffer: 指向tf2_ros::Buffer对象的指针,用于处理TF变换。
MapBuilderBridge::MapBuilderBridge(
    const NodeOptions& node_options,
    std::unique_ptr<cartographer::mapping::MapBuilderInterface> map_builder,
    tf2_ros::Buffer* const tf_buffer)
    : node_options_(node_options),
      map_builder_(std::move(map_builder)),// map_builder.cc
      tf_buffer_(tf_buffer) {}

 MapBuilder类的构造函数:cartographer/cartographer/mapping/map_builder.cc

MapBuilder::MapBuilder(const proto::MapBuilderOptions& options)
    : options_(options), thread_pool_(options.num_background_threads())

ThreadPool类的构造函数:cartographer/cartographer/common/thread_pool.cc

// 线程池类构造函数,接受一个整数参数num_threads,表示线程池中的线程数量。
// 该构造函数会检查传入的线程数量是否大于0,如果不大于0则输出错误信息。
// 然后,它会创建指定数量的线程,并将它们添加到线程池中。每个线程都会执行ThreadPool::DoWork方法。
ThreadPool::ThreadPool(int num_threads) {
  CHECK_GT(num_threads, 0) << "ThreadPool requires a positive num_threads!";
  absl::MutexLock locker(&mutex_);
  for (int i = 0; i != num_threads; ++i) {
    pool_.emplace_back([this]() { ThreadPool::DoWork(); });
  }
}

ThreadPool::DoWork函数:

// 线程池的工作线程执行函数。该函数负责从任务队列中取出任务并执行。
void ThreadPool::DoWork() {
#ifdef __linux__
  // 在Linux系统上,调整当前线程的优先级,以确保后台任务不会占用前台线程的CPU资源。
  CHECK_NE(nice(10), -1);
#endif
  const auto predicate = [this]() EXCLUSIVE_LOCKS_REQUIRED(mutex_) {
    return !task_queue_.empty() || !running_;
  };
  // 死循环,不断从任务队列中取出任务并执行。
  for (;;) {
    std::shared_ptr<Task> task;
    {
      absl::MutexLock locker(&mutex_);
      mutex_.Await(absl::Condition(&predicate));
      if (!task_queue_.empty()) {
        task = std::move(task_queue_.front());
        task_queue_.pop_front();
      } else if (!running_) {
        // 线程池停止运行,退出循环。
        return;
      }
    }
    CHECK(task);
    CHECK_EQ(task->GetState(), common::Task::DEPENDENCIES_COMPLETED);
    Execute(task.get());
  }
}

 

标签:node,map,cartographer,cc,builder,MapBuilder,options
From: https://www.cnblogs.com/ffdltsd/p/18341653

相关文章

  • 关于cartographer在github中的文件分配
    Cartographer是一个开源的库,用于2D和3D的SLAM。在Cartographer项目中,地图构建的数据传入和处理通常分布在几个不同的组件和文件夹中。以下是一些可能包含相关代码的文件夹和组件:1.**传感器驱动**(`cartographer/sensor`):这个目录包含用于处理不同类型传感器输入的代码,例如......
  • 装了一次没成功的前提下,ubuntu18.04+ros(melodic)安装 cartographer源码安装及测试---
    因为项目需要所以要安装cartographer,最开始也没仔细研究一下,随便找了一个csdn教程就跟着安装了,装了一下午,总是在最后编译的时候出错,晚上的时候心态崩了,咸鱼上找了个远程安装的,他好像是用小鱼的那个脚本安装,装了一个小时也没安装好。不死心的我又去咸鱼上找人,然后开口要两千块,两......
  • cartographer代码——世界坐标系点和像素坐标系点的转换
    构建栅格地图,要弄清楚坐标之间的关系。本篇根据代码,画出了坐标转换的关系。如下图:cartographer中的代码如下://Returnstheindexofthecellcontainingthe'point'whichmaybeoutside//themap,i.e.,negativeortoolargeindicesthatwillreturnfalsefo......
  • cartographer重要模块——motion_filter
    运动滤波,间隔一段时间、一段距离和角度,对odometry的数据进行关键帧采样。absl::optional<MotionFilter>pose_graph_odometry_motion_filter;if(trajectory_options.has_pose_graph_odometry_motion_filter()){LOG(INFO)<<"Usingamotionfilterforaddingodom......
  • cartographer-glass:2D Graph SLAM框架在玻璃环境使用LiDAR
    摘要——本算法用于检测和包含玻璃物体基于优化的SLAM算法。当激光作为主要的外部感知传感器时,玻璃物体不能正确被探测到。当入射光主要穿过玻璃物体或反射离开光源时,会发......
  • cartographer环境最新配置(2021.11.11)
    0.前言最近群里有些老哥在问cartographer配置的相关问题,将我以前自己记录的文件测试后发现竟然已经失效,其原因在于cartographer官网对程序又进行了一次升级,以前的部分操作......
  • cartographer 纯定位---pure_localization
    0.简介最近群里有些老哥在问cartographer纯定位相关问题,网上已有的方法均已失效,这里作者研究了下cartographer相关的流程以及源码,给出了一种简单的解决策略。1.旧版cartog......
  • cartographer 使用自己的雷达
    文件修改demo_revo_lds.launch<!--Copyright2016TheCartographerAuthorsLicensedundertheApacheLicense,Version2.0(the"License");youmaynotu......
  • cartographer编译
    1.拷贝catkin_ws,ceres-solver.tar.gz,protobuf.tar.gz到home目录下2.解压ceres-solver.tar.gz到catkin_ws/src目录下,解压protobuf.tar.到home目录下3.sudoapt-getupd......
  • cartographer 源码解析(六)
    这一章节呢,主要讲外推器。我们上一章节说到激光的畸变与矫正,最关键的是什么呢?其实最关键的就是关于每个发射点的发射位置的估计推测,这里就用到了外推器去推测每个发射点的位......