Cooperative Distributed MPC via Decentralized Real-Time Optimization: Implementation Results for Robot Formations

Gösta Stomberg,Henrik Ebel,Timm Faulwasser,Peter Eberhard
DOI: https://doi.org/10.48550/arXiv.2301.07960
2023-05-24
Abstract:Distributed model predictive control (DMPC) is a flexible and scalable feedback control method applicable to a wide range of systems. While the stability analysis of DMPC is quite well understood, there exist only limited implementation results for realistic applications involving distributed computation and networked communication. This article approaches formation control of mobile robots via a cooperative DMPC scheme. We discuss the implementation via decentralized optimization algorithms. To this end, we combine the alternating direction method of multipliers with decentralized sequential quadratic programming to solve the underlying optimal control problem in a decentralized fashion with nominal convergence guarantees. Our approach only requires coupled subsystems to communicate and does not rely on a central coordinator. Our experimental results showcase the efficacy of DMPC for formation control and they demonstrate the real-time feasibility of the considered algorithms.
Systems and Control,Robotics
What problem does this paper attempt to address?
The problem that this paper attempts to solve is to achieve formation control of mobile robot groups through cooperative distributed model predictive control (DMPC). Specifically, the paper explores how to use decentralized real - time optimization algorithms to solve this problem, especially by combining the alternating direction multiplier method (ADMM) with decentralized sequential quadratic programming (dSQP), so that the coupled subsystems can solve the underlying optimal control problem only through communication without a central coordinator. The focus of the paper is to demonstrate the effectiveness and real - time feasibility of this method in practical applications, especially in mobile robot formation control. ### Main contributions of the paper 1. **Practical evaluation**: The paper provides experimental results on the application of decentralized optimization algorithms in DMPC, especially when dealing with non - convex optimal control problems, the algorithms used have nominal convergence guarantees. 2. **Experimental verification**: Through actual robot hardware experiments, the effectiveness and real - time feasibility of the proposed DMPC scheme are verified. 3. **Algorithm comparison**: The paper compares the performance of the two methods, ADMM and dSQP, in solving the formation control problem, and shows their applicability and advantages under different conditions. ### Structure of the paper - **Section 2**: Introduces the DMPC scheme and the mathematical model of the optimal control problem (OCP). - **Section 3**: Describes in detail the principles and implementation steps of the two decentralized optimization algorithms, ADMM and dSQP. - **Section 4**: Discusses the implementation details of the algorithms and experimental implementation, including hardware configuration and experimental setup. - **Section 5**: Analyzes the performance and execution time of the DMPC scheme and provides valuable insights for the future development of distributed optimization algorithms. ### Key technical points - **Decentralized optimization**: Through the ADMM and dSQP methods, collaborative optimization among subsystems is achieved without a central coordinator. - **Non - convex problem handling**: The dSQP method is particularly suitable for handling non - convex optimal control problems and has good convergence and robustness. - **Real - time feasibility**: Experimental results show that the proposed DMPC scheme can achieve real - time control in actual robot formation control tasks. ### Formula summary - **Mathematical model of OCP**: \[ \min_{x, u} \sum_{i \in S} \sum_{k = 0}^{N - 1} \ell_i(x_k, u_k^i)+V_f^i(x_N) \] where, \[ \ell_i(x, u^i)=\frac{1}{2}(x_i-\bar{x}_i)^T Q_{ij}(x_j - \bar{x}_j)+\frac{1}{2}(u^i-\bar{u}^i)^T R_{ii}(u^i-\bar{u}^i) \] \[ V_f^i(x)=\frac{1}{2}\sum_{j \in S}(x_i-\bar{x}_i)^T P_{ij}(x_j-\bar{x}_j) \] - **ADMM iteration formula**: \[ z_i^{l + 1}=\arg\min_{z_i\in Z_i}L_{\rho, i}(z_i,\bar{z}_i^l,\gamma_i^l) \] \[ \bar{z}^{l + 1}=\arg\min_{\bar{z}\in E}L_{\rho}(z^{l + 1},\bar{z},\gamma^l) \] \[ \gamma_i^{l + 1}=\gamma_i^l+\rho(z_i^{l + 1}-\bar{z}_i^{l + 1}) \] - **dSQP iteration formula**: \[ \Delta z_i^{l + 1}=\arg\min_{\Delta z_i\in S_i^q}L_{\text{QP},q,\rho,i}(\Delta z_i,