Projected Gravity
- 別名: projected gravity vector, body-frame gravity vector
- カテゴリ: Sensing › Proprioceptive
- タグ: orientation, legged-locomotion, reinforcement-learning, imu, observation-design
ロボットの胴体座標系で表した単位重力方向。ヨーを含まずにロールとピッチを符号化し、学習型の歩行・バランス方策の標準的な傾き入力である。
定義
投影重力(projected gravity)は、ロボットの胴体(通常はベースや体幹)の座標系で表した重力の方向である。世界座標系では重力は真下を向き、単位ベクトルとしては (0, 0, -1) である。これを胴体の姿勢行列の転置で胴体座標系へ回転させると、胴体が傾くにつれて変化する 3 成分のベクトルが得られる。胴体が直立しているときこのベクトルは (0, 0, -1) であり、胴体が角度 θ だけ傾くと、水平部分の長さは sin θ まで増え、鉛直部分は -cos θ まで縮む。したがって x 成分と y 成分のノルムは傾きの直接的な尺度となり、直立時はゼロ、胴体が横倒しのときは 1 となる。また、その水平部分の向きは胴体がどちらへ傾いているかを示す。
ロール、ピッチ、ヨーの角度の代わりにこのベクトルを使う主な理由は、バランスコントローラや歩行コントローラが必要とする姿勢情報をちょうど過不足なく含むことにある。方位の影響を受けないので、ロボットがどちらを向いていても方策は同じようにふるまい、また姿勢の滑らかな関数であるため、オイラー角の折り返しや特異点がない。こうした理由から、legged_gym や Isaac Lab のような脚ロボットとヒューマノイドロボット向けの強化学習フレームワークでは標準的な観測項であり、その水平成分は胴体の傾きにペナルティを与える報酬に直接使われることも多い。
ハードウェアでは、投影重力は IMU の姿勢推定から得られる。これは通常、ジャイロスコープと加速度計のデータを組み合わせるフィルタで計算される。これは加速度計の生の読み取り値とは異なる。加速度計が測るのは比力であり、それが重力の方向と一致するのは胴体が加速していないときだけである。そのため、完全なシミュレーション上の姿勢で訓練された方策は、遅れのある推定値や衝撃時に乱れたフィルタ推定値を与えられると、異なるふるまいをすることがある。訓練中にこの観測にノイズと遅延を加えることが多いのはこのためである。同じ構成はヒューマノイドが持つトレイのような任意の物体にも適用でき、それがどれだけ水平かを測れる。
重要な理由
重力に対する傾きは、ロボットやロボットが運ぶ物体を直立に保つうえで最も重要な単一の姿勢信号である。投影重力はそれを、コンパクトで方位に依存せず、学習型のコントローラが扱いやすい形で与える。学習型歩行方策の観測において標準的な項目となっているのはこのためである。
主な用途
- 学習型の脚歩行・ヒューマノイド歩行方策の観測入力
- 胴体や積載物の傾きにペナルティを与える報酬項
- 転倒検出と復帰のトリガー
- トレイや容器などの運搬物のバランス保持
- 斜面上のモバイルマニピュレータの傾きを考慮した制御
実際の使われ方
あるチームが、中身をこぼさずにトレイを運ぶヒューマノイドの方策を訓練する。観測には、IMU から得る体幹の投影重力と、トレイの推定姿勢から計算するトレイの投影重力が含まれる。報酬はトレイの重力の水平成分のノルムの二乗にペナルティを与え、これはトレイが水平のときゼロになる。シミュレーションでの訓練中は、搭載の姿勢フィルタに合わせて、両方のベクトルにノイズとわずかな遅延を加える。実機では、IMU の座標系の規約がシミュレーターのものと一致しているかを確認する。このベクトルで軸が入れ替わっていたり符号が誤っていたりすると、方策が存在しない傾きを補正しようとするからである。
よくある誤解
- 投影重力は加速度計の読み取り値である — 加速度計は並進加速度も測るため、重力と一致するのは胴体が加速していないときだけである
- 投影重力は姿勢全体を符号化している — 重力軸まわりの回転(ヨー)は表されず、これは通常意図どおりである
- ロール角とピッチ角を別の名前で呼んでいるだけである — 同じ傾き情報をもつが、角度の折り返しや特異点のない滑らかな単位ベクトルとして表す
知っておくべき人
- 歩行・バランス方策を訓練する強化学習エンジニア
- 脚ロボットとヒューマノイドロボットの制御エンジニア
- シミュレーションで訓練した方策を実機の IMU で動かすエンジニア
- 姿勢表現を扱うロボティクスの学生
関連技術
- Isaac Lab
- legged_gym
- 姿勢方位基準装置(Attitude and Heading Reference System)
- 四元数による姿勢推定(Quaternion Orientation Estimation)
- Mahony フィルタと Madgwick フィルタ(Mahony and Madgwick Filters)
関連用語
関連プロジェクト
- LeRobot: HuggingFace ML library for real-world robotics in PyTorch
- MuJoCo: DeepMind physics engine for robotics and ML research
- PyBullet: Python physics simulator for robotics and RL research with fast CPU-based simulation
- Microduck: Pollen Robotics' $399 walking duck robot: open-source software, closed hardware
- Isaac Lab: NVIDIA robot learning framework: one task API across Newton, PhysX and Isaac Sim
- Newton: Open GPU physics engine for robot learning, with Kamino for closed-loop linkages