摘要: ICP算法主要用于点云精配准,精度很高,但是相应的缺点就是迭代过程中容易陷入局部极值。具体的ICP算法推导过程很多书上都有,就不再详述了,此次仿真用的是SVD分解的方法。 直接贴代码: rotate.m 仿真结果(配准前和配准后): 旋转矩阵(真值和配准结果) 误差:err=0.00019434 注 阅读全文
posted @ 2018-11-25 21:59 JusticeZQ 阅读(9931) 评论(24) 推荐(5) 编辑