g2o
Loading...
Searching...
No Matches
Public Member Functions | List of all members
g2o::RobustKernelWelsch Class Reference

Welsch cost function. More...

#include <robust_kernel_impl.h>

Inheritance diagram for g2o::RobustKernelWelsch:
Inheritance graph
[legend]
Collaboration diagram for g2o::RobustKernelWelsch:
Collaboration graph
[legend]

Public Member Functions

virtual void robustify (double e2, Vector3 &rho) const
 
- Public Member Functions inherited from g2o::RobustKernel
 RobustKernel ()
 
 RobustKernel (double delta)
 
virtual ~RobustKernel ()
 
virtual void setDelta (double delta)
 
double delta () const
 

Additional Inherited Members

- Protected Attributes inherited from g2o::RobustKernel
double _delta
 

Detailed Description

Welsch cost function.

See http://research.microsoft.com/en-us/um/people/zhang/Papers/ZhangIVC-97-01.pdf

d^2 [1 - exp(- e2/d^2)]

Definition at line 136 of file robust_kernel_impl.h.

Member Function Documentation

◆ robustify()

void g2o::RobustKernelWelsch::robustify ( double  squaredError,
Vector3 rho 
) const
virtual

compute the scaling factor for a error: The error is e^T Omega e The output rho is rho[0]: The actual scaled error value rho[1]: First derivative of the scaling function rho[2]: Second derivative of the scaling function

Implements g2o::RobustKernel.

Definition at line 102 of file robust_kernel_impl.cpp.

102 {
103 const double dsqr = _delta * _delta;
104 const double aux = e2 / dsqr;
105 const double aux2 = exp(-aux);
106 rho[0] = dsqr * (1. - aux2);
107 rho[1] = aux2;
108 rho[2] = -aux2 / dsqr;
109}
Jet< T, N > exp(const Jet< T, N > &f)
Definition jet.h:437

References g2o::RobustKernel::_delta.


The documentation for this class was generated from the following files: