Computes weighted and un-weighted averages of SE(3) poses.
Add values to average with append(), when done call get_average(). Use clear() to reset the accumulator and start a new average computation. Theoretical base: See SO_average<3> for the rotation part. The translation is a simple arithmetic mean in Euclidean space.
Definition at line 113 of file SO_SE_average.h.
#include <mrpt/poses/SO_SE_average.h>
Public Member Functions | |
SE_average () | |
Constructor. More... | |
void | clear () |
Resets the accumulator. More... | |
void | append (const mrpt::poses::CPose3D &p) |
Adds a new pose to the computation. More... | |
void | append (const mrpt::poses::CPose3D &p, const double weight) |
Adds a new pose to the weighted-average computation. More... | |
void | get_average (mrpt::poses::CPose3D &out_mean) const |
Returns the average pose. More... | |
Public Attributes | |
bool | enable_exception_on_undeterminate |
(Default=false) Set to true if you want to raise an exception on undetermined average values. More... | |
Private Attributes | |
double | m_count |
double | m_accum_x |
double | m_accum_y |
double | m_accum_z |
SO_average< 3 > | m_rot_part |
mrpt::poses::SE_average< 3 >::SE_average | ( | ) |
Constructor.
void mrpt::poses::SE_average< 3 >::append | ( | const mrpt::poses::CPose3D & | p | ) |
Adds a new pose to the computation.
Referenced by mrpt::poses::CPose3DPDFParticles::getMean(), and mrpt::poses::CPose3DPDFSOG::getMean().
void mrpt::poses::SE_average< 3 >::append | ( | const mrpt::poses::CPose3D & | p, |
const double | weight | ||
) |
Adds a new pose to the weighted-average computation.
void mrpt::poses::SE_average< 3 >::clear | ( | ) |
Resets the accumulator.
void mrpt::poses::SE_average< 3 >::get_average | ( | mrpt::poses::CPose3D & | out_mean | ) | const |
Returns the average pose.
std::logic_error | If no data point were inserted. |
std::runtime_error | Upon undeterminate average value (ie the average lays exactly on the origin point) and enable_exception_on_undeterminate is set to true (otherwise, the 0 orientation would be returned) |
Referenced by mrpt::poses::CPose3DPDFParticles::getMean(), and mrpt::poses::CPose3DPDFSOG::getMean().
bool mrpt::poses::SE_average< 3 >::enable_exception_on_undeterminate |
(Default=false) Set to true if you want to raise an exception on undetermined average values.
Definition at line 125 of file SO_SE_average.h.
|
private |
Definition at line 128 of file SO_SE_average.h.
|
private |
Definition at line 128 of file SO_SE_average.h.
|
private |
Definition at line 128 of file SO_SE_average.h.
|
private |
Definition at line 127 of file SO_SE_average.h.
|
private |
Definition at line 129 of file SO_SE_average.h.
Page generated by Doxygen 1.8.14 for MRPT 1.5.7 Git: 5902e14cc Wed Apr 24 15:04:01 2019 +0200 at lun oct 28 01:39:17 CET 2019 |