#include <octree_pa_ros.h>

Public Types | |
| typedef cOctreeBasePaRos< OcTree > | TreeTypeBase |
Public Types inherited from cOctreeBasePaRos< octomap::OcTree > | |
| typedef ::octomap::OcTreeKey | OctKey |
| typedef pcl::PointCloud< pcl::PointXYZ > | PclPointCloud |
| typedef pcl::PointCloud< pcl::PointXYZ >::ConstPtr | PclPointCloudConstPtr |
| typedef pcl::PointCloud< pcl::PointXYZ >::Ptr | PclPointCloudPtr |
| typedef octomap::OcTree | TreeTypeBase |
| typedef cOctreeBasePaRos< octomap::OcTree > | TreeTypeFull |
Public Types inherited from OcTreeBaseImpl< OcTreeNode, AbstractOccupancyOcTree > | |
| typedef leaf_iterator | iterator |
| typedef OcTreeNode | NodeType |
Public Member Functions | |
| cOctreePaRos (const double resolution) | |
| default constructor More... | |
| virtual | ~cOctreePaRos () |
| default destructor More... | |
Public Member Functions inherited from cOctreeBasePaRos< octomap::OcTree > | |
| bool | addCloud (const sensor_msgs::PointCloud2ConstPtr &cloud, const cAddCloudParameter ¶ms, const tf::Transform transform=tf::Transform::getIdentity()) |
| bool | addCloud (const sensor_msgs::PointCloudConstPtr &cloud, const cAddCloudParameter ¶ms, const tf::Transform transform=tf::Transform::getIdentity()) |
| bool | addCloud (const sensor_msgs::LaserScanConstPtr &cloud, const cAddCloudParameter ¶ms, const tf::Transform transform=tf::Transform::getIdentity()) |
| virtual void | clear (void) |
| clear local timestamps with octomap More... | |
| cOctreeBasePaRos (double resolution) | |
| default constructor More... | |
| bool | getChildKey (const OctKey ¤t, const int current_level, OctKey &child, const int child_pos) const |
| virtual ros::Time | getLastInsertionTime (void) const |
| octomap_msgs::OctomapPtr | getOctomap (void) const |
| function for getting the binary octomap More... | |
| octomap_msgs::OctomapPtr | getOctomapFull (void) const |
| function for getting the full octomap More... | |
| sensor_msgs::PointCloud2Ptr | getOctomapPcd (const int tree_depth=0, const bool expand=false) const |
| function for getting the pointcloud equivalent of the octomap More... | |
| sensor_msgs::PointCloud2Ptr | getOctomapPcdFree (const int tree_depth=0, const bool expand=false) const |
| similar to getOctomapPcd, but only returning just empty voxels More... | |
| ros::Time | getOutputTime (void) const |
| bool | getParentKey (const OctKey ¤t, const int current_level, OctKey &parent) const |
| geometry_msgs::PointPtr | keyToPoint (const OctKey &key) const |
| function for converting from key to point (geometry_msg) More... | |
| void | keyToPoint (const OctKey &key, double &x, double &y, double &z) const |
| function for converting from key to real coordinates More... | |
| OctKey | pointToKey (const geometry_msgs::Point &point) const |
| functions for converting from point (geometry_msg) to key More... | |
| bool | readFull (const std::string &filename) |
| trying to read the given file into the current OcTree More... | |
| virtual void | setLastInsertionTime (const ros::Time &time) |
| void | setOutputTime (const ros::Time &time) |
| bool | updateTime (const ros::Time &time) |
| virtual | ~cOctreeBasePaRos () |
| default destructor More... | |
Public Member Functions inherited from octomap::OcTree | |
| OcTree * | create () const |
| std::string | getTreeType () const |
| OcTree (std::string _filename) | |
| OcTree (double resolution) | |
| virtual | ~OcTree () |
Public Member Functions inherited from OccupancyOcTreeBase< OcTreeNode > | |
| bool | bbxSet () const |
| virtual bool | castRay (const point3d &origin, const point3d &direction, point3d &end, bool ignoreUnknownCells=false, double maxRange=-1.0) const |
| KeyBoolMap::const_iterator | changedKeysBegin () const |
| KeyBoolMap::const_iterator | changedKeysEnd () const |
| void | computeDiscreteUpdate (const Pointcloud &scan, const octomap::point3d &origin, KeySet &free_cells, KeySet &occupied_cells, double maxrange) |
| void | computeUpdate (const Pointcloud &scan, const octomap::point3d &origin, KeySet &free_cells, KeySet &occupied_cells, double maxrange) |
| void | enableChangeDetection (bool enable) |
| point3d | getBBXBounds () const |
| point3d | getBBXCenter () const |
| point3d | getBBXMax () const |
| point3d | getBBXMin () const |
| bool | getNormals (const point3d &point, std::vector< point3d > &normals, bool unknownStatus=true) const |
| virtual bool | getRayIntersection (const point3d &origin, const point3d &direction, const point3d ¢er, point3d &intersection, double delta=0.0) const |
| bool | inBBX (const point3d &p) const |
| bool | inBBX (const OcTreeKey &key) const |
| virtual void | insertPointCloud (const Pointcloud &scan, const octomap::point3d &sensor_origin, double maxrange=-1., bool lazy_eval=false, bool discretize=false) |
| virtual void | insertPointCloud (const Pointcloud &scan, const point3d &sensor_origin, const pose6d &frame_origin, double maxrange=-1., bool lazy_eval=false, bool discretize=false) |
| virtual void | insertPointCloud (const ScanNode &scan, double maxrange=-1., bool lazy_eval=false, bool discretize=false) |
| virtual void | insertPointCloudRays (const Pointcloud &scan, const point3d &sensor_origin, double maxrange=-1., bool lazy_eval=false) |
| virtual bool | insertRay (const point3d &origin, const point3d &end, double maxrange=-1.0, bool lazy_eval=false) |
| virtual void | integrateHit (OcTreeNode *occupancyNode) const |
| virtual void | integrateMiss (OcTreeNode *occupancyNode) const |
| bool | isChangeDetectionEnabled () const |
| virtual void | nodeToMaxLikelihood (OcTreeNode *occupancyNode) const |
| virtual void | nodeToMaxLikelihood (OcTreeNode &occupancyNode) const |
| size_t | numChangesDetected () const |
| OccupancyOcTreeBase (double resolution) | |
| OccupancyOcTreeBase (const OccupancyOcTreeBase< OcTreeNode > &rhs) | |
| std::istream & | readBinaryData (std::istream &s) |
| std::istream & | readBinaryNode (std::istream &s, OcTreeNode *node) |
| void | resetChangeDetection () |
| void | setBBXMax (point3d &max) |
| void | setBBXMin (point3d &min) |
| virtual OcTreeNode * | setNodeValue (const point3d &value, float log_odds_value, bool lazy_eval=false) |
| virtual OcTreeNode * | setNodeValue (const OcTreeKey &key, float log_odds_value, bool lazy_eval=false) |
| virtual OcTreeNode * | setNodeValue (double x, double y, double z, float log_odds_value, bool lazy_eval=false) |
| virtual void | toMaxLikelihood () |
| void | updateInnerOccupancy () |
| virtual OcTreeNode * | updateNode (double x, double y, double z, bool occupied, bool lazy_eval=false) |
| virtual OcTreeNode * | updateNode (const point3d &value, bool occupied, bool lazy_eval=false) |
| virtual OcTreeNode * | updateNode (const point3d &value, float log_odds_update, bool lazy_eval=false) |
| virtual OcTreeNode * | updateNode (double x, double y, double z, float log_odds_update, bool lazy_eval=false) |
| virtual OcTreeNode * | updateNode (const OcTreeKey &key, float log_odds_update, bool lazy_eval=false) |
| virtual OcTreeNode * | updateNode (const OcTreeKey &key, bool occupied, bool lazy_eval=false) |
| virtual void | updateNodeLogOdds (OcTreeNode *occupancyNode, const float &update) const |
| void | useBBXLimit (bool enable) |
| std::ostream & | writeBinaryData (std::ostream &s) const |
| std::ostream & | writeBinaryNode (std::ostream &s, const OcTreeNode *node) const |
| virtual | ~OccupancyOcTreeBase () |
Public Member Functions inherited from OcTreeBaseImpl< OcTreeNode, AbstractOccupancyOcTree > | |
| OcTreeKey | adjustKeyAtDepth (const OcTreeKey &key, unsigned int depth) const |
| key_type | adjustKeyAtDepth (key_type key, unsigned int depth) const |
| iterator | begin (unsigned char maxDepth=0) const |
| leaf_iterator | begin_leafs (unsigned char maxDepth=0) const |
| leaf_bbx_iterator | begin_leafs_bbx (const OcTreeKey &min, const OcTreeKey &max, unsigned char maxDepth=0) const |
| leaf_bbx_iterator | begin_leafs_bbx (const point3d &min, const point3d &max, unsigned char maxDepth=0) const |
| tree_iterator | begin_tree (unsigned char maxDepth=0) const |
| size_t | calcNumNodes () const |
| void | clearKeyRays () |
| bool | computeRay (const point3d &origin, const point3d &end, std::vector< point3d > &ray) |
| bool | computeRayKeys (const point3d &origin, const point3d &end, KeyRay &ray) const |
| OcTreeKey | coordToKey (double x, double y, double z) const |
| OcTreeKey | coordToKey (const point3d &coord, unsigned depth) const |
| OcTreeKey | coordToKey (double x, double y, double z, unsigned depth) const |
| key_type | coordToKey (double coordinate) const |
| key_type | coordToKey (double coordinate, unsigned depth) const |
| OcTreeKey | coordToKey (const point3d &coord) const |
| bool | coordToKeyChecked (const point3d &coord, OcTreeKey &key) const |
| bool | coordToKeyChecked (const point3d &coord, unsigned depth, OcTreeKey &key) const |
| bool | coordToKeyChecked (double x, double y, double z, OcTreeKey &key) const |
| bool | coordToKeyChecked (double x, double y, double z, unsigned depth, OcTreeKey &key) const |
| bool | coordToKeyChecked (double coordinate, key_type &key) const |
| bool | coordToKeyChecked (double coordinate, unsigned depth, key_type &key) const |
| OcTreeNode * | createNodeChild (OcTreeNode *node, unsigned int childIdx) |
| bool | deleteNode (double x, double y, double z, unsigned int depth=0) |
| bool | deleteNode (const point3d &value, unsigned int depth=0) |
| bool | deleteNode (const OcTreeKey &key, unsigned int depth=0) |
| void | deleteNodeChild (OcTreeNode *node, unsigned int childIdx) |
| const iterator | end () const |
| const leaf_iterator | end_leafs () const |
| const leaf_bbx_iterator | end_leafs_bbx () const |
| const tree_iterator | end_tree () const |
| virtual void | expand () |
| virtual void | expandNode (OcTreeNode *node) |
| virtual void | getMetricMax (double &x, double &y, double &z) |
| void | getMetricMax (double &x, double &y, double &z) const |
| virtual void | getMetricMin (double &x, double &y, double &z) |
| void | getMetricMin (double &x, double &y, double &z) const |
| virtual void | getMetricSize (double &x, double &y, double &z) |
| virtual void | getMetricSize (double &x, double &y, double &z) const |
| const OcTreeNode * | getNodeChild (const OcTreeNode *node, unsigned int childIdx) const |
| OcTreeNode * | getNodeChild (OcTreeNode *node, unsigned int childIdx) const |
| double | getNodeSize (unsigned depth) const |
| size_t | getNumLeafNodes () const |
| double | getResolution () const |
| OcTreeNode * | getRoot () const |
| unsigned int | getTreeDepth () const |
| std::string | getTreeType () const |
| void | getUnknownLeafCenters (point3d_list &node_centers, point3d pmin, point3d pmax, unsigned int depth=0) const |
| virtual bool | isNodeCollapsible (const OcTreeNode *node) const |
| point3d | keyToCoord (const OcTreeKey &key) const |
| point3d | keyToCoord (const OcTreeKey &key, unsigned depth) const |
| double | keyToCoord (key_type key) const |
| double | keyToCoord (key_type key, unsigned depth) const |
| unsigned long long | memoryFullGrid () const |
| virtual size_t | memoryUsage () const |
| virtual size_t | memoryUsageNode () const |
| bool | nodeChildExists (const OcTreeNode *node, unsigned int childIdx) const |
| bool | nodeHasChildren (const OcTreeNode *node) const |
| OcTreeBaseImpl (const OcTreeBaseImpl< OcTreeNode, AbstractOccupancyOcTree > &rhs) | |
| OcTreeBaseImpl (double resolution) | |
| bool | operator== (const OcTreeBaseImpl< OcTreeNode, AbstractOccupancyOcTree > &rhs) const |
| virtual void | prune () |
| virtual bool | pruneNode (OcTreeNode *node) |
| std::istream & | readData (std::istream &s) |
| OcTreeNode * | search (const point3d &value, unsigned int depth=0) const |
| OcTreeNode * | search (const OcTreeKey &key, unsigned int depth=0) const |
| OcTreeNode * | search (double x, double y, double z, unsigned int depth=0) const |
| void | setResolution (double r) |
| virtual size_t | size () const |
| void | swapContent (OcTreeBaseImpl< OcTreeNode, AbstractOccupancyOcTree > &rhs) |
| double | volume () |
| std::ostream & | writeData (std::ostream &s) const |
| virtual | ~OcTreeBaseImpl () |
Public Member Functions inherited from octomap::AbstractOccupancyOcTree | |
| AbstractOccupancyOcTree () | |
| double | getClampingThresMax () const |
| float | getClampingThresMaxLog () const |
| double | getClampingThresMin () const |
| float | getClampingThresMinLog () const |
| double | getOccupancyThres () const |
| float | getOccupancyThresLog () const |
| double | getProbHit () const |
| float | getProbHitLog () const |
| double | getProbMiss () const |
| float | getProbMissLog () const |
| bool | isNodeAtThreshold (const OcTreeNode *occupancyNode) const |
| bool | isNodeAtThreshold (const OcTreeNode &occupancyNode) const |
| bool | isNodeOccupied (const OcTreeNode *occupancyNode) const |
| bool | isNodeOccupied (const OcTreeNode &occupancyNode) const |
| bool | readBinary (std::istream &s) |
| bool | readBinary (const std::string &filename) |
| void | setClampingThresMax (double thresProb) |
| void | setClampingThresMin (double thresProb) |
| void | setOccupancyThres (double prob) |
| void | setProbHit (double prob) |
| void | setProbMiss (double prob) |
| virtual OcTreeNode * | updateNode (const OcTreeKey &key, float log_odds_update, bool lazy_eval=false)=0 |
| virtual OcTreeNode * | updateNode (const OcTreeKey &key, bool occupied, bool lazy_eval=false)=0 |
| bool | writeBinary (const std::string &filename) |
| bool | writeBinary (std::ostream &s) |
| bool | writeBinaryConst (std::ostream &s) const |
| bool | writeBinaryConst (const std::string &filename) const |
| virtual | ~AbstractOccupancyOcTree () |
Public Member Functions inherited from octomap::AbstractOcTree | |
| AbstractOcTree () | |
| bool | write (std::ostream &s) const |
| bool | write (const std::string &filename) const |
| virtual | ~AbstractOcTree () |
Additional Inherited Members | |
Static Public Member Functions inherited from octomap::AbstractOcTree | |
| static AbstractOcTree * | createTree (const std::string id, double res) |
| static AbstractOcTree * | read (std::istream &s) |
| static AbstractOcTree * | read (const std::string &filename) |
Public Attributes inherited from cOctreeBasePaRos< octomap::OcTree > | |
| cOctreeBasePaRosParameter | rosparams_base_ |
| parameters More... | |
Protected Member Functions inherited from cOctreeBasePaRos< octomap::OcTree > | |
| bool | addCloud (const PclPointCloudPtr &cloud, const cAddCloudParameter ¶ms, const tf::Transform &transform) |
| void | getChildKeySimple (const OctKey ¤t, const int current_level, OctKey &child, const int child_pos) const |
| helper function for getChildKey More... | |
| void | getOctomapPcdSub (const OctKey &key, const int current_level, const int min_level, PclPointCloud &cloud) const |
| helper function for getOctomapPcd... More... | |
| void | getParentKeySimple (const OctKey ¤t, const int current_level, OctKey &parent) const |
| helper function for getParentKey More... | |
Protected Member Functions inherited from OccupancyOcTreeBase< OcTreeNode > | |
| bool | integrateMissOnRay (const point3d &origin, const point3d &end, bool lazy_eval=false) |
| OccupancyOcTreeBase (double resolution, unsigned int tree_depth, unsigned int tree_max_val) | |
| OcTreeNode * | setNodeValueRecurs (OcTreeNode *node, bool node_just_created, const OcTreeKey &key, unsigned int depth, const float &log_odds_value, bool lazy_eval=false) |
| void | toMaxLikelihoodRecurs (OcTreeNode *node, unsigned int depth, unsigned int max_depth) |
| void | updateInnerOccupancyRecurs (OcTreeNode *node, unsigned int depth) |
| OcTreeNode * | updateNodeRecurs (OcTreeNode *node, bool node_just_created, const OcTreeKey &key, unsigned int depth, const float &log_odds_update, bool lazy_eval=false) |
Protected Member Functions inherited from OcTreeBaseImpl< OcTreeNode, AbstractOccupancyOcTree > | |
| void | allocNodeChildren (OcTreeNode *node) |
| void | calcMinMax () |
| void | calcNumNodesRecurs (OcTreeNode *node, size_t &num_nodes) const |
| void | deleteNodeRecurs (OcTreeNode *node) |
| bool | deleteNodeRecurs (OcTreeNode *node, unsigned int depth, unsigned int max_depth, const OcTreeKey &key) |
| void | expandRecurs (OcTreeNode *node, unsigned int depth, unsigned int max_depth) |
| size_t | getNumLeafNodesRecurs (const OcTreeNode *parent) const |
| void | init () |
| OcTreeBaseImpl (double resolution, unsigned int tree_depth, unsigned int tree_max_val) | |
| void | pruneRecurs (OcTreeNode *node, unsigned int depth, unsigned int max_depth, unsigned int &num_pruned) |
| std::istream & | readNodesRecurs (OcTreeNode *, std::istream &s) |
| std::ostream & | writeNodesRecurs (const OcTreeNode *, std::ostream &s) const |
Protected Member Functions inherited from octomap::AbstractOccupancyOcTree | |
| bool | readBinaryLegacyHeader (std::istream &s, unsigned int &size, double &res) |
Static Protected Member Functions inherited from octomap::AbstractOcTree | |
| static bool | readHeader (std::istream &s, std::string &id, unsigned &size, double &res) |
| static void | registerTreeType (AbstractOcTree *tree) |
Protected Attributes inherited from cOctreeBasePaRos< octomap::OcTree > | |
| ros::Time | current_output_time_ |
| internal variable for storing current output time More... | |
| ros::Time | last_insertion_time_ |
| internal variable for storing last insertion time More... | |
Protected Attributes inherited from OccupancyOcTreeBase< OcTreeNode > | |
| point3d | bbx_max |
| OcTreeKey | bbx_max_key |
| point3d | bbx_min |
| OcTreeKey | bbx_min_key |
| KeyBoolMap | changed_keys |
| bool | use_bbx_limit |
| bool | use_change_detection |
Protected Attributes inherited from OcTreeBaseImpl< OcTreeNode, AbstractOccupancyOcTree > | |
| std::vector< KeyRay > | keyrays |
| const leaf_bbx_iterator | leaf_iterator_bbx_end |
| const leaf_iterator | leaf_iterator_end |
| double | max_value [3] |
| double | min_value [3] |
| double | resolution |
| double | resolution_factor |
| OcTreeNode * | root |
| bool | size_changed |
| std::vector< double > | sizeLookupTable |
| point3d | tree_center |
| const unsigned int | tree_depth |
| const tree_iterator | tree_iterator_end |
| const unsigned int | tree_max_val |
| size_t | tree_size |
Protected Attributes inherited from octomap::AbstractOccupancyOcTree | |
| float | clamping_thres_max |
| float | clamping_thres_min |
| float | occ_prob_thres_log |
| float | prob_hit_log |
| float | prob_miss_log |
Static Protected Attributes inherited from octomap::OcTree | |
| static StaticMemberInitializer | ocTreeMemberInit |
Static Protected Attributes inherited from octomap::AbstractOccupancyOcTree | |
| static const std::string | binaryFileHeader |
Static Protected Attributes inherited from octomap::AbstractOcTree | |
| static const std::string | fileHeader |
Definition at line 60 of file octree_pa_ros.h.
Definition at line 63 of file octree_pa_ros.h.
| cOctreePaRos::cOctreePaRos | ( | const double | resolution | ) |
default constructor
Definition at line 55 of file octree_pa_ros.cpp.
|
virtual |
default destructor
Definition at line 61 of file octree_pa_ros.cpp.