一、简介
在之前的博客中Ceres&PCL 加权四阶多项式曲线拟合,基于对每个点进行加权的思路,我们可以大致得到我们想要的曲线形状,但是这种方式其实误差很大,有时候并不能得到我们理想中的结果。
OK,虽然上面的方法的确有很多不足的地方,但是它的确可以为我们提供一个较为理想的初值,这个思路其实很像ICP算法。我们可以首先使用加权的方法,得到一个还不错的初始曲线,之后基于这个曲线去进一步优化即可。
二、实现代码
#define NOMAXMIN
//PCL
#
在之前的博客中Ceres&PCL 加权四阶多项式曲线拟合,基于对每个点进行加权的思路,我们可以大致得到我们想要的曲线形状,但是这种方式其实误差很大,有时候并不能得到我们理想中的结果。
OK,虽然上面的方法的确有很多不足的地方,但是它的确可以为我们提供一个较为理想的初值,这个思路其实很像ICP算法。我们可以首先使用加权的方法,得到一个还不错的初始曲线,之后基于这个曲线去进一步优化即可。
#define NOMAXMIN
//PCL
#