Consensus Complementarity Control for Multi-Contact MPC

Read original: arXiv:2304.11259 - Published 7/29/2024 by Alp Aydinoglu, Adam Wei, Wei-Cheng Huang, Michael Posa

🎲

Overview

The paper proposes a new hybrid model predictive control algorithm called Consensus Complementarity Control (C3) for systems that make and break contact with their environment.
Many existing controllers for tasks like locomotion and manipulation require pre-defined mode schedules or are computationally complex, making them unsuitable for real-time use.
The C3 method uses the Alternating Direction Method of Multipliers (ADMM) to enable high-speed reasoning over potential contact events, and a consensus formulation to parallelize the contact scheduling problem.

Plain English Explanation

The paper introduces a new type of control algorithm called Consensus Complementarity Control (C3) that is designed to work well for systems that need to make and break contact with their environment. This could include things like legged robots trying to walk or robot arms trying to manipulate objects.

Many existing control algorithms for these types of tasks either require the programmer to provide a pre-planned schedule of when the system should make and break contact, or they are too computationally complex to run in real-time. The C3 algorithm aims to address these limitations.

The key idea behind C3 is to use a mathematical technique called the Alternating Direction Method of Multipliers (ADMM) to quickly reason about potential contact events. It also uses a "consensus" approach to split up the contact scheduling problem, allowing it to be parallelized and run more efficiently.

Technical Explanation

The paper presents the Consensus Complementarity Control (C3) algorithm, a hybrid model predictive control method for systems that make and break contact with their environment. Unlike many existing controllers that require pre-defined mode schedules or are computationally intractable for real-time use, C3 leverages the Alternating Direction Method of Multipliers (ADMM) to enable high-speed reasoning over potential contact events.

The core of the C3 algorithm is a consensus formulation that parallelizes the contact scheduling problem. By decomposing the optimization into individual subproblems that can be solved simultaneously, the approach allows for efficient real-time contact planning even for high-dimensional systems.

The authors validate their method on five numerical examples, including four high-dimensional frictional contact problems as well as a physical experiment with an underactuated multi-contact system. They further demonstrate the effectiveness of C3 on a physical robot arm accomplishing a complex, high-dimensional manipulation task involving multiple contacts.

Critical Analysis

The paper provides a thorough technical explanation of the C3 algorithm and presents convincing numerical and physical experiment results to validate its performance. However, the authors acknowledge several limitations and areas for future work.

One key caveat is that the consensus-based parallelization relies on the subproblems being loosely coupled, which may not always be the case for more tightly integrated multi-contact systems. Additionally, the ADMM-based optimization, while efficient, still requires significant computational resources that may limit its use on very low-powered embedded platforms.

The authors also note that their experiments focused on deterministic settings, and incorporating stochasticity and uncertainty into the C3 framework is an important direction for future research. Extending the method to handle more complex contact models and higher-dimensional state spaces is another area for improvement.

Overall, the C3 algorithm represents a promising step forward in enabling high-speed contact-rich control for a variety of robotic and other cyber-physical applications. However, as with any research, there are still opportunities to further refine and expand the approach to address its current limitations.

Conclusion

The Consensus Complementarity Control (C3) algorithm proposed in this paper offers a novel solution to the challenge of controlling systems that must make and break contact with their environment, such as legged robots and dexterous robot manipulators. By leveraging the Alternating Direction Method of Multipliers (ADMM) and a consensus-based formulation, C3 can perform high-speed reasoning over potential contact events, enabling efficient real-time control without the need for pre-defined mode schedules.

The authors demonstrate the effectiveness of their method through extensive numerical simulations and physical experiments, showcasing its ability to handle high-dimensional frictional contact problems and complex multi-contact manipulation tasks. While the approach has some limitations that require further research, C3 represents an important advancement in the field of contact-rich control that could have significant implications for a wide range of robotic and cyber-physical applications.

This summary was produced with help from an AI and may contain inaccuracies - check out the links to read the original source documents!

Follow @aimodelsfyi on 𝕏 →

Related Papers

🎲

Consensus Complementarity Control for Multi-Contact MPC

Alp Aydinoglu, Adam Wei, Wei-Cheng Huang, Michael Posa

We propose a hybrid model predictive control algorithm, consensus complementarity control (C3), for systems that make and break contact with their environment. Many state-of-the-art controllers for tasks which require initiating contact with the environment, such as locomotion and manipulation, require a priori mode schedules or are too computationally complex to run at real-time rates. We present a method based on the alternating direction method of multipliers (ADMM) that is capable of high-speed reasoning over potential contact events. Via a consensus formulation, our approach enables parallelization of the contact scheduling problem. We validate our results on five numerical examples, including four high-dimensional frictional contact problems, and a physical experimentation on an underactuated multi-contact system. We further demonstrate the effectiveness of our method on a physical experiment accomplishing a high-dimensional, multi-contact manipulation task with a robot arm.

7/29/2024

Complementarity-Free Multi-Contact Modeling and Optimization for Dexterous Manipulation

Wanxin Jin

A significant barrier preventing model-based methods from matching the high performance of reinforcement learning in dexterous manipulation is the inherent complexity of multi-contact dynamics. Traditionally formulated using complementarity models, multi-contact dynamics introduces combinatorial complexity and non-smoothness, complicating contact-rich planning and control. In this paper, we circumvent these challenges by introducing a novel, simplified multi-contact model. Our new model, derived from the duality of optimization-based contact models, dispenses with the complementarity constructs entirely, providing computational advantages such as explicit time stepping, differentiability, automatic satisfaction of Coulomb friction law, and minimal hyperparameter tuning. We demonstrate the effectiveness and efficiency of the model for planning and control in a range of challenging dexterous manipulation tasks, including fingertip 3D in-air manipulation, TriFinger in-hand manipulation, and Allegro hand on-palm reorientation, all with diverse objects. Our method consistently achieves state-of-the-art results: (I) a 96.5% average success rate across tasks, (II) high manipulation accuracy with an average reorientation error of 11{deg} and position error of 7.8 mm, and (III) model predictive control running at 50-100 Hz for all tested dexterous manipulation tasks. These results are achieved with minimal hyperparameter tuning.

8/20/2024

Accelerating Model Predictive Control for Legged Robots through Distributed Optimization

Lorenzo Amatucci, Giulio Turrisi, Angelo Bratta, Victor Barasuol, Claudio Semini

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.

9/5/2024

❗

Multi-contact Stochastic Predictive Control for Legged Robots with Contact Locations Uncertainty

Ahmad Gazar, Majid Khadiv, Andrea Del Prete, Ludovic Righetti

Trajectory optimization under uncertainties is a challenging problem for robots in contact with the environment. Such uncertainties are inevitable due to estimation errors, control imperfections, and model mismatches between planning models used for control and the real robot dynamics. This induces control policies that could violate the contact location constraints by making contact at unintended locations, and as a consequence leading to unsafe motion plans. This work addresses the problem of robust kino-dynamic whole-body trajectory optimization using stochastic nonlinear model predictive control (SNMPC) by considering additive uncertainties on the model dynamics subject to contact location chance-constraints as a function of robot's full kinematics. We demonstrate the benefit of using SNMPC over classic nonlinear MPC (NMPC) for whole-body trajectory optimization in terms of contact location constraint satisfaction (safety). We run extensive Monte-Carlo simulations for a quadruped robot performing agile trotting and bounding motions over small stepping stones, where contact location satisfaction becomes critical. Our results show that SNMPC is able to perform all motions safely with 100% success rate, while NMPC failed 48.3% of all motions.

6/14/2024