ethzasl-msf - Modular Sensor Fusion
Time delay compensated single and multi sensor fusion framework based on an EKF
 All Classes Namespaces Files Functions Variables Typedefs Enumerations Enumerator Friends Macros Pages
List of all members | Public Member Functions | Private Attributes
msf_core::similarity_transform::From6DoF Class Reference

Computes the average similarity transform (rotation, position, scale) between two sets of 6 DoF poses.

#include <similaritytransform.h>

Public Member Functions

 From6DoF ()
void addMeasurement (const PosePair &measurement)
 Adds a pair of measurements. No other computation is performed.
void addMeasurement (const Pose &pose1, const Pose &pose2)
 Adds a pair of measurements. No other computation is performed.
bool compute (Pose &pose, double *scale=nullptr, double *cond=nullptr, double eps=std::numeric_limits< double >::epsilon()*4 *4)
 computes the average similarity transform the transform is computed between the previously added sets of poses.

Private Attributes

PosePairVector measurements_

Constructor & Destructor Documentation

msf_core::similarity_transform::From6DoF::From6DoF ( )

Member Function Documentation

void msf_core::similarity_transform::From6DoF::addMeasurement ( const PosePair measurement)
void msf_core::similarity_transform::From6DoF::addMeasurement ( const Pose pose1,
const Pose pose2 
)
bool msf_core::similarity_transform::From6DoF::compute ( Pose pose,
double *  scale = nullptr,
double *  cond = nullptr,
double  eps = std::numeric_limits<double>::epsilon() * 4 * 4 
)
Parameters
[out]poseresulting position / orientation
[out]scaleresulting scale: pos1 = pos2*scale
[out]condcondition number of the problem to detect (non) sufficient number of measurements
[in]epsin case of badly posed problems, eps can be set for the Moore-Penrose pseudo inverse

Member Data Documentation

PosePairVector msf_core::similarity_transform::From6DoF::measurements_
private

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