Navigation and Control for an Autonomous Robotic Fruit Harvesting System