P. Abichandani, H. Benson, and M. Kam, Mathematical programming approaches for multi-vehicle motion planning: Linear, nonlinear, and mixed integer programming, Foundations and Trends® in Robotics, vol.2, issue.4, pp.261-338, 2013.

P. Abichandani, G. Ford, H. Y. Benson, K. , and M. , Mathematical programming for multi-vehicle motion planning problems, 2012 IEEE International Conference on Robotics and Automation, pp.3315-3322, 2012.

M. Abramowitz and I. A. Stegun, Handbook of Mathematical Functions with Formulas, Graphs, and Mathematical Tables, National Bureau of Standards Applied Mathematics Series, vol.55, 1972.

M. Alicja, A new universal adaptive tracking control law for nonholonomic wheeled mobile robots moving in r3 space, IEEE International Conference on Robotics and Automation, 1999.

C. Amato, G. Konidaris, G. Cruz, C. A. Maynor, J. P. How et al., Planning for decentralized control of multiple robots under uncertainty, 2015 IEEE International Conference on Robotics and Automation (ICRA), pp.1241-1248, 2015.

T. Arney, An efficient solution to autonomous path planning by approximate cell decomposition, 2007 Third International Conference on Information and Automation for Sustainability, pp.88-93, 2007.

T. Asano, T. Asano, L. Guibas, J. Hershberger, and H. Imai, Visibility of disjoint polygons, Algorithmica, vol.1, issue.1-4, pp.49-63, 1986.

M. Ashoorirad, R. Barzamini, A. Afshar, J. , and J. , Model Reference Adaptive Path Following for Wheeled Mobile Robots, 2006 International Conference on Information and Automation, pp.289-294, 2006.

A. G. Baydin, B. A. Pearlmutter, A. A. Radul, and J. M. Siskind, Automatic differentiation in machine learning: a survey, Journal of machine learning research, vol.18, issue.153, 2018.

C. Bde-boor, A practical guide to splines, 2001.

T. Bell, M. O'connor, V. Jones, A. Rekow, G. Elkaim et al., Realistic autofarming closed-loop tractor control over irregular paths using kinematic gps, The Journal of Navigation, vol.51, issue.3, pp.327-335, 1998.

F. Borrelli, D. Subramanian, .. U. Raghunathan, and L. Biegler, MILP and NLP Techniques for centralized trajectory planning of multiple unmanned air vehicles, 2006.

A. Control-conference, , pp.5763-5768

S. Boyd, N. Parikh, E. Chu, B. Peleato, and J. Eckstein, Distributed optimization and statistical learning via the alternating direction method of multipliers. Foundations and Trends® in Machine learning, vol.3, pp.1-122, 2011.

M. Bücker, , pp.2019-2021, 2000.

J. Canny and J. Reif, New lower bound techniques for robot motion planning problems, Foundations of Computer Science, pp.49-60, 1987.

J. Carsten, A. Rankin, D. Ferguson, and A. Stentz, Global path planning on board the mars exploration rovers, IEEE Aerospace Conference, pp.1-11, 2007.

H. M. Choset, S. Hutchinson, K. M. Lynch, G. Kantor, W. Burgard et al., Principles of robot motion: theory, algorithms, and implementation, 2005.

R. Curnow and M. Lichvar, , pp.2019-2029, 2019.

C. De-la-cruz and R. Carelli, Dynamic modeling and centralized formation control of mobile robots, IECON 2006-32nd Annual Conference on IEEE Industrial Electronics, pp.3880-3885, 2006.

M. Defoort, A. Kokosy, T. Floquet, W. Perruquetti, P. et al., Motion planning for cooperative unicycle-type mobile robots with limited sensing ranges: A distributed receding horizon approach, Robotics and Autonomous Systems, vol.57, issue.11, pp.1094-1106, 2009.
URL : https://hal.archives-ouvertes.fr/hal-00519825

S. Developpers, Scipy -scientific computing tools for python, pp.2019-2029, 2019.

J. A. Douthwaite, S. Zhao, and L. S. Mihaylova, Velocity obstacle approaches for multi-agent collision avoidance, Unmanned Systems, vol.7, issue.01, pp.55-64, 2019.

