Fix layer comparison in 3d

[hubacji1/rrts.git] / src / rrtext8.cc

diff --git a/src/rrtext8.cc b/src/rrtext8.cc
index a4d468bd93d628f34f035af8b729590c2daabf5f..fdeb5d391116c03fa4052467997303b9f73e126b 100644 (file)
--- a/src/rrtext8.cc
+++ b/src/rrtext8.cc
@@ -28,7 +28,7 @@ void RRTExt8::store_node(RRTNode *n, KdNode *&r, int l)
                 store_node(n, r->left(), l + 1);
         else if (l % 3 == 1)
                 store_node(n, r->right(), l + 1);
-        else if (l % 3 == 0 && n->h() < r->node()->h())
+        else if (l % 3 == 2 && n->h() < r->node()->h())
                 store_node(n, r->left(), l + 1);
         else
                 store_node(n, r->right(), l + 1);