Timing. More...
#include <3d_ndt_mcl.hpp>
Public Member Functions | |
Eigen::Affine3d | getMean () |
Eigen::Vector3d | getMeanVector () |
void | initializeFilter (double x, double y, double z, double roll, double pitch, double yaw, double x_e, double y_e, double z_e, double roll_e, double pitch_e, double yaw_e, unsigned int numParticles) |
NDTMCL3D (double map_resolution, lslgeneric::NDTMap< PointT > &nd_map, double zfilter) | |
void | updateAndPredict (Eigen::Affine3d Tmotion, pcl::PointCloud< PointT > &cloud) |
void | updateAndPredictEff (Eigen::Affine3d Tmotion, pcl::PointCloud< PointT > &cloud) |
Public Attributes | |
int | counter |
bool | forceSIR |
lslgeneric::NDTMap< PointT > | map |
This is my map. | |
ParticleFilter3D | pf |
This is the particle filter. | |
double | resolution |
double | resolution_sensor |
double | zfilt_min |
Private Attributes | |
bool | isInit |
int | sinceSIR |
Timing.
NDT MCL - Class implementation
Definition at line 21 of file 3d_ndt_mcl.hpp.
NDTMCL3D< PointT >::NDTMCL3D | ( | double | map_resolution, |
lslgeneric::NDTMap< PointT > & | nd_map, | ||
double | zfilter | ||
) | [inline] |
Constructor
First, lets make our target map match the given map This is done because we want (possibly) lower resolution target map
Definition at line 33 of file 3d_ndt_mcl.hpp.
Definition at line 316 of file 3d_ndt_mcl.hpp.
Eigen::Vector3d NDTMCL3D< PointT >::getMeanVector | ( | ) | [inline] |
Definition at line 310 of file 3d_ndt_mcl.hpp.
void NDTMCL3D< PointT >::initializeFilter | ( | double | x, |
double | y, | ||
double | z, | ||
double | roll, | ||
double | pitch, | ||
double | yaw, | ||
double | x_e, | ||
double | y_e, | ||
double | z_e, | ||
double | roll_e, | ||
double | pitch_e, | ||
double | yaw_e, | ||
unsigned int | numParticles | ||
) | [inline] |
Intialize filter to some pose and with some number of particles
Definition at line 82 of file 3d_ndt_mcl.hpp.
void NDTMCL3D< PointT >::updateAndPredict | ( | Eigen::Affine3d | Tmotion, |
pcl::PointCloud< PointT > & | cloud | ||
) | [inline] |
Definition at line 95 of file 3d_ndt_mcl.hpp.
void NDTMCL3D< PointT >::updateAndPredictEff | ( | Eigen::Affine3d | Tmotion, |
pcl::PointCloud< PointT > & | cloud | ||
) | [inline] |
#pragma
Definition at line 195 of file 3d_ndt_mcl.hpp.
Definition at line 27 of file 3d_ndt_mcl.hpp.
Definition at line 29 of file 3d_ndt_mcl.hpp.
Definition at line 325 of file 3d_ndt_mcl.hpp.
lslgeneric::NDTMap<PointT> NDTMCL3D< PointT >::map |
This is my map.
Definition at line 23 of file 3d_ndt_mcl.hpp.
ParticleFilter3D NDTMCL3D< PointT >::pf |
This is the particle filter.
Definition at line 24 of file 3d_ndt_mcl.hpp.
double NDTMCL3D< PointT >::resolution |
Definition at line 25 of file 3d_ndt_mcl.hpp.
double NDTMCL3D< PointT >::resolution_sensor |
Definition at line 26 of file 3d_ndt_mcl.hpp.
Definition at line 326 of file 3d_ndt_mcl.hpp.
Definition at line 28 of file 3d_ndt_mcl.hpp.