A distributed control framework for motion coordination of teams of autonomous agricultural vehicles

A distributed control framework intended to coordinate the motions of teams of autonomous agricultural vehicles operating in proximity is presented; master–slave and peer-to-peer operation modes are supported. Each vehicle has a nonlinear model predictive tracking controller, which keeps it as close as possible to the path demanded by the task, and coordinates and avoids collisions with nearby vehicles. To do this, it receives the motion trajectories of all other vehicles in its vicinity that may interfere with its own projected motion via a wireless network, and incorporates these trajectories in the computation of its own optimal control action. Each controller is supervised by a higher-level task controller that determines a limited set of the controller's parameters. Simulation experiments have shown that the minimisation of the tracking error along a finite horizon enabled the controller to track paths containing sharp turns, by applying appropriate steering well in advance of the turn. It has also been shown that the variation of specific predictive controller parameters results in a wide range of behaviours; i.e., vehicles can move in both operating modes, coordinate with nearby vehicles by altering their velocity profiles or the shapes of their paths, and avoid collisions.

[1]  Dusan M. Stipanovic,et al.  Formation Control and Collision Avoidance for Multi-agent Non-holonomic Systems: Theory and Experiments , 2008, Int. J. Robotics Res..

[2]  Xiaoming Hu,et al.  Control of mobile platforms using a virtual vehicle approach , 2001, IEEE Trans. Autom. Control..

[3]  E. J. van Henten,et al.  Optimal manipulator design for a cucumber harvesting robot , 2009 .

[4]  Simos A. Evangelou,et al.  Advances in the development of a virtual car driver , 2009 .

[5]  Antonella Ferrara,et al.  Minimum sensor second-order sliding mode longitudinal control of passenger vehicles , 2004, IEEE Transactions on Intelligent Transportation Systems.

[6]  Gamal N. Elnagar,et al.  The pseudospectral Legendre method for discretizing optimal control problems , 1995, IEEE Trans. Autom. Control..

[7]  Jie Lin,et al.  Coordination of groups of mobile autonomous agents using nearest neighbor rules , 2003, IEEE Trans. Autom. Control..

[8]  Arto Visala,et al.  Navigation system for agricultural machines: Nonlinear Model Predictive path tracking , 2012 .

[9]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[10]  B. Xie,et al.  Tractor Platooning System on Sloping Terrain at Low Speed , 2009 .

[11]  L. Lasdon,et al.  An interior penalty method for inequality constrained optimal control problems , 1967, IEEE Transactions on Automatic Control.

[12]  Zhao Dean,et al.  System Design and Control of an Apple Harvesting Robot , 2020, ArXiv.

[13]  Luca Maria Gambardella,et al.  c ○ 2004 Kluwer Academic Publishers. Manufactured in The Netherlands. Swarm-Bot: A New Distributed Robotic Concept , 2022 .

[14]  Barry Brian Werger,et al.  Cooperation without Deliberation: A Minimal Behavior-based Approach to Multi-Robot Teams , 1999, Artif. Intell..

[15]  William B. Dunbar,et al.  Distributed receding horizon control for multi-vehicle formation stabilization , 2006, Autom..

[16]  Vijay Kumar,et al.  Closed loop motion planning and control for mobile robots in uncertain environments , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[17]  Craig W. Reynolds Flocks, herds, and schools: a distributed behavioral model , 1987, SIGGRAPH.

[18]  Jan M. Maciejowski,et al.  Predictive control : with constraints , 2002 .

[19]  David C. Slaughter,et al.  Autonomous robotic weed control systems: A review , 2008 .

[20]  Xi Zhang,et al.  Development of an intelligent master-slave system between agricultural vehicles , 2010, 2010 IEEE Intelligent Vehicles Symposium.

[21]  René Vidal,et al.  Distributed Formation Control with Omnidirectional Vision-Based Motion Segmentation and Visual Servoing , 2004 .

[22]  Davor Hrovat,et al.  Vehicle steering intervention through differential braking , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[23]  Lynne E. Parker,et al.  ALLIANCE: an architecture for fault tolerant multirobot cooperation , 1998, IEEE Trans. Robotics Autom..

[24]  Dionysis Bochtis,et al.  Original paper: Path planning for in-field navigation-aiding of service units , 2010 .

[25]  Julian Sanchez,et al.  Corn plant sensing using real-time stereo vision , 2009 .

[26]  J. Sanchez,et al.  Sliding mode control for robot formations , 2003, Proceedings of the 2003 IEEE International Symposium on Intelligent Control.

[27]  Randal W. Beard,et al.  A decentralized approach to formation maneuvers , 2003, IEEE Trans. Robotics Autom..

[28]  Rafael Fierro,et al.  A dual-mode model predictive controller for robot formations , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[29]  J. F. Reid,et al.  Adaptive steering controller using a Kalman estimator for wheel-type agricultural tractors , 2001, Robotica.

[30]  Marcus Geimer,et al.  Method for an electronic controlled platooning system of agricultural vehicles , 2009, 2009 IEEE International Conference on Vehicular Electronics and Safety (ICVES).

[31]  Hongyan Wang,et al.  Social potential fields: A distributed behavioral control for autonomous robots , 1995, Robotics Auton. Syst..

[32]  Arto Visala,et al.  Semi-automatic Tuning of NMPC Based Trajectory Control System in Agricultural Machine , 2011 .

[33]  Vijay Kumar,et al.  Modeling and control of formations of nonholonomic mobile robots , 2001, IEEE Trans. Robotics Autom..

[34]  Dionysis Bochtis,et al.  Optimal Dynamic Motion Sequence Generation for Multiple Harvesters , 2007 .

[35]  Lynne E. Parker,et al.  Cooperative leader following in a distributed multi-robot system , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[36]  Tateshi Fujiura,et al.  Cherry-harvesting robot , 2008 .

[37]  Tucker R. Balch,et al.  Behavior-based formation control for multirobot teams , 1998, IEEE Trans. Robotics Autom..

[38]  Maja J. Mataric,et al.  A general algorithm for robot formations using local sensing and minimal communication , 2002, IEEE Trans. Robotics Autom..

[39]  Camillo J. Taylor,et al.  A vision-based formation control framework , 2002, IEEE Trans. Robotics Autom..

[40]  Narendra Ahuja,et al.  A potential field approach to path planning , 1992, IEEE Trans. Robotics Autom..

[41]  Noboru Noguchi,et al.  Development of a master-slave robot system for farm operations , 2004 .

[42]  Sunil K. Agrawal,et al.  DIFFERENTIAL FLATNESS-BASED FORMATION FOLLOWING OF A SIMULATED AUTONOMOUS SMALL GRAIN HARVESTING SYSTEM , 2004 .

[43]  J. Betts Survey of Numerical Methods for Trajectory Optimization , 1998 .

[44]  S. Shankar Sastry,et al.  Following the flock [formation control] , 2004, IEEE Robotics & Automation Magazine.

[45]  G. van Straten,et al.  Systematic design of an autonomous platform for robotic weeding , 2010 .

[46]  Ricardo G. Sanfelice,et al.  Optimal control of Mixed Logical Dynamical systems with Linear Temporal Logic specifications , 2008, 2008 47th IEEE Conference on Decision and Control.