Prepared all methods for 3d pathfinding algorithm