Abstract:Implementing obstacle avoidance in dynamic environments is a challenging problem for robots. Model predictive control (MPC) is a popular strategy for dealing with this type of problem, and recent work mainly uses control barrier function (CBF) as hard constraints to ensure that the system state remains in the safe set. However, in crowded scenarios, effective solutions may not be obtained due to infeasibility problems, resulting in degraded controller performance. We propose a new MPC framework that integrates CBF to tackle the issue of obstacle avoidance in dynamic environments, in which the infeasibility problem induced by hard constraints operating over the whole prediction horizon is solved by softening the constraints and introducing exact penalty, prompting the robot to actively seek out new paths. At the same time, generalized CBF is extended as a single-step safety constraint of the controller to enhance the safety of the robot during navigation. The efficacy of the proposed method is first shown through simulation experiments, in which a double-integrator system and a unicycle system are employed, and the proposed method outperforms other controllers in terms of safety, feasibility, and navigation efficiency. Furthermore, real-world experiment on an MR1000 robot is implemented to demonstrate the effectiveness of the proposed method.
What problem does this paper attempt to address?
The problem that this paper attempts to solve is to achieve obstacle avoidance for robots in dynamic environments. Specifically, the paper focuses on how to design a safety - critical controller that can ensure the safe navigation of robots in crowded or complex dynamic environments. Although existing methods such as model predictive control (MPC) combined with control barrier functions (CBF) can solve the problem to a certain extent, in complex environments, the optimization problem may have no solution due to hard constraints, thus affecting the performance of the controller. Therefore, the paper proposes a new MPC framework. By softening CBF constraints and introducing exact penalty functions, and extending the generalized CBF as a single - step safety constraint, it improves the obstacle - avoidance effect in dynamic environments while ensuring safety and navigation efficiency.
### Main Contributions
1. **Propose an MPC framework based on CBF soft constraints**: It is used to generate safe and collision - free trajectories in dynamic environments.
2. **Introduce dynamic generalized CBF (D - GCBF) as a single - step hard constraint**: To enhance safety.
3. **Verify the real - time ability, effectiveness and stability of the algorithm through simulation experiments and practical tests**.
### Solutions
1. **Soft - constraint predictive control**:
- Convert CBF hard constraints into soft constraints, and introduce slack variables and penalty functions to ensure the feasibility of the optimization problem.
- By choosing an appropriate penalty weight, make the optimization problem under soft constraints equivalent to that under hard constraints when feasible.
2. **Safety enhancement**:
- Introduce D - GCBF as a single - step hard constraint to simplify multi - step constraints, reduce computational complexity, and enhance feasibility.
- Ensure the safety of the system in dynamic environments through theoretical proof and experimental verification.
### Experimental Verification
- **Simulation experiment**: Use Python and Casadi for modeling, and perform simulations on the Ubuntu 20.04 system through the IPOPT solver.
- **Practical test**: Conduct experiments on the MR1000 robot to verify the effectiveness of the algorithm.
### Quantitative Evaluation
- **Double - integral system**:
- Compare the performance indicators of different controllers, including the success rate of reaching the destination (S), the collision rate (C), the average navigation time (T), the number of solution failure times (FS), and the average solution time (ST).
- The results show that the proposed framework is superior to other methods in terms of success rate, safety, navigation time, and solution stability.
- **Single - wheel vehicle system**:
- Similarly, evaluate the controllers of the single - wheel vehicle system, and the results also show that the new framework performs better in dynamic environments.
### Conclusion
By introducing softened CBF constraints and D - GCBF single - step hard constraints, the paper successfully solves the problems of no solution to the optimization problem and insufficient safety in robot obstacle avoidance in dynamic environments. The experimental results verify the effectiveness of this method in improving navigation efficiency and safety.