Octomap <1.8.0 compatible but not working

CMakeLists.txt

@@ -82,6 +82,10 @@ if(NOT OCTOMAP_FOUND)
     endif()
 endif()
 if (OCTOMAP_FOUND OR (OCTOMAP_INCLUDE_DIRS AND OCTOMAP_LIBRARY_DIRS))
+  string(REPLACE "." ";" VERSION_LIST ${OCTOMAP_VERSION})
+  list(GET VERSION_LIST 0 OCTOMAP_MAJOR_VERSION)
+  list(GET VERSION_LIST 1 OCTOMAP_MINOR_VERSION)
+  list(GET VERSION_LIST 2 OCTOMAP_PATCH_VERSION)
   include_directories(${OCTOMAP_INCLUDE_DIRS})
   link_directories(${OCTOMAP_LIBRARY_DIRS})
   set(FCL_HAVE_OCTOMAP 1)

include/fcl/config.h.in

@@ -48,4 +48,20 @@
 #cmakedefine01 FCL_BUILD_TYPE_DEBUG
 #cmakedefine01 FCL_BUILD_TYPE_RELEASE
 
+#if FCL_HAVE_OCTOMAP
+  #define OCTOMAP_MAJOR_VERSION @OCTOMAP_MAJOR_VERSION@
+  #define OCTOMAP_MINOR_VERSION @OCTOMAP_MINOR_VERSION@
+  #define OCTOMAP_PATCH_VERSION @OCTOMAP_PATCH_VERSION@
+
+  #define OCTOMAP_VERSION_AT_LEAST(x,y,z) \
+    (OCTOMAP_MAJOR_VERSION > x || (OCTOMAP_MAJOR_VERSION >= x && \
+    (OCTOMAP_MINOR_VERSION > y || (OCTOMAP_MINOR_VERSION >= y && \
+    OCTOMAP_PATCH_VERSION >= z))))
+
+  #define OCTOMAP_VERSION_AT_MOST(x,y,z) \
+    (OCTOMAP_MAJOR_VERSION < x || (OCTOMAP_MAJOR_VERSION <= x && \
+    (OCTOMAP_MINOR_VERSION < y || (OCTOMAP_MINOR_VERSION <= y && \
+    OCTOMAP_PATCH_VERSION <= z))))
+#endif // FCL_HAVE_OCTOMAP
+
 #endif

include/fcl/octree.h

@@ -190,25 +190,41 @@ class OcTree : public CollisionGeometry
   /// @return ptr to child number childIdx of node
   OcTreeNode* getNodeChild(OcTreeNode* node, unsigned int childIdx)
   { 
+#if OCTOMAP_VERSION_AT_LEAST(1,8,0)
     return tree->getNodeChild(node, childIdx);
+#else
+    return node->getChild(childIdx);
+#endif
   }  
 
   /// @return const ptr to child number childIdx of node
   const OcTreeNode* getNodeChild(const OcTreeNode* node, unsigned int childIdx) const
   { 
+#if OCTOMAP_VERSION_AT_LEAST(1,8,0)
     return tree->getNodeChild(node, childIdx);
+#else
+    return node->getChild(childIdx);
+#endif
   }  
 
   /// @brief return true if the child at childIdx exists
   bool nodeChildExists(const OcTreeNode* node, unsigned int childIdx) const
   { 
+#if OCTOMAP_VERSION_AT_LEAST(1,8,0)
     return tree->nodeChildExists(node, childIdx);
+#else
+    return node->childExists(childIdx);
+#endif
   }
 
   /// @brief return true if node has at least one child
   bool nodeHasChildren(const OcTreeNode* node) const
   {
+#if OCTOMAP_VERSION_AT_LEAST(1,8,0)
     return tree->nodeHasChildren(node);
+#else
+    return node->hasChildren();
+#endif
   }
 
   /// @brief return object type, it is an octree