Abstract:In the control task of mobile manipulators(MM), achieving efficient and agile obstacle avoidance in dynamic environments is challenging. In this letter, we present a safe expeditious whole-body(SEWB) control for MMs that ensures both external and internal collision-free. SEWB is constructed by a two-layer optimization structure. Firstly, control barrier functions(CBFs) are employed for a MM to establish initial safety constraints. Moreover, to resolve the pseudo-equilibrium problem of CBFs and improve avoidance agility, we propose a novel sub-optimization called adaptive cyclic inequality(ACI). ACI considers obstacle positions, velocities, and predefined directions to generate directional constraints. Then, we combine CBF and ACI to decompose safety constraints alongside an equality constraint for expectation control. Considering all these constraints, we formulate a quadratic programming(QP) as our primary optimization. In the QP cost function, we account for the motion accuracy differences between the base and manipulator, as well as obstacle influences, to achieve optimized motion. We validate the effectiveness of our SEWB control in avoiding collision and reaching target points through simulations and real-world experiments, particularly in challenging scenarios that involve fast-moving obstacles. SEWB has been proven to achieve whole-body collision-free and improve avoidance agility, similar to a "martial arts dodge".
What problem does this paper attempt to address?
### The Problem the Paper Attempts to Solve
This paper aims to address the problem of efficient and agile obstacle avoidance for Mobile Manipulators (MM) in dynamic environments. Specifically, the researchers propose a Safe Expeditious Whole-Body (SEWB) control method to ensure that mobile manipulators can avoid collisions with external obstacles and their own components while performing tasks. The SEWB control method is implemented through a two-layer optimization structure, where the first layer uses Control Barrier Functions (CBFs) to establish initial safety constraints, and the second layer introduces a new sub-optimization method—Adaptive Cyclic Inequality (ACI)—to resolve the pseudo-equilibrium point problem of CBFs and enhance obstacle avoidance agility.
### Main Contributions
1. **Proposed a Safe Expeditious Whole-Body (SEWB) control method**: Based on a two-layer optimization structure, it ensures that mobile manipulators can efficiently avoid obstacles in dynamic environments while preventing internal collisions. SEWB can be used for global planning or rapid response local planning.
2. **Introduced Adaptive Cyclic Inequality (ACI)**: Combined with CBFs to establish safety constraints, it not only solves the pseudo-equilibrium point problem in traditional CBFs methods but also enhances obstacle avoidance agility, achieving capabilities similar to "martial arts dodging." To the best of the authors' knowledge, this is the first method to achieve efficient obstacle avoidance for mobile manipulators.
3. **Validated the effectiveness and stability of the method through simulations and physical experiments**: Tested in complex scenarios with fast-moving obstacles, verifying the performance, effectiveness, and stability of the SEWB control method.
### Research Background
Mobile manipulators have been widely used in fields such as manufacturing, intelligent catering, daily assistance, and medical services due to their enhanced workspace and versatility. However, programming robots to complete tasks in dynamic environments remains a challenge. Specifically, mobile manipulators need to interact highly flexibly in an unrestricted workspace, requiring control systems to generate fast, accurate, and coordinated whole-body movements while considering multiple points of contact with the environment. This need is particularly urgent in dynamic and obstacle-rich environments.
Existing methods such as sequential base-manipulator control, Reinforcement Learning (RL)-based methods, sampling-based methods, and reactive systems, although making progress in some aspects, still suffer from slow response speeds and poor adaptability. Therefore, this paper proposes a new control method to achieve efficient obstacle avoidance for mobile manipulators in dynamic environments.
### Method Overview
1. **System Modeling**: Describes the system model of the mobile manipulator, including the degrees of freedom of the base and manipulator, position dynamics, and Jacobian matrix.
2. **Control Barrier Functions (CBFs)**: Introduces the basic concepts of CBFs and their application in robotic systems.
3. **Adaptive Cyclic Inequality (ACI)**: Explains in detail the design principles and implementation methods of ACI, and how it combines with CBFs to form the main optimization problem.
4. **Optimization Method**: Combines safety constraints and desired motion objectives through Quadratic Programming (QP) to form an optimization problem.
5. **Internal and External Safety Constraints**: Introduces the external safety constraints of the mobile base and manipulator, as well as the internal safety constraints of the system, ensuring that the robot does not experience self-collision during movement.
6. **Stability Analysis**: Provides a weak form Lyapunov stability analysis of the SEWB control method, proving the non-increasing nature of the controller in subsets away from obstacles.
### Experimental Validation
The effectiveness and stability of the SEWB control method were validated through simulations and physical experiments. The experimental results show that the SEWB control method can efficiently avoid obstacles in dynamic environments and performs excellently when facing fast-moving obstacles.
### Conclusion
This paper proposes a new SEWB control method that successfully solves the problem of efficient obstacle avoidance for mobile manipulators in dynamic environments. By introducing ACI, it not only enhances obstacle avoidance agility but also resolves the pseudo-equilibrium point problem in traditional CBFs methods.