FSN Planning | Trajectory Planning