MotionPlanner: optimize division