精确计算多面体间的距离函数,实现机器人安全避障的非保守控制。
Exact Signed-Distance Control Barrier Functions via Minkowski Operations for Safe Navigation among Polytopes
- 基于闵可夫斯基运算构建多面体间精确符号距离函数。
- 在纯平移与自行车模型中实现安全恢复与多障碍避障。
- 揭示几何与运动约束耦合引发的新类局部极小点,适合复杂环境导航研究。
在尊重系统动力学、控制能力和精确几何的前提下,安全导航多面体环境是机器人领域的挑战。控制屏障函数(CBFs)通过使安全集前向不变来合成安全控制策略,但现有方法常使用球体或椭球等保守光滑形状近似多面体,以获得显式的可微距离函数。本文提出针对多面体机器人与多面体障碍物的精确符号距离函数(SDF)形式,并结合非光滑CBFs。利用闵可夫斯基运算,该方法在无碰撞(正号)与碰撞(负号)情形下均通过配套凸规划求解精确SDF。进一步地,借助二维闵可夫斯基运算的几何特性及两个配套凸规划的最优性条件,通过敏感性分析推导出精确SDF梯度的统一解析表达式。精确旋转梯度揭示了由几何与非完整运动学耦合导致的此前被掩盖的一类局部极小点。通过纯平移案例和三种涉及自行车模型的场景——包括从不安全初始化恢复、单障碍与多障碍避障——验证了该框架的有效性。与基线方法对比表明,所提框架支持非保守机动并实现安全恢复。
原文摘要 · Abstract (English)
Safely navigating polytopic environments while respecting the dynamics, control, and exact geometry of the underlying system is a challenge in robotics. Control barrier functions (CBFs) synthesize safe control policies by rendering the safe set forward invariant, but many existing CBF-based methods approximate polytopes using conservative smooth shapes, such as spheres or ellipsoids, to obtain explicit differentiable distance functions. In this article, we propose an exact Signed Distance Function (SDF) formulation for a {\it polytopic} robot and {\it polytopic} obstacles and integrate it with nonsmooth CBFs. Leveraging Minkowski operations, the proposed method computes the exact SDF via companion convex programs in both the collision-free (positive-sign) and in-collision (negative-sign) cases. Furthermore, by exploiting the convenient geometric properties of 2D Minkowski operations and the optimality conditions of the two companion convex programs, we derive a unified analytical expression for the gradient of the exact SDF via sensitivity analysis. The exact rotational gradient further reveals a previously masked class of local minima induced by the coupling between geometry and nonholonomic kinematics. We demonstrate the effectiveness of the proposed framework through a pure-translation case and three scenarios with unicycle models involving recovery from an unsafe initialization and single- and multiple-obstacle avoidance. Comparisons with baseline methods highlight how the proposed framework enables non-conservative maneuvers and safety recovery.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。