Lidar_imu自动标定源码阅读（六）——run部分

有了个相册

已于 2022-08-30 10:18:09 修改

阅读量512

点赞数

分类专栏： slam 文章标签： c++ 开发语言

于 2022-08-17 11:27:10 首次发布

本文链接：https://blog.csdn.net/m0_48748418/article/details/126382308

版权

slam 专栏收录该内容

21 篇文章

订阅专栏

本文详细解读了如何通过run_lidar2imu.cpp源码进行Lidar与IMU传感器间外参标定，包括加载外参、转换坐标系及关键步骤。通过实例说明了标定过程和必备参数的使用。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

源码阅读，能力有限，如有某处理解错误，请指出，谢谢。

run_lidar2imu.cpp：输入文件所在路径，开始标定。

#include <Eigen/Core>
#include <pcl/common/transforms.h>
#include <pcl/conversions.h>
#include <pcl/io/pcd_io.h>
#include <pcl/point_cloud.h>

#include "calibration.hpp"
#include "extrinsic_param.hpp"
#include "registration.hpp"
#include <iostream>

#include "logging.hpp"
#include "transform_util.hpp"
using namespace std;

int main(int argc, char **argv) {
  if (argc != 4) {
    cout << "Usage: ./run_lidar2imu <lidar_pcds_dir> <poses_path> "
            "<extrinsic_json> "
            "\nexample:\n\t"
            "./bin/run_lidar2imu data/top_center_lidar/ "
            "data/NovAtel-pose-lidar-time.txt "
            "data/gnss-to-top_center_lidar-extrinsic.json "
         << endl;
    return 0;
  }
  string lidar_pcds_dir = argv[1];
  string poses_path = argv[2];
  string extrinsic_json = argv[3];
  string stitching_path = "stitching.pcd";
  // load extrinsic
  Eigen::Matrix4d json_param;
  LoadExtrinsic(extrinsic_json, json_param);
  LOGI("Load extrinsic!");
  // convert to lidar 2 imu
  Eigen::Matrix4d lidar2imu_extrinsic = json_param.inverse().eval();
  std::cout << json_param << std::endl;
  Eigen::Matrix4d transform = Eigen::Matrix4d::Identity();
  // Registrator registrator;
  // registrator.LoadOdometerData(poses_path, lidar2imu);
  // registrator.LoadLidarPCDs(lidar_pcds_dir);
  // registrator.RegistrationByGroundPlane(transform);
  // registrator.RegistrationByVoxelOccupancy(transform);
  // registrator.SaveStitching(stitching_path);
  // std::cout << "the calibration result is " << std::endl;
  // std::cout << transform << std::endl;
  Calibrator calibrator;
  calibrator.Calibration(lidar_pcds_dir, poses_path, lidar2imu_extrinsic);

  return 0;
}

lidar与imu之间的外参标定是非常重要的，也是一个基础的东西，只有知道了传感器之间的相对位姿，然后才能更好的完成数据间的融合。

Lidar_imu自动标定源码阅读完结。