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

一階ロボット運動計画器を二階ロボット動力学に拡張する

基本情報

論文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

要旨

本論文は、一階運動計画器を二階動力学に支配されるロボットシステムに拡張する。既知のスカラー関数の負勾配が与えられた一階運動計画器と整合することの知識に基づいた2つの制御スキームを提案する。このような関数が既知である場合、一階運動計画器と動的ゲインを有する減衰速度ベクトルを組み合わせることで、一階運動計画器の安全性と収束性の保証を二階システムに拡張する。このような関数がない場合、ロボット速度と一階運動計画器間の誤差がゼロに収束することを保証する代替制御スキームを提案する。理論的展開はシミュレーション結果により支持され、提案手法の有効性を実証している。

研究背景と動機

問題定義

自律ロボット航法は、ロボットを目標位置に導きながら障害物を回避することを含む。既存の航法手法は主に人工ポテンシャル場に基づいており、吸引ベクトル場がロボットを目標に向かわせ、反発ベクトル場が障害物回避を確保する。

中核的課題

動力学の不一致問題：ほとんどの航法戦略は、ロボット運動が速度制御される一階モデルに支配されると仮定するが、実際のロボットシステムは通常二階動力学でモデル化される
安全性の保証：一階計画器を二階システムに直接適用すると、オーバーシュートが生じ、システムが不安全領域に進入する可能性がある
幾何学的制限：既存の二階システム航法手法は、処理可能な障害物の幾何学的形状の点で制限されている

研究動機

既存の一階運動計画器（参考文献5, 8など）は複雑な幾何学的形状の障害物環境で安全な航法を確保できるが、二階システムに直接適用すると安全性の保証が失われる。したがって、一階運動計画器の適用性を二階動力学システムに拡張する制御スキームの設計が必要である。

中核的貢献

安全性と収束性の保証の拡張：一階運動計画器の安全性と収束性の保証を二階システムに拡張し、複雑な障害物幾何学環境での航法を可能にする
無限ポテンシャル関数の不要性：既存手法1, 10と異なり、障害物境界に接近する際にポテンシャル関数が無限大に向かう必要がない
初期条件制限の緩和：参考調節器手法13, 14と異なり、ロボット初期速度に制限がない
2つの相補的制御スキーム：動的減衰フィードバック(DDF)と速度追跡フィードバック(VTF)の2つの制御戦略を提案

手法の詳細

タスク定義

フィードバック制御則uを設計して、二階システム：

ẋ = v
v̇ = u

が安全性と目標状態(x = xd, v = 0)の漸近安定性を保証するようにする。ここで、一階システムẋ = vdが安全性と目標位置x = xdの漸近安定性を保証することが既知である。

基本的仮定

仮定1（環境制約）：

自由空間Xrは経路連結
δu > 0が存在して、不安全領域は以下を満たす：最近点の一意性、ヘッシアン行列の有界性と対称性

仮定2（一階計画器の性質）：

ω極限集合はE ∪ {xd}であり、Eは孤立平衡点のみを含む
xdはほぼ全域的に漸近安定
すべての平衡点でヤコビアン行列の固有値の実部は非ゼロ
障害物に接近する際にvd(x)⊤η(x) ≥ μ > 0を満たす
vd(x)は有界

制御スキームの設計

スキーム1：動的減衰フィードバック(DDF)制御

適用条件：vd(x) = -k₁∇ₓφ(x)を満たすスカラー関数φ(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)はほぼ全域的に漸近安定
ポテンシャル関数発散の不要性：従来の手法と異なり、障害物境界でポテンシャル関数が無限大に向かう必要がない