MMI to path planner to servo controller