以全站仪为真值数据,SLAM为需要评估的轨迹,用最小二乘算法,对二者进行轨迹匹配。 本代码用于平面坐标系的二维旋转,场景:室内定位过程中,使用LEGO-LOAM算法得到小车的平面位置后,需要将小车的位置转换到真值坐标系下。
1