g2o中的核函数
作用限制误差较大的edge对最终优化结果的影响。
RobustKernelHuber函数
g2o中的class名称:
class RobustKernelHuber : public RobustKernel
公式:
{
r
h
o
(
e
)
=
e
2
,
e
≤
△
e
r
h
o
(
e
)
=
△
e
(
2
e
−
△
e
)
,
e
>
△
e
\begin{cases} & rho(e) = e^{2}\text ,e\le \triangle e \\ & rho(e)=\triangle e(2e-\triangle e) \text ,e> \triangle e \end{cases}
{rho(e)=e2,e≤△erho(e)=△e(2e−△e),e>△e
使用:
g2o::RobustKernelHuber *rk = new g2o::RobustKernelHuber;//定义核函数
rk->setDelta(thHuberMono);//设置核函数Delta e
e->setRobustKernel(rk);//将核函数添加到g2o的edge
本文内容由网友自发贡献,版权归原作者所有,本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容,请联系:hwhale#tublm.com(使用前将#替换为@)