added initial plan for pathfinding