両手協調は、同時に始まった2つの独立した腕の軌跡ではありません。両手が一つの剛体を持つと、そのエンドエフェクターが閉じた運動連鎖を形成します。相対姿勢誤差は接触力、物体の変形、または滑りに変わります。
コントローラーはアーム間の可能な関係を維持しつつ、荷重を分散し、関節、トルク、衝突、グリップの制約を尊重しながら物体を動かさなければなりません。タイミング誤差やキャリブレーションバイアスは、各アームが自分のコマンドを正確に追跡していても内部力を生じさせることがあります。
このガイドは 全身コントロールガイド と座標 系ガイドと一緒に使ってください。物体の運動と閉じた連鎖応力を同時に検証します。
無関係な2つの目標ではなく、1つのオブジェクト制約をモデル化する
オブジェクトフレームと各グラスプ変換を定義します。左右のツールポーズは、共有オブジェクトポーズまたは一貫した相対制約から生成されるべきです。独立したターゲット同士はミリメートルや数分の差があり、それが硬い物体に大きな力をかぶることがあります。
把握の遵守と許容される相対運動を明確に保つこと。柔軟なバッグ、長い板、剛性の治具は異なる制約モデルと力の限界を必要とします。
絶対座標と相対座標の分離
絶対座標は、オブジェクトや協同システムがワークセル内でどこを移動するかを表します。相対座標はエンドエフェクタやグリップフレーム間のポーズを表します。この分解により、タスクの動きと閉じた連鎖関係が分離されます。
向き、補間、変換方向を定義します。一見小さな記号やフレームの誤りでも、アームが物体を逆方向にねじらせることがあります。
| 座標または変数 | 操作方法 | 一次制約 | 失敗の症状 |
|---|---|---|---|
| 物体絶対姿勢 | タスクモーション | 世界衝突とリーチ | 間違った配置 |
| ツールの相対姿勢 | クローズドチェーン | グラップ幾何学 | 武器の戦い |
| ネットオブジェクトレンチ | 加速度または接触 | ペイロードと任務部隊 | 損失の追跡 |
| 内部レンチ | グリップとプリロード | 損傷とアクチュエータの限界 | 加熱または曲げ |
| ヌル空間姿勢 | 結合マージン | 自己衝突 | 特異点 |
両腕を共通の物理フレームにキャリブレーションします
ベース、ジョイントゼロ、ツール中心点、グリップ変換は両腕の相対誤差に累積されます。各腕を別々のターゲットに対してキャリブレーションすると、両腕が同じ物体に接触した後にのみ現れるクロスアームバイアスが残ることがあります。
共通の成果物を使い、センサーをゼロにした後に相対的な姿勢と力を測定します。 ロボットのキャリブレーション ワークフローに従い、すべてのテストでキャリブレーションバージョンを保持してください。
すべての制約が揃った状態で閉じた連鎖運動を解く
クローズドチェーンプランナーまたはコントローラーは、関節と衝突を尊重しつつ、両方のグラスプ関係を満たさなければなりません。一方のアームを先にサンプリングし、もう一方を解くのは有用ですが、狭い共有作業空間では解が偏ったり失敗したりすることがあります。
現在の MoveIt 二重アームの文書 では、複数アーム構成および計画グループが示されています。それだけではオブジェクトフォースの調整や安全挙動を生み出すものではありません。
タスクからマスター・スレーブまたは対称的な役割を選択します
マスター・スレーブ設計では、片腕が動きをリードし、もう片方の腕が相対的なポーズや力に従う形です。対称設計では、タスク変数を両腕に分散させます。どちらも普遍的に優れているわけではない。工具、剛性、感知、リーチが有用な配分を決定します。
役割の切り替えを明確かつスムーズにしましょう。基準や力積分器の急激な変化は、各コントローラが単独で安定していても物体に衝撃を与えることがあります。
ネットオブジェクトレンチとは別に内部力を測定する
内部力は剛体を加速させるのではなく、グリップ、物体、関節に荷重をかけます。システムは、自身を絞ったり伸ばしたりねじったりしながら、優れたオブジェクトポーズトラッキングを発揮できます。手首のセンサーや関節トルクの推定は、この隠れたストレスを明らかにすることがあります。
プリロードを少し行うと、グリップの安定性が向上するかもしれません。物体の強度、接触摩擦、センサーバイアス、アクチュエータの熱的限界で制限し、ルールでゼロに強制するのではなく、
トルクとグリップマージンで荷重を割り当てる
均等な荷重分担は簡単ですが、片腕の特異点、関節の限界、または弱いグリップの近くでは不十分に適切になることがあります。配分はトルクの余裕、操作性、接触余裕、作業レンチの方向などを考慮します。
移動中の配分を追跡する。物体が回転したり移動する基地が動くにつれて、実行可能な静的分割は不可能になることがあります。
制御タイミング、ジッター、通信損失
各軍科は指揮、統合国家、部隊のために時間を共有する必要があります。遅延差は相対的な追尾誤差として現れ、特に速いまたは硬い動きの際に現れます。平均的なレイテンシだけでは、有害なジッターやパケットロスを隠します。
タイム同期ガイドを使い、テストに有界遅延を注入してください。同期品質が適格なエンベロープから離れたら、両方のアームを遅くしたり停止したりしてください。
自己衝突、物体衝突、視認性の計画
2本のアームはより多くの自己衝突ペアを作り、お互いのカメラを遮ることができます。保持されたオブジェクトは動く衝突ジオメトリの一部となります。ケーブルや仮設支持器具は標準モデルに含まれていない場合もあります。
アプローチ全体を確認し、協調動作、後退、撤退。両腕で使われる同じイベントでオブジェクトジオメトリとアタッチドボディの状態を更新します。
リグラスプを支持された遷移として扱う
リグリップ中は、片手で荷重を支え、もう一方の手で荷重を下ろし、動き、再び接触します。サポートグリップ、物体の動き、次の接触は移行中ずっと自分のマージン内にとどまらなければなりません。
荷重移乗前の検証を定義してください:接触確立、力の方向が妥当、姿勢が公差内、受け腕が荷重を受け入れられること。ゲートが失敗した場合はサポート状態に中止します。
保護停止と片腕故障の調整
一方のアームが停止した場合、もう一方のアームは古いコマンドで共有オブジェクトを引き続けるべきではありません。安全な対応は負荷、重力、ブレーキ、備具、そして人のアクセスに依存します。両腕は同期停止、制御された下降、または維持された支持が必要になることがあります。
センサーのドロップアウト、ドライブ故障、保護停止、グリップスリップ、オブジェクトブレイクアウェイのテストをしてください。回復手順では、ラッチされたり電源を使わないパートナーに対して片腕を再び使うことはできません。
| テスト係数 | バリエーション | メートル法 | 必須の失敗証拠 |
|---|---|---|---|
| 目的 | 質量、剛性、サイズ | 姿勢と内力 | 変形 |
| キャリブレーション | 相対バイアス注入 | 力対バイアス | トランスフォームバージョン |
| タイミング | 遅延とジッター | 相対誤差とピークフォース | クロックトレース |
| 負荷分担 | 非対称リーチとトルク | マージンと温度 | 共同国家 |
| 故障 | 停止、滑り、センサー喪失 | セーフステートでの成功 | 応答タイムライン |
両手での受け入れチェックリストを公開する
オブジェクトとグラスプフレーム、絶対および相対目標、負荷割り当て、内部力制限、同期閾値、衝突モデル、停止挙動、サポート済み回復を文書化します。両方の腕のコマンドと測定値を1つの時間軸に保存します。
以下のチェックリストで検証を締めくくります。
- 2本腕の相対幾何学をキャリブレーションします。
- オブジェクトと相対座標を明示的に制御します。
- ネットレンチと内部レンチは別々に計測してください。
- テスト遅延、ジッター、衝突、荷重移送。
- 片腕故障をシステムセーフ状態に調整します。
よくある質問
2つのアームパスを独立して計画し、同時に実行することは可能でしょうか？
共有の剛体制約を持たず、衝突判定後のタスクのみ;共有オブジェクト作業には一貫した相対関係が必要です。
マスター・スレーブ・コントロールは対称コントロールよりも悪いのでしょうか？
いいえ。これは役割の割り当てであり、異なるトレードオフがあります。作業の形状、剛性、感知、リーチが適合性を決定します。
内力は常にゼロであるべきでしょうか？
いいえ。制御されたプリロードはグリップを安定させることができますが、物体、接触、センサー、アクチュエータの限界内に収まらなければなりません。
片腕が保護停止に入るとどうなりますか？
もう一方のアームは、同期停止、支持、または負荷に応じて制御された降下などの調整されたあらかじめ定義された応答が必要です。
主なバイマニュアルの指標は何ですか？
物体ポーズ、相対ポーズ、ネットおよび内部レンチ、荷重分担マージン、衝突クリアランス、タイミング、故障回復成功率。
閉鎖内力と停止境界
両手操作システムは、共有接触時に1台の閉鎖機械を操作します。安全・回収ロジックは、単なる2つのコントローラーだけでなく、両方のアームと支援対象を調整しなければなりません。