Cartographer 源码解析1.2 —— 代码结构

最新推荐文章于 2024-09-17 12:53:15 发布

梦凝小筑

最新推荐文章于 2024-09-17 12:53:15 发布

阅读量3.3k

点赞数 6

分类专栏： slam学习文章标签： Cartographer 源码解析

本文链接：https://blog.csdn.net/weixin_36976685/article/details/89225050

版权

slam学习专栏收录该内容

10 篇文章 45 订阅

订阅专栏

*转载请注明出处 @梦凝小筑

1.2 Cartographer 源码软件结构

Cartographer 的源码中，主要有两大部分：

1，Cartographer 算法核心代码，在Cartographer文件夹中，

2，Cartographer 在 ros 平台的接口，在Cartographer_ros文件夹中

* 还有一个ceres-solver google 的开源优化库，用来求解各种优化问题，这里不介绍。

软件结构如图所示：

解析：

（1）Cartographer_ros

作用：Cartographer 在 ros 平台的接口 , 启动rosj节点、读取来自传感器数据、处理并将数据上传给核心Cartographer核心算法部分、载入外部参数、初始化Extrapolator等

模块：Options、node、MapBuilderBridge、SensorBridge、TfBridge

Options：

主要代码文件：node_option.cc 、node_option.h 、trajectory_options.cc 、trajectory_options.h

功能：

  NodeOptions node_options;//!定义Cartographer最初级选项
  TrajectoryOptions trajectory_options;//!定义建图的一些设置参数

  //!LoadOptions从外部载入参数，并赋值给 node_options和 trajectory_options
  //!输入参数 有launch文件中导入，分别是参数文件的路径和文件名
  std::tie(node_options, trajectory_options) =
      LoadOptions(FLAGS_configuration_directory, FLAGS_configuration_basename);

node:

主要代码文件：node.cc 、node.h

功能：

Node::LoadState cartographer参数载入的入口

  //!调用MapBuilderBridge.LoadState
  map_builder_bridge_.LoadState(state_filename, load_frozen_state);

Node::StartTrajectoryWithDefaultTopics 建图前的设置

  CHECK(ValidateTrajectoryOptions(options));
  //!建图前的设置
  AddTrajectory(options, DefaultSensorTopics());

Node::AddTrajectory

int Node::AddTrajectory(const TrajectoryOptions& options,
                        const cartographer_ros_msgs::SensorTopics& topics) {
  const std::set<cartographer::mapping::TrajectoryBuilderInterface::SensorId>
      expected_sensor_ids = ComputeExpectedSensorIds(options, topics);//!预期id

  //!根据参数初始化MapBuilderBridge
  //!MapBuilderBridge map_builder_bridge_ GUARDED_BY(mutex_);
  const int trajectory_id =
      map_builder_bridge_.AddTrajectory(expected_sensor_ids, options);
  AddExtrapolator(trajectory_id, options);//!设置外推器的参数
  AddSensorSamplers(trajectory_id, options);
  LaunchSubscribers(options, topics, trajectory_id);//!消息订阅
  wall_timers_.push_back(node_handle_.createWallTimer( //! ros 计时器
      ::ros::WallDuration(kTopicMismatchCheckDelaySec),
      &Node::MaybeWarnAboutTopicMismatch, this, /*oneshot=*/true));
  for (const auto& sensor_id : expected_sensor_ids) {
    subscribed_topics_.insert(sensor_id.id);
  }
  return trajectory_id;
}

Node::ComputeExpectedSensorIds

Node::AddExtrapolator

Node::AddSensorSamplers

Node::LaunchSubscribers (*重要) 定义topic订阅器，订阅各个传感器信息

MapBuilderBridge：

----持续更新----