Cleaned up the MotionPlanRequest/Response mess a little bit