mop: Motion Organization and Planning