LOAM中消除IMU重力影响解析

最新推荐文章于 2024-10-23 22:03:05 发布

ABC_Orange

最新推荐文章于 2024-10-23 22:03:05 发布

阅读量979

点赞数 2

分类专栏：算法公式

原文链接：https://blog.csdn.net/weixin_44492854/article/details/109249662

版权

算法公式专栏收录该内容

9 篇文章

订阅专栏

文章转载自： https://blog.csdn.net/weixin_44492854/article/details/109249662

代码介绍

在LOAM的处理中，IMU数据甫一进入系统第一步是对重力分量的去除。LOAM中对重力影响的去除有以下公式：

float accX = vec_imuData[pointer].accy - sin(imuRoll[pointer]) * cos(imuPitch[pointer]) * 9.81;
float accY = vec_imuData[pointer].accz - cos(imuRoll[pointer]) * cos(imuPitch[pointer]) * 9.81;
float accZ = vec_imuData[pointer].accx + sin(imuPitch[pointer]) * 9.81;

以上公式处理对初始IMU的数据进行了以下两个操作：

    1. 去除了重力的影响；
    2. 变换了坐标表示。

坐标系的定义：

  ROS坐标系： x轴向前，y轴向左，z轴向上的右手坐标系
  欧拉角坐标系： z轴向前，X轴向左，y轴向上的右手坐标系
  imu坐标系： x轴向前，y轴向左，z轴向上的右手坐标系
  velodyne lidar安装坐标系： x轴向前，y轴向左，z轴向上的右手坐标系
  scanRegistration会把两者通过交换坐标轴，都统一到z轴向前，x轴向左，y轴向上的欧拉角坐标系，这是J. Zhang的论文里面使用的坐标系

以下对两个方面逐个进行说明。