Proactive Local-Minima-Free Robot Navigation: Blending Motion Prediction with Safe Control

Dynamic multi-obstacle navigation is challenging due to sudden obstacle motion, future feasibility, and concave unsafe regions arising from obstacle geometry or clustering and overlap. We propose MMP-MCBF, integrating multimodal motion prediction, online barrier learning, and adaptive modulated CBF-QP control for proactive, efficient navigation in dynamic non-convex environments.

IEEE Robotics and Automation Letters (RA-L) 2026
ADMM-MCBF-LCA: A Layered Control Architecture for Safe Real-Time Navigation

A layered control architecture for safe real-time navigation among moving obstacles under input saturation constraints, combining offline path generation with online path selection and safety-ensured and liveness-enhanced control based on modulated control barrier functions (CBFs) to mitigate infeasibility during collision avoidance.

IEEE International Conference on Robotics and Automation (ICRA) 2025
Memory-Aware Multi-Sensor Perception for Efficient and Safe Navigation in Dynamic Environments

Existing perception-based methods often rely on prior maps or short-horizon observations, limiting their ability to exploit previously observed structure and compromising liveness and goal convergence. These limitations motivate a memory-aware navigation framework that builds a persistent environment representation online and leverages it for liveness-aware collision avoidance without requiring an offline map.

Under Review
Towards Feasible Dynamic Grasping: Leveraging Gaussian Process Distance Field, SE(3) Equivariance and Riemannian Mixture Models

A Gaussian Process Distance Field-based framework for dynamic grasping that combines shape reconstruction, equivariant grasp sampling, and reachability-aware pose selection.

IEEE International Conference on Robotics and Automation (ICRA) 2024

No Undesirable Equilibria, No Collisions: Combining Modulation and Control Barrier Functions for Liveness and Safety in Dynamic Collision Avoidance

Department of Mechanical Engineering and Applied Mechanics, University of Pennsylvania
Under Review

We validate the proposed MCBF-QP controllers in simulated hospital settings and in real-world experiments on fully actuated Ridgeback robots and underactuated Fetch platforms. Across all evaluations, Modulated CBF-QPs consistently outperform standard CBF-QPs.

Abstract

Control Barrier Function Quadratic Programs (CBF-QPs) provide formal safety guarantees for general control-affine systems and accommodate actuation constraints, but do not inherently guarantee liveness, i.e., sustained progress toward and convergence to a goal. They may admit undesirable equilibria or dysfunctional circulation that impede goal convergence. In contrast, Modulation of Dynamical Systems (Mod-DS) promotes liveness through geometric reshaping of nominal vector fields, but is primarily suited to fully actuated systems and does not directly accommodate general actuation constraints. We establish theoretical connections between these paradigms, showing that normal Mod-DS is a special case of CBF-QP and that reference Mod-DS is linked to CBF-QP through a shared formulation. These connections motivate the Modulated CBF-QP (MCBF-QP) framework, which incorporates geometric guidance from Mod-DS into CBF-QPs to enhance liveness while retaining formal safety and control-affine generality. We develop reference MCBF-QP, which reduces undesirable equilibria and dysfunctional circulation for star-shaped obstacles, and on-manifold MCBF-QP, which eliminates undesirable equilibria and reduces dysfunctional circulation for arbitrarily shaped concave obstacles. Although no Lyapunov function is explicitly constructed, we prove that the tangent guidance constraint introduced into the CBF-QP formulation implicitly enforces the decrease condition of a hybrid Lyapunov function, yielding asymptotic goal convergence and thus liveness under the stated assumptions. Extensive simulation and hardware experiments demonstrate safe and live obstacle avoidance with the proposed MCBF-QP framework in static and dynamic environments.

Hospital: Fully Actuated

Video 1: Reference MCBF-QP Demonstration against CBF-QP and reference Mod-DS

Video 2: on-Manifold MCBF-QP Demonstration against CBF-QP and on-Manifold Mod-DS

Hospital: Underactuated

Video 1: Shifted on-Manifold MCBF-QP Demonstration against Shifted CBF-QP

Video 2: Augumented on-Manifold MCBF-QP Demonstration against Augmented CBF-QP

Social Navigation

Social navigation performance comparison
Figure 1. Comparison of Shifted MCBF-QP, Shifted CBF-QP, and MPC-CBF (horizon = 20) in a challenging dynamic social navigation task. Blue contours in the first-column images indicate the isosurface geodesically approximated to select the proper obstacle exit strategy \( \phi(x, \bar{h}) \) in MCBF-QP,shown by the red arrow.

Static Concave Obstacles

Video 1: Shifted CBF-QP

Video 2: Shifted on-Manifold MCBF-QP

Dynamic Adversarial Attacks

Video 1: Shifted CBF-QP

Video 2: Shifted on-Manifold MCBF-QP

Soical Navigation

Video 1: Shifted CBF-QP

Video 2: Shifted on-Manifold MCBF-QP

Mixed Environment

Video: Shifted on-Manifold MCBF-QP Demonstration through 5-Trial Validation

Results Summary

table
Figure 2. Spider plot summarizing controller performance in hospital navigation at 20~Hz. Metrics include average travel duration, Safe %, Reached %, and average number of infeasible QP instances per trajectory. Values are normalized between the center and outermost layer, where a larger radial extent denotes better performance.

BibTeX

@misc{xue2026minimacollisionscombiningmodulation,
      title={No Undesirable Equilibria, No Collisions: Combining Modulation and Control Barrier Functions for Liveness and Safety in Dynamic Collision Avoidance}, 
      author={Yifan Xue and Nadia Figueroa},
      year={2026},
      eprint={2502.14238},
      archivePrefix={arXiv},
      primaryClass={cs.RO},
      url={https://arxiv.org/abs/2502.14238},
    }