Inherits opentl::core::util::ParameterContainer.
Classes | |
struct | GaussNewtonData_Key_dof |
struct | GaussNewtonData_Key_dof_and_featSize |
structure for caching individual GN-terms (single features). key = pose dof (left 16bits) AND feature size (right 16bits) More... | |
Public Types | |
Public Member Functions | |
GaussNewton () | |
Constructor. | |
double | gaussNewtonUpdate (const std::vector< core::cvdata::T_MEAS_FEAT * > &measurements, opentl::core::cvdata::Pose &currPose, opentl::math::Vector *priorGrad=NULL, opentl::math::SquareMatrix *priorHess=NULL, opentl::math::SquareMatrix *estCov=NULL) |
Perform Gauss-Newton parameter update (used in order to upgrade from feature to object level) for all targets. | |
void | init () |
Initialization. | |
~GaussNewton () |
typedef struct opentl::core::util::GaussNewton::GaussNewtonData_Key_dof opentl::core::util::GaussNewton::T_GAUSSNEWTON_DATA_KEY_DOF |
typedef struct opentl::core::util::GaussNewton::GaussNewtonData_Key_dof_and_featSize opentl::core::util::GaussNewton::T_GAUSSNEWTON_DATA_KEY_DOF_AND_FEATSIZE |
structure for caching individual GN-terms (single features). key = pose dof (left 16bits) AND feature size (right 16bits)
opentl::core::util::GaussNewton::GaussNewton | ( | ) |
Constructor.
opentl::core::util::GaussNewton::~GaussNewton | ( | ) |
double opentl::core::util::GaussNewton::gaussNewtonUpdate | ( | const std::vector< core::cvdata::T_MEAS_FEAT * > & | measurements, | |
opentl::core::cvdata::Pose & | currPose, | |||
opentl::math::Vector * | priorGrad = NULL , |
|||
opentl::math::SquareMatrix * | priorHess = NULL , |
|||
opentl::math::SquareMatrix * | estCov = NULL | |||
) |
Perform Gauss-Newton parameter update (used in order to upgrade from feature to object level) for all targets.
measurements | Input vector of multi-modal measurements and Jacobians (feature-level) related to a single target | |
currPose | Input and output pose (updated with Gauss-Newton in the incremental parameters) | |
priorGrad | Input: gradient of the prior distribution | |
priorHess | Input: Hessian of the prior distribution | |
estCov | Output: covariance of the estimate (= invert Gauss-Newton matrix) |
void opentl::core::util::GaussNewton::init | ( | ) | [inline, virtual] |