Architecture, integration of planner and motion controller