https://9lib.org/document/zgwr648y-indoor-pathfinding-octree-representation-point-cloud.html