mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-03 16:27:46 +08:00
debug info...
This commit is contained in:
@@ -151,6 +151,7 @@ public:
|
|||||||
buildIndex();
|
buildIndex();
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
|
UDEBUG("Add to trees (%d)", trees_);
|
||||||
for (size_t i=old_size;i<size_;++i) {
|
for (size_t i=old_size;i<size_;++i) {
|
||||||
for (int j = 0; j < trees_; j++) {
|
for (int j = 0; j < trees_; j++) {
|
||||||
addPointToTree(tree_roots_[j], i);
|
addPointToTree(tree_roots_[j], i);
|
||||||
@@ -665,7 +666,6 @@ private:
|
|||||||
|
|
||||||
void addPointToTree(NodePtr node, int ind)
|
void addPointToTree(NodePtr node, int ind)
|
||||||
{
|
{
|
||||||
UDEBUG("ind=%d", ind);
|
|
||||||
ElementType* point = points_[ind];
|
ElementType* point = points_[ind];
|
||||||
|
|
||||||
if ((node->child1==NULL) && (node->child2==NULL)) {
|
if ((node->child1==NULL) && (node->child2==NULL)) {
|
||||||
|
|||||||
Reference in New Issue
Block a user