2025-11-10T03:03:08.769835

Extending First-order Robotic Motion Planners to Second-order Robot Dynamics

Sawant, Tayebi

This paper extends first-order motion planners to robots governed by second-order dynamics. Two control schemes are proposed based on the knowledge of a scalar function whose negative gradient aligns with a given first-order motion planner. When such a function is known, the first-order motion planner is combined with a damping velocity vector with a dynamic gain to extend the safety and convergence guarantees of the first-order motion planner to second-order systems. If no such function is available, we propose an alternative control scheme ensuring that the error between the robot's velocity and the first-order motion planner converges to zero. The theoretical developments are supported by simulation results demonstrating the effectiveness of the proposed approaches.

academic

Extending First-order Robotic Motion Planners to Second-order Robot Dynamics

基本信息

论文ID: 2503.17589
标题: Extending First-order Robotic Motion Planners to Second-order Robot Dynamics
作者: Mayur Sawant, Abdelhamid Tayebi (Lakehead University)
分类: cs.RO cs.SY eess.SY
发表时间: 2025年10月10日 (arXiv v2)
论文链接: https://arxiv.org/abs/2503.17589

动力学不匹配问题：大多数导航策略假设机器人运动由速度控制的一阶模型支配，但实际机器人系统通常由二阶动力学建模
安全性保障：直接将一阶规划器应用于二阶系统可能导致超调，使系统进入不安全区域
几何限制：现有二阶系统导航方法在可处理的障碍物几何形状方面受限

研究动机

现有一阶运动规划器（如5, 8）能够在复杂几何形状障碍物环境中确保安全导航，但直接应用于二阶系统会失去安全性保证。因此需要设计控制方案，将一阶运动规划器的适用性扩展到二阶动力学系统。

核心贡献

扩展安全性和收敛性保证：将一阶运动规划器的安全性和收敛性保证扩展到二阶系统，使其能够在复杂障碍物几何环境中导航
无需无限势函数：与现有方法1, 10不同，不需要人工势函数在接近障碍物边界时趋于无穷
放宽初始条件限制：与参考调节器方法13, 14不同，对机器人初始速度没有限制
两种互补控制方案：提出动态阻尼反馈(DDF)和速度跟踪反馈(VTF)两种控制策略

方法详解

任务定义

设计反馈控制律u使得二阶系统：

ẋ = v
v̇ = u

保证安全性和目标状态(x = xd, v = 0)的渐近稳定性，已知一阶系统ẋ = vd保证安全性和目标位置x = xd的渐近稳定性。

基本假设

假设1（环境约束）：

自由空间Xr路径连通
存在δu > 0使得不安全区域满足：最近点唯一性、Hessian矩阵有界性和对称性

假设2（一阶规划器性质）：

ω-极限集为E ∪ {xd}，其中E只包含孤立平衡点
xd几乎全局渐近稳定
所有平衡点处Jacobian矩阵特征值实部非零
靠近障碍物时满足vd(x)⊤η(x) ≥ μ > 0
vd(x)有界

控制方案设计

方案1：动态阻尼反馈(DDF)控制

适用条件：已知标量函数φ(x)使得vd(x) = -k₁∇ₓφ(x)

控制律：

ud(x,v) = -k₁∇ₓφ(x) - kdβ(dx)v

动态增益函数：

β(p) = {
  1,           p ≥ ε₂
  φ(p),        ε₁ ≤ p ≤ ε₂  
  p⁻¹,         0 < p ≤ ε₁
}

其中dx = d(x,OW) - r是到障碍物的安全距离。

方案2：速度跟踪反馈(VTF)控制

适用条件：一阶规划器vd(x)连续可微且∇ₓvd(x)有界

控制律：

uv(x,v) = -kdβ(dx)(v - vd(x)) + ∇ₓvd(x)⊤v

技术创新点

自适应阻尼机制：根据机器人与障碍物的距离动态调整阻尼增益，远离障碍物时保持低阻尼实现快速运动，接近障碍物时增加阻尼确保安全
理论保证：
- 定理1：DDF控制确保X°r × Rⁿ前向不变，(xd,0)几乎全局渐近稳定
- 定理2：VTF控制确保速度误差‖v(t)-vd(x(t))‖单调递减，(xd,0)几乎全局渐近稳定
无需势函数发散：不同于传统方法，不需要势函数在障碍物边界处趋于无穷