M. Ester, H. Kriegel, J. Sander, and X. Xu, A density-based algorithm for discovering clusters in large spatial databases with noise, Kdd, vol.96, pp.226-231, 1996.

A. Filotheou, A. Nikou, and D. V. Dimarogonas, Robust decentralized navigation of multi-agent systems with collision avoidance and connectivity maintenance using model predictive controllers, 2018.

P. Fiorini and Z. Shiller, Motion planning in dynamic environments using velocity obstacles, The International Journal of Robotics Research, vol.17, issue.7, pp.760-772, 1998.

D. Fox, W. Burgard, and S. Thrun, The dynamic window approach to collision avoidance, IEEE Robotics & Automation Magazine, vol.4, issue.1, pp.23-33, 1997.

. Gartner, Gartner predicts 2019 for supply chain operations, pp.2019-2029, 2019.

R. Gayle, A. Sud, M. C. Lin, and D. Manocha, Reactive deformation roadmaps: motion planning of multiple robots in dynamic environments, IEEE/RSJ International Conference on Intelligent Robots and Systems, pp.3777-3783, 2007.

. Gizmag, Autonomous robots are helping to pack your amazon orders, pp.2019-2029, 2014.

F. Hamerlain, K. Achour, T. Floquet, and W. Perruquetti, Trajectory tracking of a car-like robot using second order sliding mode control, European Control Conference (ECC), pp.4932-4936, 2007.

J. Hopcroft, J. Schwartz, and M. Sharir, On the complexity of motion planning for multiple independent objects; pspace-hardness of the "warehouseman's problem, The International Journal of Robotics Research, vol.3, issue.4, pp.76-88, 1984.

M. Hoy, A. S. Matveev, and A. V. Savkin, Algorithms for collision-free navigation of mobile robots in complex cluttered environments: A survey, Robotica, vol.33, issue.3, pp.463-497, 2015.

L. P. Kaelbling and T. Lozano-perez, Integrated task and motion planning in belief space, The International Journal of Robotics Research, vol.32, pp.1194-1227, 2013.

L. E. Kavraki, P. Svestka, J. Latombe, and M. H. Overmars, Probabilistic roadmaps for path planning in high-dimensional configuration spaces, IEEE transactions on Robotics and Automation, vol.12, issue.4, pp.566-580, 1996.

J. M. Keil and J. Sack, Minimum decompositions of polygonal objects, Machine Intelligence and Pattern Recognition, vol.2, pp.197-216, 1985.

M. P. Kelly, Transcription methods for trajectory optimization: a beginners tutorial, 2017.

O. Khatib, Real-time obstacle avoidance for manipulators and mobile robots, Autonomous Robot Vehicles, pp.396-404, 1986.

D. Kraft, A software package for sequential quadratic programming, DLR German Aerospace Center -Institute for Flight Mechanics, 1988.

M. Krid, F. Benamar, and R. Lenain, A new explicit dynamic path tracking controller using Generalized Predictive Control, International Journal of Control, Automation and Systems, pp.1-10, 2016.

H. Kurniawati, D. Hsu, and W. S. Lee, Sarsop: Efficient point-based pomdp planning by approximating optimally reachable belief spaces, Robotics: Science and systems, 2008.

L. Salle, J. Lefschetz, and S. , Stability by Liapunov's Direct Method with Applications by, vol.4, 2012.

W. F. Lages and E. M. Hemerly, Adaptive Linearizing Control of Mobile Robots, IFAC Proceedings Volumes, vol.31, pp.23-28, 1998.

J. Latombe, Robot Motion Planning, vol.124, 1991.

J. P. Laumond, Robot Motion Planning and Control, 1998.

S. M. Lavalle, Planning algorithms, 2006.
URL : https://hal.archives-ouvertes.fr/hal-01993243

A. Leal, autodiff -Automatic Differentiation in C++, pp.2019-2021, 2018.

M. Levihn, J. Scholz, and M. Stilman, Hierarchical decision theoretic planning for navigation among movable obstacles, Algorithmic Foundations of Robotics X, pp.19-35, 2013.

