Added dijkstra 3D planner