A* path finding algorithm in Minecraft (3 dimension) (fully command block)