W. C. Lu, L. Duan, H. Fei-bin, and F. Mora-camino, Differential flatness applied to vehicle trajectory tracking, 27th Chinese Control Conference, pp.242-247, 2008.
URL : https://hal.archives-ouvertes.fr/hal-00938183

J. M. Maestre and R. R. Negenborn, Distributed model predictive control made easy, vol.69, 2014.

R. Marino, Adaptive control of nonlinear systems: Basic results and applications, Annual Reviews in Control, vol.21, pp.55-66, 1997.

R. Marino and P. Tomei, Nonlinear Control Design: Geometric, Adaptive, and Robust, 1995.

M. W. Mehrez, T. Sprodowski, K. Worthmann, G. K. Mann, R. G. Gosine et al., Occupancy grid based distributed mpc for mobile robots, Intelligent Robots and Systems (IROS), 2017 IEEE/RSJ International Conference on, pp.4842-4847, 2017.

J. M. Mendes-filho and E. Lucet, Multi-robot motion planning: a modified receding horizon approach for reaching goal states, Acta Polytechnica, vol.56, issue.1, pp.10-17, 2016.

J. M. Mendes-filho, E. Lucet, and D. Filliat, Real-Time Distributed Receding Horizon Motion Planning and Control for Mobile Multi-Robot Dynamic Systems, ICRA 2017 -IEEE International Conference on Robotics and Automation, 2017.
URL : https://hal.archives-ouvertes.fr/hal-01530977

J. M. Mendes-filho, E. Lucet, and D. Filliat, Distributed receding horizon motion planning for multirobot systems, 2018.
URL : https://hal.archives-ouvertes.fr/hal-01530977

J. M. Mendes-filho, E. Lucet, and D. Filliat, Experimental Validation of a Multirobot Distributed Receding Horizon Motion Planning Approach, ICARCV 2018 -15th International Conference on Control, Automation, Robotics and Vision, 2018.
URL : https://hal.archives-ouvertes.fr/hal-01935322

X. Merlhiot, J. L. Garrec, G. Saupin, A. , and C. , The XDE Mechanical Kernel: Efficient and Robust Simulation of Multibody Dynamics with Intermittent Nonsmooth Contacts, Proceedings of the Second Joint International Conference on Multibody System Dynamics -IMSD, 2012.

M. B. Milam, Real-time optimal trajectory generation for constrained dynamical systems, 2003.

M. Mohanan and A. Salgoankar, A survey of robotic motion planning in dynamic environments, Robotics and Autonomous Systems, vol.100, pp.171-185, 2018.

L. Nedelkoska and G. Quintini, Automation, skills use and training, 2018.

N. J. Nilsson, . Sri, . Menlo-park, and . Ca, Shakey the robot, 1984.

J. Nocedal and S. J. Wright, Numerical optimization : with 85 illustrations. Springer series in operations research, 1999.

O. Adept, Omron Adept Lynx Platform User's Guide, pp.2019-2041, 2016.

M. Otte and E. Frazzoli, Rrtx: Real-time motion planning/replanning for environments with unpredictable obstacles, Algorithmic Foundations of Robotics XI, pp.461-478, 2015.

J. Park and S. Oh, A new concave hull algorithm and concaveness measure for n-dimensional datasets, Journal of Information science and engineering, vol.28, issue.3, pp.587-600, 2012.

M. R. Pedersen and V. Krüger, Automated planning of industrial logistics on a skill-equipped robot, IROS 2015 workshop Task Planning for Intelligent Robots in Service and Manufacturing, 2015.

R. E. Perez, P. W. Jansen, and J. R. Martins, pyOpt: A Python-based object-oriented framework for nonlinear constrained optimization. Structures and Multidisciplinary Optimization, vol.45, pp.101-118, 2012.

L. Piegl and W. Tiller, The NURBS book, 2012.

F. Pourboghrat and M. P. Karlsson, Adaptive control of dynamic mobile robots with nonholonomic constraints, Computers & Electrical Engineering, vol.28, issue.4, pp.241-253, 2002.

S. Quinlan and O. Khatib, Towards real-time execution of motion tasks, Experimental Robotics II, pp.239-254, 1993.

, Ratp group launches experiment in driverless shuttles at cea paris-saclay, RATP, pp.2019-2029, 2018.

