Time-Optimal Switching Surfaces for Triple Integrator under Full Box Constraints

技術的概要：完全な箱制約下における三重積分器の時間最適スイッチング曲面

問題定義
本論文は、完全な箱制約を受ける三重積分器システムの時間最適制御問題に取り組みます。システムダイナミクスには、ジャーク制限付き制御入力（$u$）と、位置（$x_1$）、速度（$x_2$）、加速度（$x_3$）に関する状態制約が含まれます。目的は、任意の初期状態 $\mathbf{x}_0$ から固定された終端状態 $\mathbf{x}_f$ へ、最小時間 $t_f$ でシステムを遷移させることです。

二重積分器の時間最適制御はよく理解されていますが、三重積分器の場合は特に以下の点において重大な課題を呈します：

1. 非対称制約：ジャークおよび状態の上限と下限の絶対値が等しくない場合。
2. 非定常な境界条件：任意の初期状態および終端状態。
3. アクティブな位置制約：軌道が位置制約境界（$x_3 = \bar{x}_3$ または $x_3 = \underline{x}_3$）に接するか、その境界に沿ってスライドする必要があるシナリオ。

既存の解決策、例えば商用の Ruckig アルゴリズム（コミュニティ版）は、非対称制約やアクティブな位置制約の下ではしばしば失敗します。以前の解析的アプローチは、状態制約を無視するか、対称な制約を仮定するか、あるいはスイッチング曲面と位置制約のアクティブ条件の完全な特徴付けを提供しなかったかのいずれかでした。

手法
著者は、ポントリャーギンの最大原理（PMP）を用いて最適制御則を特徴付け、これはバン・バン・シンギュラー（BBS）構造に従います。手法の核心は、時間最適スイッチング曲面を導出するための状態空間の幾何学的解析にあります。

1. 拡張スイッチング則（ASL）：最適軌道は、弧の列（制約のないバン・バン弧と、状態が固定される制約付き弧）および「接線マーカー」として表現されます。接線マーカーは、位置制約が接線的にアクティブになる際に発生します（すなわち、$x_3 = \bar{x}_3$、$x_2 = 0$、かつ $x_1 \geq 0$）。
2. スイッチング曲面の構築：
   • 位置制約なし：著者は、終端状態 $\mathbf{x}_f$ から後方積分を行うことでスイッチング多様体を構築します。これにより、特定の ASL（例：$\bar{0}\bar{0}\bar{0}$、$\bar{0}\bar{1}\bar{0}\bar{0}$）に対応する曲面を定義し、3 次元状態空間を分割します。
   • 位置制約あり：本論文は、位置制約がアクティブになる具体的な条件を導出します。位置境界に接する軌道を考慮した新しいスイッチング曲面（例：$\bar{0}(\bar{3}, 2)\bar{0}\bar{0}\bar{0}$）を導入します。定理 2 は、完全な箱制約を受ける三重積分器のすべての可能な ASL 形式の完全な分類を提供し、最適軌道が制約のない弧と接線マーカーの列から構成されることを確立します。
3. アルゴリズム的実装：
   • アルゴリズム 1：2 次射影を分析することで $\mathbf{x}_0$ と $\mathbf{x}_f$ の間の相対方向を決定し、スイッチング曲面が多価となる場合を処理します。
   • アルゴリズム 2：2 次最適制御を介して状態を接続し、弧の持続時間に関する多項式方程式を解くことで、位置制約なしの問題を解決します。
   • アルゴリズム 3：完全な箱制約への解を拡張します。制約のない解が位置制約に違反する場合、アルゴリズムは状態を定理 2 に基づいて導出された接線マーカーに再帰的に接続し、部分問題を解決します。
   • 弧の持続時間に関する方程式系は、グロブナー基底を用いて解かれ、問題は次数 $\leq 6$ の単一の多項式方程式に還元されます。

主な貢献

• スイッチング曲面の完全な特徴付け：本論文は、完全な箱制約下における三重積分器の時間最適スイッチング曲面、アクティブな位置制約を伴う解の幾何学的構造を含む、初めて完全な解析的特徴付けを提供します。
• アクティブ条件の導出：本論文は、位置制約がアクティブになる条件（「接線マーカー」条件）を明示的に導出しており、これは以前文献に欠けていたギャップです。
• 定理 2（ASL 分類）：本論文は、この問題に対する許容される拡張スイッチング則の完全な集合を確立し、最適軌道が接線マーカーを含む特定の列に従うことを証明します。
• 効率的なアルゴリズム：任意の境界状態と非対称制約に対して時間最適軌道を計画するアルゴリズムが提案されました。

結果
提案された手法は、3 つのベースライン（Ruckig（コミュニティ版）、CasADi（IPOPT ベース）、SCP（逐次凸計画法））に対して評価されました。

• 成功率：提案手法は、対称な場合（ケース 1）と非対称かつアクティブな位置制約を伴う場合（ケース 2）の両方で、実行可能な解を見つける際に100% の成功率を達成しました。対照的に、Ruckig は非対称性によりケース 2 で失敗し、SCP/CasADi は有意に低い成功率を示しました（ケース 2 においてそれぞれ 34.1% および 97.7%）。
• 計算効率：軌道あたりの平均計算時間は約10 $\mu$s（具体的にはケース 1 で $2.38 \times 10^{-6}$ 秒、ケース 2 で $1.25 \times 10^{-5}$ 秒）でした。これは、最適化ベースのベースライン（CasADi：約 0.28 秒；SCP：約 7.28 秒）と比較して5 桁の削減を表します。
• 最適性：この手法は一貫して大域的最適解を見つけました。最適化ベースの手法が局所最適（亜最適 ASL）に収束したテストケースにおいて、提案手法は終端時間を最大90.9%（ケース 1）および73.4%（ケース 2）削減しました。

重要性
著者は、この研究が非定常な終端条件およびアクティブな位置制約下における 3 次時間最適制御問題に対する、最初の完全なスイッチング曲面の特徴付けと効率的なアルゴリズムを提供すると主張しています。反復最適化から幾何学的・解析的解へと移行することで、本論文は、高精度かつ時間最適制御がマイクロ秒レベルの計算時間で達成可能であることを実証しており、制約がしばしば非対称かつアクティブとなるロボット運動や数値制御加工などのリアルタイム産業用途に極めて適していることを示しています。