00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035 #ifndef PCL_VECTOR_AVERAGE_H
00036 #define PCL_VECTOR_AVERAGE_H
00037
00038 #include <Eigen/Core>
00039 #include <pcl/common/eigen.h>
00040
00041 namespace pcl
00042 {
00050 template <typename real, int dimension>
00051 class VectorAverage
00052 {
00053 public:
00054
00056 VectorAverage ();
00058 ~VectorAverage () {}
00059
00060
00062 inline void
00063 reset ();
00064
00066 inline const
00067 Eigen::Matrix<real, dimension, 1>& getMean () const { return mean_;}
00068
00070 inline const
00071 Eigen::Matrix<real, dimension, dimension>& getCovariance () const { return covariance_;}
00072
00074 inline real
00075 getAccumulatedWeight () const { return accumulatedWeight_;}
00076
00078 inline unsigned int
00079 getNoOfSamples () { return noOfSamples_;}
00080
00082 inline void
00083 add (const Eigen::Matrix<real, dimension, 1>& sample, real weight=1.0);
00084
00086 inline void
00087 doPCA (Eigen::Matrix<real, dimension, 1>& eigen_values, Eigen::Matrix<real, dimension, 1>& eigen_vector1,
00088 Eigen::Matrix<real, dimension, 1>& eigen_vector2, Eigen::Matrix<real, dimension, 1>& eigen_vector3) const;
00089
00091 inline void
00092 doPCA (Eigen::Matrix<real, dimension, 1>& eigen_values) const;
00093
00095 inline void
00096 getEigenVector1 (Eigen::Matrix<real, dimension, 1>& eigen_vector1) const;
00097
00098
00099
00100 protected:
00101
00102
00103 unsigned int noOfSamples_;
00104 real accumulatedWeight_;
00105 Eigen::Matrix<real, dimension, 1> mean_;
00106 Eigen::Matrix<real, dimension, dimension> covariance_;
00107 };
00108
00109 typedef VectorAverage<float, 2> VectorAverage2f;
00110 typedef VectorAverage<float, 3> VectorAverage3f;
00111 typedef VectorAverage<float, 4> VectorAverage4f;
00112 }
00113
00114 #include "pcl/common/vector_average.hpp"
00115
00116 #endif // #ifndef PCL_VECTOR_AVERAGE_H
00117