Lane planner plans a trajectory that navigates from start_point to goal_point when a route is given via action goal. However, it is inserting start_point and goal_point with current