Modeling and Control of a Robot for Picking Citrus Fruit