Single Rigid Body Model
- 別名: SRB model, SRBD, single rigid body dynamics
- カテゴリ: Control › Locomotion control
- タグ: legged-locomotion, reduced-order-models, model-predictive-control, quadrupeds, rigid-body-dynamics
脚ロボットを、質量のない脚での接触力によって動かされる、質量と慣性が一定の 1 つの剛体として表す低次元モデル。移動の MPC で広く使われている。
定義
単一剛体モデル(Single rigid body model、SRB model)は、脚ロボットを、ロボットの全質量と、通常は胴体座標系で一定とみなす回転慣性をもつ 1 つの剛体として表す。脚は質量のないものとして扱われるので、その役割は足から胴体へ床反力を伝えることだけである。状態は胴体の位置、姿勢、並進速度、角速度であり、入力は立脚中の足での接触力である。
ダイナミクスは Newton-Euler 方程式である。接触力の和に重力を加えたものが質量と重心加速度の積に等しく、重心まわりの接触力のモーメントの和(それぞれ、重心に対する足の位置とその力との外積)が角運動量の変化率に等しい。ロボットが引く荷物や、つながれた別のロボットからの力といった外力と外部モーメントは、これらの和に直接加えることができる。このモデルは重心ダイナミクスに近く、重心ダイナミクスもロボットを重心と全運動量によって記述するが、SRB モデルは脚の運動が慣性をどう変え、角運動量にどう寄与するかを無視する。
このモデルは四足ロボットのモデル予測制御の標準的な基盤となった。MIT Cheetah 3 のために提案され広く使われている定式化は、ロールとピッチが小さくヨーの軌道が既知であると仮定して回転ダイナミクスを線形化し、短いホライズンにわたる接触力の探索を、摩擦円錐制約をもつ凸二次計画に変える。非線形版は回転ダイナミクスを完全に保持する。SRB モデルは脚が胴体に比べて軽い場合に最もうまく働く。四肢の重いヒューマノイドロボットや、脚の振りが重要な宙返りのような動作では、重心モデルや全身モデルのほうが正確である。
重要な理由
SRB モデルは、ロボットのハードウェア上で数歩分のホライズンにわたってリアルタイムに最適化できるほど単純でありながら、胴体の 3D の回転と各足の力が生むモーメントを保持している。このバランスにより、四足ロボットの力ベースの移動コントローラや、外部の荷重を考慮しなければならないプランナーでよく選ばれるようになった。
主な用途
- 四足ロボットの移動のモデル予測制御
- 立脚中の足への床反力の配分
- 胴体の回転を伴うジャンプや動的な機動の計画
- 外部の荷重やつながれたロボットを伴う協調移動
- 歩容と接触スケジュールの最適化
実際の使われ方
四足ロボットでは、SRB モデルに基づいて構築されたモデル予測制御コントローラが一定の周期で動作する。各更新で、推定された胴体状態、歩容から得られる接触スケジュール、目標速度を受け取り、摩擦円錐制約と力の制限のもとで、これからのホライズンにわたる立脚の床反力を解く。最初の力の組は各脚のヤコビ行列の転置によって関節トルクに変換され、遊脚は別のコントローラのもとで足先軌道に追従する。ロボットがペイロードを運ぶ場合や他のロボットとつながっている場合は、予想される外力とその重心まわりのモーメントをモデルに加え、計画された足の力がそれを補償するようにする。
よくある誤解
- SRB モデルは胴体の回転を無視する — 完全な 3D の姿勢と角速度を保持しており、省かれるのは脚の質量と脚によって生じる運動量だけである
- SRB モデルと重心ダイナミクスは同じである — 重心ダイナミクスは四肢の運動が全体の慣性と運動量をどう変えるかを考慮するが、SRB モデルはそれを固定するか無視する
- 凸 SRB MPC はどんな運動にも有効である — 一般的な凸形式は小さなロールとピッチを前提としているので、宙返りのような大きな回転には非線形の定式化か回転を考慮した定式化が必要である
知っておくべき人
- 四足ロボットとヒューマノイドロボットの移動エンジニア
- モデル予測制御の開発者
- 荷物を運ぶ脚ロボットやチームで作業する脚ロボットの研究者
- 脚ロボットの低次元モデルを学ぶ学生
関連技術
- 凸モデル予測制御(Convex Model Predictive Control)
- Newton-Euler 方程式(Newton-Euler Equations)
- 重心ダイナミクス(Centroidal Dynamics)
- 二次計画法(Quadratic Programming)
- 全身制御(Whole-Body Control)
関連用語
- Centroidal Dynamics
- Model Predictive Control
- Friction Cone
- Quadruped
- Whole-Body Control
- Linear Inverted Pendulum
関連プロジェクト
- DimOS: Python robotics runtime with agents, SLAM and teleop, no ROS required
- MuJoCo MPC: DeepMind's interactive real-time model predictive control framework for MuJoCo
- PACE Sim2Real: Systematic sim-to-real transfer via actuator dynamics identification
- python_simple_mppi: MPPI control derived and implemented in numpy, with four worked examples
- mjbatch: Runs thousands of MuJoCo simulations in parallel on the CPU
- Quadruped-PyMPC: Python MPC framework for quadruped locomotion with gradient and sampling control