モバイル操作は、動くベース、胴体またはリフト、ロボットアーム、エンドエフェクターを連結させます。ナビゲーション目標がベースをオブジェクトの近くに置く場合でも、ツールは到達不可能、単独、遮蔽、衝突状態になることがあります。逆に、有利な腕のポーズは安全でない、あるいは不可能なベースアプローチを必要とする場合もあります。
システムには明確な責任を持つ層が必要です。ナビゲーションは環境内のより長い地平線の移動を扱います。ベースポーズサンプリングと到達可能性は、ツールタスクを有用な到達領域に結びつけます。連動計画や全身制御は、ベースと腕の相互作用が重要な動きを扱います。
このガイドをモバイル ロボットの計画ガイド と モーションプランニングの比較と組み合わせて活用してください。コマンド状態と測定された到着状態を別々に検証してください。
ツールタスクから始めて、最も近い基準点から始めないでください
望ましい工具のポーズ、アプローチ通路、向きの公差、接触方向、撤退を定義します。幾何学的に最も近い停止点を選ぶのではなく、この作業を実現可能なベースと胴体の候補を生成してください。
センサー視点や人間のアクセスも含めてください。基本ポーズは、ターゲットを腕の後ろに隠したり、次に開くべきキャビネットの扉を塞いでいる間に逆運動学を満たすことができます。
分離した逐次計画、連結計画、ハイブリッド計画
順次計画は腕をナビゲートし、停止し、計画します。到着の不確実性が小さく、作業が静止している場合、これはシンプルで適切です。結合計画探索はベース状態と腕状態を同時に配置し、リーチを広げる一方で次元やモデリングの要求を増加させます。
ハイブリッドシステムは長距離移動時にナビゲーションを使い、その後作業近くでローカル連動調整を行います。完全な結合を自動的に優位と見なすのではなく、必要な精度、接触、スペース、リカバリーの中からアーキテクチャを選択してください。
| 建築 | 最適フィット | 主な利点 | 一次故障 |
|---|---|---|---|
| 連続的 | オープンスペースと寛容なリーチ | シンプルなインターフェース | 到着後は連絡不能 |
| ベースポーズサンプリング | 多くの停車駅が許容されます | タスク認識型ナビゲーション目標 | 弱得点モデル |
| 連結計画 | 緻密で協調した動き | フルワークスペース使用 | 高次元探索 |
| 全身制御 | オンライン連絡か追跡 | 継続的補正 | モデルと安定性需要 |
| ハイブリッド | 長距離移動と精密な作業 | レイヤー計算 | 遷移ミスマッチ |
逆到達可能性から基礎候補を生成する
到着後に一方の腕の逆運動学問題を解決する代わりに、工具目標を有利な腕の作業空間内に配置するベースポーズをサンプルまたは最適化しましょう。存在だけでなく複数のIK解をスコアリングしてください。
基地のフットプリント、アプローチ方向、センサー視界、ナビゲーションクリアランスを侵害する候補は却下します。 逆運動学ガイド は、ポーズ解が実現可能性層の一つに過ぎない理由を説明しています。
二値のIK結果ではなく、到達可能性のマージンを使う
関節限界や特異点近くの到達可能なポーズはベース誤差に脆弱になることがあります。到達可能性マップや繰り返しのIKサンプリングにより、各基底候補周辺の溶液密度、操作可能性、継ぎ目マージン、アプローチの実現可能性を推定できます。
局所化や物体の姿勢の不確実性を許容する領域をスコアリングします。最良の名目候補は、より広い近傍を持つわずかに遠い姿勢よりも劣ることが多いです。
モバイルマニピュレータの衝突ジオメトリ全体を表現します
衝突判定には、ベース、ホイール、マスト、胴体、アームリンク、エンドエフェクター、ケーブル、ペイロードが含まれます。付加対象は、掴んだ後、スイープ体積を変化させます。ベース回転は、端がほとんど動かない場合でも、上げた腕を障害物にぶつけることがあります。
静的なマップ、ローカル障害物、操作シーンを同期させてください。未モデルの突起には保守的なジオメトリを使い、作業スペースに人やカートが入ってくる際の知覚遅延をテストします。
適切な視野で Nav2 と操作計画を活用する
現在の Nav2 概念のドキュメント では、モバイルナビゲーションのためのプランナー、コントローラー、行動オーケストレーションについて説明されています。それだけでは腕の届きやすさや接触の制約を解決するものではありません。
MoveItのモバイルベースとアームのチュートリアルは、計画グループを組み合わせたものを示し、純粋なナビゲーションのためにNav2を明確に推奨しています。この例をアーキテクチャの参考として扱い、デプロイで使用されたバージョンを検証してください。
非ホロノミックな基底運動と経路実行を尊重する
差動駆動ベースは横方向に移動できません。ホロノミックとしてモデリングされた平面ジョイントは、プラットフォームが実行できない幾何学的動きを返すことができます。旋回半径、ホイールスリップ、ローカルコントローラーの挙動も最終的なベースポーズに影響を与えます。
ベースに合ったモーションモデルを使い、実際のコントローラーインターフェースを確認してください。経路追跡と最終共分散を記録し、プランナーの成功だけでなく。
安定性、ペイロード、接触を連動運動に含めます
アームを伸ばすことで重心がずれ、車輪や構造の荷重が増加します。重いペイロードでのブレーキや旋回は安定性を低下させる可能性があります。接触作業はレンチの制約を加え、固定ベースやブレーキベースを必要とする場合があります。
車体全体の 制御ガイド を使って制約を共有し、その後、チップやホイール荷重の余裕と実際のペイロードおよび床下でのベースモーションを検証します。
ナビゲーション後にコマンドを信用するのではなく再観察する
コマンドベース目標は測定された到着ポーズではありません。位置誤差、車輪の滑り、障害物回避、停止の動きがアームと目標の関係を変えます。物体のポーズは移動中に動くこともあります。
到着後、新しいロボットとターゲット状態を取得し、変換を再計算し、アームプランをゲートします。ターゲットが許容範囲外にある場合は、アームの軌道を無理に動かすのではなく、ベースを再配置してください。
安全な移行と回復姿勢を計画する
アームが移動時に収納されるタイミング、伸ばせるタイミング、そしてどの姿勢でセンサーやブレーキが有効かを定義してください。回収には、工具の格納、ペイロードの降ろし、後退、再配置、再観測などが含まれます。
失敗したARMプランは、タスクエグゼクティブが利用できる理由を返すべきです。同じナビゲーション目標とIKリクエストを状態を変えずに繰り返すのは回復ではありません。
不確実性と雑多さの中でタスクの成功を評価する
ナビゲーション成功率、到着誤差、到達可能な目標率、計画時間、最小接点・衝突マージン、再計画、タスク成功、接触力および回収率を測定します。物体の不確実性、基準誤差、クラッター、床摩擦、ペイロードを変化させます。
Google Researchのテーブルワイプ研究は、1つの接触が豊富なモバイルタスクに対して全身制約された実行アプローチを示しています。結論を出す際には、タスクとハードウェアの範囲を明確にしてください。
| テスト係数 | バリエーション | 一次計量 | 失敗の証拠 |
|---|---|---|---|
| 到着 | ポーズ誤差と共分散 | 到達可能なタスクレート | 測定されたベースポーズ |
| シーン | クラッターと動的障害物 | 衝突マージン | シーンタイムスタンプ |
| ターゲット | 姿勢と視界の不確実性 | 再観測成功 | センサーフレーム |
| ペイロード | 規模とリーチ | 安定性とトルクマージン | 車輪および関節荷重 |
| 回復 | IK(通行)失敗、通路が塞がれ、接触 | 安全完成率 | 状態遷移 |
ベースアーム実行契約を公開する
ツール目標許容範囲、基準候補ジェネレーター、到達可能性スコア、計画グループ、モーションモデル、シーンソース、到達ゲート、安定性限界、回復状態を文書化します。各ベンチマークには地図、キャリブレーション、ロボットモデル、ソフトウェアのバージョンを必ず保管してください。
簡潔なチェックリストとともにリリースしましょう。
- ツールタスクからベースポーズを生成します。
- アクセス可能性の余裕、可視性、ナビゲーションの実現可能性をスコアリングします。
- 動いている本体と取り付けられたペイロードを確認してください。
- アームの動き前の測定された到着状態を再度観察してください。
- 再配置、引き込み、安全な回収をテストしてください。
よくある質問
ベースとアームは常に一緒に計画しなければならないのでしょうか？
いいえ。順次計画は寛容なタスクに効果的です。結合計画やハイブリッド計画は、ベースモーションとアームの実現可能性が強く相互作用する場合に有用です。
一番近い基本ポーズが通常一番良いのでしょうか？
いいえ。これにより、ジョイント制限、特異点、オクルージョン、衝突、または不適切なアプローチ幾何学が生じる可能性があります。堅牢な実現可能な領域をスコアリングします。
Nav2モバイル操作の全タスクを計画できますか？
Nav2 は移動ナビゲーションを担当し、アームの到達可能性、操作、衝突、接触およびタスク制約には追加の計画と制御が必要です。
アームはベースストッピング誤差を補正できますか？
ただし、リーチとマージンの範囲内でのみ。大きな誤差は再観測と基底の再配置が必要です。
カップルドプランニングはどのように比較すべきでしょうか？
タスク成功、到着許容範囲、リーチおよび衝突マージン、ランタイム、再計画、接触行動、制御された不確実性における回復を測定します。
コマンドされた到達および実行可能なツールポーズ境界
航法コマンドが成功しても、腕の動きは許可されません。ベース、ターゲット、シーンを再観察し、リーチ、衝突、安定性、接触限界に対してツールプランをゲートします。