implemented mp for ManipPlanner