Added straight line planner