#include <EndpointModel.h>
Public Member Functions | |
EndpointModel (ros::NodeHandle *nh, boost::shared_ptr< MapModel > mapModel, EngineT *rngEngine) | |
virtual void | integrateMeasurement (Particles &particles, const PointCloud &pc, const std::vector< float > &ranges, float max_range, const tf::Transform &baseToSensor) |
virtual void | setMap (boost::shared_ptr< octomap::OcTree > map) |
virtual | ~EndpointModel () |
Protected Member Functions | |
bool | getHeightError (const Particle &p, const tf::StampedTransform &footprintToBase, double &heightError) const |
void | initDistanceMap () |
Protected Attributes | |
boost::shared_ptr < DynamicEDTOctomap > | m_distanceMap |
double | m_maxObstacleDistance |
double | m_sigma |
Definition at line 42 of file EndpointModel.h.
humanoid_localization::EndpointModel::EndpointModel | ( | ros::NodeHandle * | nh, |
boost::shared_ptr< MapModel > | mapModel, | ||
EngineT * | rngEngine | ||
) |
Definition at line 28 of file EndpointModel.cpp.
humanoid_localization::EndpointModel::~EndpointModel | ( | ) | [virtual] |
Definition at line 45 of file EndpointModel.cpp.
bool humanoid_localization::EndpointModel::getHeightError | ( | const Particle & | p, |
const tf::StampedTransform & | footprintToBase, | ||
double & | heightError | ||
) | const [protected, virtual] |
Implements humanoid_localization::ObservationModel.
Definition at line 80 of file EndpointModel.cpp.
void humanoid_localization::EndpointModel::initDistanceMap | ( | ) | [protected] |
Definition at line 107 of file EndpointModel.cpp.
void humanoid_localization::EndpointModel::integrateMeasurement | ( | Particles & | particles, |
const PointCloud & | pc, | ||
const std::vector< float > & | ranges, | ||
float | max_range, | ||
const tf::Transform & | baseToSensor | ||
) | [virtual] |
Integrate a measurement in particle set, update weights accordingly Particle weights should be in log scale before, weights are added.
Implements humanoid_localization::ObservationModel.
Definition at line 49 of file EndpointModel.cpp.
void humanoid_localization::EndpointModel::setMap | ( | boost::shared_ptr< octomap::OcTree > | map | ) | [virtual] |
Reimplemented from humanoid_localization::ObservationModel.
Definition at line 102 of file EndpointModel.cpp.
boost::shared_ptr<DynamicEDTOctomap> humanoid_localization::EndpointModel::m_distanceMap [protected] |
Definition at line 55 of file EndpointModel.h.
double humanoid_localization::EndpointModel::m_maxObstacleDistance [protected] |
Definition at line 54 of file EndpointModel.h.
double humanoid_localization::EndpointModel::m_sigma [protected] |
Definition at line 53 of file EndpointModel.h.