arXiv:2605.15999cs.ROcs.SY2026-05

用新代价函数让变形四旋翼在窄道中安全穿越,感知受限下仍高效避障。

Constrained MPC-Based Motion Planning for Morphing Quadrotors in Ultra-Narrow Passages under Limited Perception

论文配图:Constrained MPC-Based Motion Planning for Morphing Quadrotors in Ultra-Narrow Passages under Limited Perception
图 1 · 摘自论文原文
  • 设计平滑指数型障碍代价函数,避免传统方法在窄道中误判阻塞
  • 2D LiDAR直接输入MPC,在有限感知下实现窄通道成功通过
  • 算法通用性强,适用于各类移动机器人,代码开源可复用

本文提出一种面向变形四旋翼在极端受限环境下的运动规划框架,同时规划形态与轨迹。针对2D LiDAR感知受限场景,设计了一种新型非线性模型预测控制(MPC)障碍规避代价函数,克服了传统人工势场法在窄道中因代价过高而人为阻断路径的问题。所提方法采用平滑指数型代价,保持窄道内低通行成本的同时维持强碰撞规避能力,避免硬阈值激活,并引入代价衰减因子降低窄道内代价。直接将2D LiDAR测量值用于MPC,实现对任意形状障碍物的绕行。该方法基于acados构建的非线性MPC框架,仿真与实验结果均表明,其可在典型排斥代价函数失效的狭窄走廊中成功通行。该方案计算高效且实用,兼顾安全性与可行性。尽管应用于变形四旋翼平台,但代价函数设计具有普适性,适用于任意移动机器人系统。实现代码已公开于GitHub,视频演示链接见文后。

原文摘要 · Abstract (English)

This paper introduces a motion planning framework to plan morphology and trajectory for morphing quadrotors under extremely constrained environments. We develop a novel obstacle avoidance cost function for nonlinear model predictive control (MPC) that enables navigation through extremely narrow gaps under limited perception from a 2D LiDAR. Classical artificial potential field-based costs typically have a high cost in narrow passages, artificially blocking the navigable path. In contrast, we propose a smooth exponential obstacle cost that preserves low traversal cost within narrow gaps while maintaining strong collision avoidance behavior. The formulation avoids hard activation thresholds and introduces a cost reduction factor to reduce the cost within narrow passages. Direct use of 2D LiDAR measurements in MPC allows navigation around arbitrarily shaped obstacles. The method is embedded within an acados-based nonlinear MPC framework. Simulation and experimental results demonstrate successful traversal of narrow corridors where typical repulsive cost functions would fail. The approach provides a computationally efficient and practical solution for navigating through tight spaces while maintaining safety from the obstacles. While we are implementing the framework on the morphing quadrotors, the cost function formulation is general-purpose for any mobile robot application, and is not limited to the morphing quadrotors. The implementation code is available at \href{https://github.com/harshjmodi1996/morphocopter_mpc}{Github Repo} and a short video is available at \href{https://zh.engr.tamu.edu/wp-content/uploads/sites/310/2026/03/MPC_MorphoCopter_video.mp4}{Video Link}.

运动规划四旋翼避障MPC

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。