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

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

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：

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