Accelerating Model Predictive Control for Legged Robots through Distributed Optimization (2403.11742v4)
Abstract: This paper presents a novel approach to enhance Model Predictive Control (MPC) for legged robots through Distributed Optimization. Our method focuses on decomposing the robot dynamics into smaller, parallelizable subsystems, and utilizing the Alternating Direction Method of Multipliers (ADMM) to ensure consensus among them. Each subsystem is managed by its own Optimal Control Problem, with ADMM facilitating consistency between their optimizations. This approach not only decreases the computational time but also allows for effective scaling with more complex robot configurations, facilitating the integration of additional subsystems such as articulated arms on a quadruped robot. We demonstrate, through numerical evaluations, the convergence of our approach on two systems with increasing complexity. In addition, we showcase that our approach converges towards the same solution when compared to a state-of-the-art centralized whole-body MPC implementation. Moreover, we quantitatively compare the computational efficiency of our method to the centralized approach, revealing up to a 75% reduction in computational time. Overall, our approach offers a promising avenue for accelerating MPC solutions for legged robots, paving the way for more effective utilization of the computational performance of modern hardware.
- F. Farshidian, E. Jelavic, A. Satapathy, M. Giftthaler, and J. Buchli, “Real-time motion planning of legged robots: A model predictive control approach,” in 2017 IEEE-RAS 17th International Conference on Humanoid Robotics (Humanoids), 2017, pp. 577–584.
- C. Mastalli, R. Budhiraja, W. Merkt, G. Saurel, B. Hammoud, M. Naveau, J. Carpentier, L. Righetti, S. Vijayakumar, and N. Mansard, “Crocoddyl: An Efficient and Versatile Framework for Multi-Contact Optimal Control,” in IEEE International Conference on Robotics and Automation (ICRA), 2020.
- R. Verschueren, G. Frison, D. Kouzoupis, J. Frey, N. van Duijkeren, A. Zanelli, B. Novoselnik, T. Albin, R. Quirynen, and M. Diehl, “acados – a modular open-source framework for fast embedded optimal control,” Mathematical Programming Computation, 2021.
- F. Farshidian et al., “OCS2: An open source library for optimal control of switched systems,” [Online]. Available: https://github.com/leggedrobotics/ocs2.
- S. Hong, J.-H. Kim, and H.-W. Park, “Real-time constrained nonlinear model predictive control on so(3) for dynamic legged locomotion,” in 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2020, pp. 3982–3989.
- G. Romualdi, S. Dafarra, G. L’Erario, I. Sorrentino, S. Traversaro, and D. Pucci, “Online non-linear centroidal mpc for humanoid robot locomotion with step adjustment,” in 2022 International Conference on Robotics and Automation (ICRA), 2022, pp. 10 412–10 419.
- N. Rathod, A. Bratta, M. Focchi, M. Zanon, O. Villarreal, C. Semini, and A. Bemporad, “Model predictive control with environment adaptation for legged locomotion,” IEEE Access, vol. 9, 2021.
- D. E. Orin, A. Goswami, and S.-H. Lee, “Centroidal dynamics of a humanoid robot,” Autonomous robots, vol. 35, no. 2-3, pp. 161–176, 2013.
- J.-P. Sleiman, F. Farshidian, M. V. Minniti, and M. Hutter, “A unified mpc framework for whole-body dynamic locomotion and manipulation,” IEEE Robotics and Automation Letters, vol. 6, no. 3, pp. 4688–4695, 2021.
- R. Grandia, F. Jenelten, S. Yang, F. Farshidian, and M. Hutter, “Perceptive locomotion through nonlinear model-predictive control,” IEEE Transactions on Robotics, vol. 39, no. 5, pp. 3402–3421, 2023.
- C. Mastalli, S. Chhatoi, T. Corbéres, S. Tonneau, and S. Vijayakumar, “Inverse-dynamics mpc via nullspace resolution,” IEEE Transactions on Robotics, vol. 39, no. 4, pp. 3222–3241, 2023.
- E. Dantec, M. Naveau, P. Fernbach, N. Villa, G. Saurel, O. Stasse, M. Taix, and N. Mansard, “Whole-body model predictive control for biped locomotion on a torque-controlled humanoid robot,” in 2022 IEEE-RAS 21st International Conference on Humanoid Robots (Humanoids), 2022, pp. 638–644.
- J. N. Nganga and P. M. Wensing, “Accelerating second-order differential dynamic programming for rigid-body systems,” IEEE Robotics and Automation Letters, vol. 6, no. 4, pp. 7659–7666, 2021.
- W.-L. Ma, N. Csomay-Shanklin, and A. D. Ames, “Coupled control systems: Periodic orbit generation with application to quadrupedal locomotion,” IEEE Control Systems Letters, vol. 5, no. 3, pp. 935–940, 2021.
- V. R. Kamidi, J. Kim, R. T. Fawcett, A. D. Ames, and K. Akbari Hamed, “Distributed quadratic programming-based nonlinear controllers for periodic gaits on legged robots,” IEEE Control Systems Letters, vol. 6, pp. 2509–2514, 2022.
- W.-L. Ma, N. Csomay-Shanklin, S. Kolathaya, K. A. Hamed, and A. D. Ames, “Coupled control lyapunov functions for interconnected systems, with application to quadrupedal locomotion,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 3761–3768, 2021.
- R. Budhiraja, J. Carpentier, and N. Mansard, “Dynamics consensus between centroidal and whole-body models for locomotion of legged robots,” in 2019 International Conference on Robotics and Automation (ICRA), 2019, pp. 6727–6733.
- S. Boyd, N. Parikh, E. Chu, B. Peleato, and J. Eckstein, “Distributed optimization and statistical learning via the alternating direction method of multipliers,” Found. Trends Mach. Learn., vol. 3, no. 1, 2011.
- G. Bravo-Palacios and P. M. Wensing, “Large-scale admm-based co-design of legged robots,” in 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2022, pp. 8842–8849.
- W. Deng, M.-J. Lai, Z. Peng, and W. Yin, “Parallel multi-block admm with o(1/k) convergence,” Journal of Scientific Computing, vol. 71, no. 2, pp. 712–736, 2017.
- J. Baumgarte, “Stabilization of constraints and integrals of motion in dynamical systems,” Computer Methods in Applied Mechanics and Engineering, vol. 1, no. 1, pp. 1–16, 1972. [Online]. Available: https://www.sciencedirect.com/science/article/pii/0045782572900187
- S. Gros, M. Zanon, R. Quirynen, A. Bemporad, and M. Diehl, “From linear to nonlinear mpc: bridging the gap via the real-time iteration,” International Journal of Control, vol. 93, no. 1, pp. 62–80, 2020.
- Z. Zhou and Y. Zhao, “Accelerated admm based trajectory optimization for legged locomotion with coupled rigid body dynamics,” in 2020 American Control Conference (ACC), 2020, pp. 5082–5089.
- G. L’Erario, G. Nava, G. Romualdi, F. Bergonti, V. Razza, S. Dafarra, and D. Pucci, “Whole-body trajectory optimization for robot multimodal locomotion,” in 2022 IEEE-RAS 21st International Conference on Humanoid Robots (Humanoids), 2022, pp. 651–658.
- E. Todorov, T. Erez, and Y. Tassa, “Mujoco: A physics engine for model-based control,” in 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2012, pp. 5026–5033.