Hierarchical Optimization-based Control for Whole-body Loco-manipulation of Heavy Objects

Alberto Rigo,Muqun Hu,Satyandra K. Gupta,Quan Nguyen

2024-03-20

Abstract:In recent years, the field of legged robotics has seen growing interest in enhancing the capabilities of these robots through the integration of articulated robotic arms. However, achieving successful loco-manipulation, especially involving interaction with heavy objects, is far from straightforward, as object manipulation can introduce substantial disturbances that impact the robot's locomotion. This paper presents a novel framework for legged loco-manipulation that considers whole-body coordination through a hierarchical optimization-based control framework. First, an online manipulation planner computes the manipulation forces and manipulated object task-based reference trajectory. Then, pose optimization aligns the robot's trajectory with kinematic constraints. The resultant robot reference trajectory is executed via a linear MPC controller incorporating the desired manipulation forces into its prediction model. Our approach has been validated in simulation and hardware experiments, highlighting the necessity of whole-body optimization compared to the baseline locomotion MPC when interacting with heavy objects. Experimental results with Unitree Aliengo, equipped with a custom-made robotic arm, showcase its ability to lift and carry an 8kg payload and manipulate doors.

Robotics

What problem does this paper attempt to address?

### Problems Addressed by the Paper

This paper aims to address the challenges faced by legged robots during object manipulation (loco-manipulation), especially when interacting with heavy objects. Specifically:

1. **Integration of Object Manipulation and Mobility**: By combining leg movements and robotic arm manipulation, the paper seeks to enhance the object manipulation capabilities of legged robots. Traditionally, object manipulation interferes with the robot's stability, particularly when handling heavy objects.

2. **Overall Coordinated Control Framework**: The paper proposes a new hierarchical optimization control framework to address the overall coordination issues of legged robots. This framework includes:
- An Online Manipulation Planner, which calculates the manipulation forces and the task reference trajectory of the manipulated object.
- Pose Optimization, which adjusts the robot's trajectory to meet kinematic constraints.
- A Linear Model Predictive Controller (Linear MPC), which executes the final robot reference trajectory and incorporates the required manipulation forces into the predictive model.

3. **Validation Experiments**: The effectiveness of this framework is validated through simulations and hardware experiments. The experimental results show that, when interacting with heavy objects, this method offers higher stability and task completion capability compared to traditional Model Predictive Controllers (MPC) that only consider mobility.

In summary, the main goal of this paper is to develop a control framework that can effectively handle dynamic disturbances during object manipulation, enabling legged robots to perform various tasks in complex environments, such as carrying heavy objects and opening doors.