关于LOAM中的 transformAssociateToMap（）函数

由于每次都会忘记所以写下来，如果不对，望大家指正。

就是如何通过雷达里程计的当前位姿以及雷达里程计的上一帧的位姿和经过map优化之后的上一帧的位姿，注意以上都是在世界坐标系下的位姿状态。

先介绍一下简单的位姿转换的知识：假设我们已知第 

 。

// transformSum为当前里程计信息
// transformBefMapped 上次里程计信息
// transformAftMapped 上次map中的位置
// transformTobeMapped 为里程计估计的当前时刻的位置
//根据我们上面提到的公式来计算

 假设有一个点  ，可以通过里程计的位姿信息来转到上一帧记为  。

// transformSum 这里的这个量为当前里程计的位姿信息，可能我这几个物理量的理解有点错误，但是数学知
//识应该是没有错误的。
// transformBefMapped 上次里程计信息
// transformAftMapped 上次map中的位置
// transformTobeMapped 待优化量
//Pi = transformBefMapped.inv() * transformSum * Pj;
//也可以由优化之后的位姿变量来得到
//Pi = transformAftMapped.inv() * transformTobeMapped * Pj;
//那么就有
//transformAftMapped.inv() * transformTobeMapped = transformBefMapped.inv()*transformSum；
//transformTobeMapped=transformAftMapped*transformBefMapped.inv()*transformSum；