[论文解读] Correct-by-Construction Navigation Functions with Application to Sensor Based Robot Navigation

Savvas G. Loizou, Elon Rimon|arXiv (Cornell University)|Mar 7, 2021

Robotic Path Planning Algorithms参考文献 9被引用 6

一句话总结

该论文提出了一种基于调和函数与导航变换的构造性导航函数，用于未知环境中的机器人导航，无需参数调优。通过将增益参数 $ k $ 显式地定义为障碍物数量的函数，该方法确保了全局渐近稳定性，并支持在局部感知具有扇区限制的情况下实现障碍物的实时动态集成，通过运动学与动力学控制器得到验证，保证了临界阻尼与有界速度。

ABSTRACT

This paper brings together the concepts of navigation transformation and harmonic functions to form navigation functions that are correct-by-construction in the sense that no tuning is required. The form of the navigation function is explicitly related to the number of obstacles in the environment. This enables application of navigation functions for autonomous robot navigation in partially or fully unknown environments, with the capability of on-the-fly adjustment of the navigation function when new obstacles are discovered by the robot. Appropriate navigation controllers, applicable to robots with local, sector bounded sensing, are presented and analyzed for a~kinematic point-mass robot and then for the dynamic point-mass robot system. The closed form nature of the proposed navigation scheme provides for online, fast-feedback based navigation. In addition to the analytic guarantees, simulation studies are presented to verify the effectiveness of the methodology.

研究动机与目标

• 通过构造性方法消除导航函数中参数调优的需求。
• 在机器人导航过程中，实现对部分已知环境中新发现障碍物的实时集成。
• 支持任意非零扇区有界局部感知，建模真实传感器（如激光扫描仪）的行为。
• 设计运动学与动力学控制器，避免在鞍点附近出现向量场停滞，并确保临界阻尼。
• 在仅部分已知工作空间知识的条件下，提供稳定性、有界速度与避碰的解析保证。

提出的方法

• 通过从原始机器人工作空间经导航变换导出的点世界模型，使用调和函数构造导航函数。
• 显式地将增益参数 $ k $ 定义为障碍物数量 $ M $ 的函数，确保无需调优即可实现构造性正确行为。
• 应用松弛的莫尔斯性质，在避免临界点退化的同时保持拓扑稳定性。
• 设计运动学控制器 (18)，通过匹配导航函数等高线集的动能，防止在鞍点附近出现减速。
• 为二阶系统设计动力学控制器 (22)，通过基于能量的控制与耗散机制，实现临界阻尼与有界最大速度。
• 采用与机器人速度对齐的对称感知扇区模型 (3)，反映真实传感器限制，支持反应式导航。

实验结果

研究问题

• RQ1 能否通过显式关联增益 $ k $ 与障碍物数量，实现无需参数调优的导航函数构造？
• RQ2 当机器人运动过程中检测到新障碍物时，导航函数如何实现动态更新？
• RQ3 仅使用扇区有界局部感知（即使存在非零角 aperture）是否也能实现稳定且无碰撞的导航？
• RQ4 能否设计导航函数的向量场，以避免运动学系统在鞍点附近的停滞？
• RQ5 在所提出的控制律下，动力学系统能否实现临界阻尼与有界速度，同时保持全局渐近稳定性？

主要发现

• 所提出的导航函数具有构造性正确性：无需对 $ k $ 进行调优，因为 $ k $ 已显式定义为障碍物数量 $ M $ 的函数。
• 运动学控制器 (18) 确保全局渐近稳定性，并通过匹配导航函数等高线集的动能，避免在鞍点附近出现向量场停滞。
• 动力学控制器 (22) 实现了在目标处的临界阻尼，并对最大速度进行了约束，仿真中 $ \norm{\boldsymbol{\text{v}}}_{\text{max}} = 0.93 \, \text{m/s} $，远低于理论最大值 $ 4.47 \, \text{m/s} $。
• 系统成功实现了动态障碍物发现：在仿真中，机器人在无碰撞情况下穿越了六个依次检测到的障碍物。
• 在仅部分工作空间知识与扇区有界感知条件下，控制器仍保持稳定与收敛，即使在 $ \theta = 60^\circ $ 时也表现出鲁棒性，证明了对有限感知的适应能力。
• 提供了关于稳定性、有界速度与临界阻尼的解析保证，仿真结果验证了理论预测。