MA Reithmayr Trajectory Planner