Title: Motion Control of a Citrus-Picking Robot