cs.RONov 6, 2026

Capturability-Aware Footstep Planning in Cluttered Environments: A Recursively Feasible Sequential MPC on Axis-Aligned Safe Corridors

Authors: Athanasios Kyriakopoulos, Shubham S. Kumbhar, Kunal S. Narkhede, Abhijeet M. Kulkarni, Ioannis Poulakakis

Organizations: A. Kyriakopoulos was with the School of Mechanical Engineering, National Technical University of Athens, Athens, Greece, when this work was conducted. He is now with the Department of Mechanical Engineering, University of California, Berkeley, CA 94720, USA · S. S. Kumbhar, K. S. Narkhede, and A. M. Kulkarni are with the Department of Mechanical Engineering, University of Delaware, Newark, DE 19716, USA · I. Poulakakis is with the School of Mechanical Engineering, National Technical University of Athens, Athens, Greece, and HERON—Hellenic Center of Excellence in Robotics, Athena Research Center, Athens, Greece

Abstract

A fundamental aspect of humanoid footstep planning is to jointly guarantee obstacle avoidance and locomotion stability. This paper presents a capturability-aware sequential Model Predictive Control (MPC) framework for Linear Inverted Pendulum (LIP)-based humanoid footstep planning in the presence of obstacles. The proposed method combines obstacle avoidance with capturability constraints through safe corridors constructed as sequences of intersecting rectangles, yielding a sequential MPC framework with recursive feasibility guarantees for the LIP-based planning layer. The planner autonomously adapts to constrained scenarios, switching to in-place walking when obstructions---such as doors assumed to be open during planning but unexpectedly found to be closed during execution---block forward motion. Performance is largely independent of the prediction horizon, allowing high success rates while keeping the computational cost low. The approach is validated in high-fidelity simulations with the humanoid robot Digit, demonstrating a practical solution for capturable humanoid footstep planning in cluttered environments.

Figures & tables

Explore similar work

CardsList
  1. Perceptive Variable-Timing Footstep Planning for Humanoid Locomotion on Disconnected Footholds

    Mar 8, 2026Zhaoyang Xiang, Upama Pant, Ayonga HereidHumanoid Robot LocomotionTerrain-Aware Robot Locomotion

  2. Probabilistic Recursively Feasible Motion Planning Under Uncertain Environments

    May 18, 2026Hyeontae Sung, Hyeongchan Ham, Junyoung Park +2Constrained Motion PlanningChance-Constrained Motion Planning

  3. LiDAR-based Humanoid Navigation in Dynamic, Non-Convex Environments via Spatio-Temporal Safe Corridors

    Oct 12, 2026Shubham S. Kumbhar, Panagiotis ArtemiadisRobot NavigationSafe Motion Planning