adding changes to trajectory_planner