State Diagram: TOP:Trajectory_Plan