3d path finding [hierarchical]