[論文レビュー] A Collision-Free MPC for Whole-Body Dynamic Locomotion and Manipulation

Jia-Ruei Chiu, Jean-Pierre Sleiman+3 more|arXiv (Cornell University)|Feb 24, 2022

Robotic Locomotion and Control被引用数 2

ひとこと要約

本論文は、脚立型移動ロボットにおける全身動的歩行および操作のためのリアルタイムで衝突のないModel Predictive Control (MPC)フレームワークを提示する。簡略化された衝突プリミティブからの符号付き距離に基づくソフト制約を組み込み、事前に計算されたユークリッド符号付き距離場（ESDF）を活用することで、計算コストがわずかに12%増加するのみで、ハードウェア上でもリアルタイムMPC性能を維持しながら、動的環境における安全で協調的な運動を実現する。

ABSTRACT

In this paper, we present a real-time whole-body planner for collision-free legged mobile manipulation. We enforce both self-collision and environment-collision avoidance as soft constraints within a Model Predictive Control (MPC) scheme that solves a multi-contact optimal control problem. By penalizing the signed distances among a set of representative primitive collision bodies, the robot is able to safely execute a variety of dynamic maneuvers while preventing any self-collisions. Moreover, collision-free navigation and manipulation in both static and dynamic environments are made viable through efficient queries of distances and their gradients via a euclidean signed distance field. We demonstrate through a comparative study that our approach only slightly increases the computational complexity of the MPC planning. Finally, we validate the effectiveness of our framework through a set of hardware experiments involving dynamic mobile manipulation tasks with potential collisions, such as locomotion balancing with the swinging arm, weight throwing, and autonomous door opening.

研究の動機と目的

• 動的でごみだらけの環境における、脚立型移動アームの安全でリアルタイムな全身運動計画を可能にする。
• ヒューリスティックな後処理やオフライン計画に依存せずに、自己衝突および環境衝突回避の課題に対処する。
• ベースの運動とアーム操作を統合的に最適化する、統一されたMPCフレームワークに衝突回避を統合する。
• 追加の衝突制約にもかかわらず、リアルタイムMPC周波数を維持するための計算効率を確保する。
• スイングアームでのバランス、ウェイトトス、自動ドア開錠といった動的タスクを含むハードウェア実験で、その頑健性を実証する。

提案手法

• Model Predictive Control (MPC) を用いた多点接触最適制御問題において、自己衝突および環境衝突回避をソフト制約として定式化する。
• 計算コストを低減しつつも精度を維持するため、ロボットを簡略化された衝突プリミティブ（例：球体やカプセル）で表現する。
• FIESTAマップからの事前計算済みのユークリッド符号付き距離場（ESDF）を用いて、ロボットプリミティブと障害物との間の距離および勾配を効率的に照会する。
• 簡略化モデルの全プリミティブペア間でナイーブな距離照会戦略を適用するが、滑らかな勾配と低いオーバーヘッドのおかげで、ブロードフェーズマネージャーよりも優れた性能を発揮する。
• MPCのコスト関数に符号付き距離をペナルティ化することで、安全な分離を促進し、ソルバーの収束を可能にするために最小距離閾値を設ける。
• 15 HzでリアルタイムLiDARを用いた環境更新を実施し、静的および動的障害物を検出する。衝突回避は、キャッシュされた距離および勾配データに依存する。

実験結果

リサーチクエスチョン

• RQ1 動的で全身の歩行と操作が行われる状況下で、統一されたMPCフレームワークがリアルタイムに自己衝突および環境衝突を効果的に回避できるか？
• RQ2 衝突回避に伴う計算コストの増加が、MPC周波数およびリアルタイム実行可能性に与える影響は何か？
• RQ3 詳細モデルと比較して、簡略化されたプリミティブを用いた衝突検出戦略の精度と効率のトレードオフは何か？
• RQ4 直接的なOctoMapベースの近接照会と比較して、事前計算済みのESDFを使用する利点は、計算コストと勾配の滑らかさの観点でどう異なるか？
• RQ5 本フレームワークは、接近する人間や移動する物体といった動的障害物を、安全面や性能に悪影響を及げることなくどれほど処理できるか？

主な発見

• 提案手法は、衝突回避なしのブラインドケースと比較して、MPCの計算時間をわずかに11.97%増加させるにとどまり、ハードウェア上でのリアルタイム動作を可能にする。
• 簡略化モデルを用いたナイーブな距離照会戦略は、理論的には最適化が不十分でも、滑らかな勾配場と低いオーバーヘッドのおかげで、ブロードフェーズマネージャーよりも優れた性能を発揮する。
• OctoMapを用いた形状プリミティブによる衝突照会は、セル数が多く、勾配の不連続性があるため、ブラインドケースと比較して19倍も計算コストが高くなる。
• 本フレームワークは、スイングアームを用いたバランス、バックワードウェイトトス、自動ドア開錠といったハードウェアデモンストレーションを成功裏に実施し、静的障害物および接近する人間を効果的に回避した。
• 盲点や15 Hzの更新レートといったLiDARの制限があっても、本手法は依然として頑健に機能するが、動的障害物の速度は、閾値内に突然出現しないように制限する必要がある。
• 最小距離閾値を設けたソフト制約により、ソルバーは信頼性高く収束する一方で、実際の衝突は防止される。これは、ハード制約よりもペナルティベースの回避戦略の有効性を示している。