, Ratp group, cea and iveco bus hold first ever demonstration in europe of a fully autonomous garage, RATP, pp.2019-2029, 2019.

G. Renault, Paris-Saclay Autonomous Lab: new autonomous, electric and shared mobility services, pp.2019-2029, 2019.

E. D. Sacerdoti, Planning in a hierarchy of abstraction spaces, Artificial intelligence, vol.5, issue.2, pp.115-135, 1974.

C. Samson, Control of chained systems application to path following and timevarying point-stabilization of mobile robots, IEEE Transactions on Automatic Control, vol.40, issue.1, pp.64-77, 1995.

G. Sanchez and J. Latombe, Using a prm planner to compare centralized and decoupled planning for multi-robot systems, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No. 02CH37292), vol.2, pp.2112-2119, 2002.

B. Siciliano and O. Khatib, Springer handbook of robotics, pp.808-810, 2008.

T. Siméon, S. Leroy, and J. Lauumond, Path coordination for multiple mobile robots: A resolution-complete algorithm, IEEE Transactions on Robotics and Automation, vol.18, issue.1, pp.42-49, 2002.

. Spark, Robotics 2020 multi-annual roadmap for robotics in europe, 2019.

S. Srivastava, E. Fang, L. Riano, R. Chitnis, S. Russell et al., Combined task and motion planning through an extensible planner-independent interface layer, 2014 IEEE international conference on robotics and automation (ICRA), pp.639-646, 2014.

K. D. Stroyan, Symbolic differentiation, Calculus Using Mathematica, pp.85-103, 2014.

O. Takahashi and R. J. Schilling, Motion planning in a plane using generalized voronoi diagrams, IEEE Trans. Robotics and Automation, vol.5, pp.143-150, 1989.

S. Thrun, W. Burgard, and D. Fox, Probabilistic robotics (intelligent robotics and autonomous agents series, 2005.

B. Thuilot, Contribution à la modélisation et à la commande de robots mobiles à roues, 1995.

A. Tits, C. Lawrence, and J. Zhou, User's guide for cfsqp version 2.5: A c code for solving (large scale) constrained nonlinear (minimax) optimization problems, generating iterates satisfying all inequality constraints, 1999.

R. Van-parys and G. Pipeleers, Online distributed motion planning for multivehicle systems, European Control Conference (ECC), pp.1580-1585, 2016.

Y. Zhou, H. Hu, Y. Liu, S. W. Lin, and Z. Ding, A Real-Time and Fully Distributed Approach to Motion Planning for Multirobot Systems, IEEE Transactions on Systems, Man, and Cybernetics: Systems, issue.99, pp.1-15, 2017.

, 2 Father ID: 1 TWD

T. Wd,

T. Wd,

. Move_0,

. Move_0,

, Node ID: 5 Father ID: 2 TWD

. Move_0,

, Node ID: 6 Father ID: 5 TWD

, R PC(region=SweptSurf(obj_C

. Move_0,

. Move_0,

, R PC(region=SweptSurf(obj_C

. Move_0,

, Node ID: 1 | Father ID: 0 | CCost: 0.180710678119 | Repeated Node? False HOLDS(holderID=rA, objID=oA) PICKABLE(objID=oA) PICKED(objID=oA) RPC

, Node ID: 2 | Father ID: 1 | CCost: 3.46264493653 | Repeated Node? False CONTROLLABLE(objID=rA) HOLDS(holderID=rA, objID=oA) PICKABLE(objID=oA) PICKED(objID=oA) RPC

, Node ID: 3 | Father ID: 2 | CCost: 3.64335561465 | Repeated Node? False CONTROLLABLE(objID=rA) PICKABLE(objID=oA)

!. Picked,

, Node ID: 4 | Father ID: 2 | CCost: 5.98195866971 | Repeated Node? False CONTROLLABLE(objID=rA) HOLDS(holderID=rA, objID=oA) PICKABLE(objID=oA) PICKED(objID=oA) RPC

, Node ID: 5 | Father ID: 3 | CCost: 6.16266934783 | Repeated Node? False CONTROLLABLE(objID=rA) PICKABLE(objID=oA)

!. Picked,

, False, pickable: False, type: object, sigmas