アーカイブ / Robotics
四足歩行のQPは疎な形が速いか：解法と搭載計算機を比較
Benchmarking Different QP Formulations and Solvers for Dynamic Quadrupedal Walking
Benchmarking Different QP Formulations and Solvers for Dynamic Quadrupedal Walkingの原論文から掲載した図です。細部はクリックして拡大できます。
原論文の図の説明を読む
Fig. 1: Go2 quadruped [ 6 ] used for evaluation in a Volcanic field test in an analogous scenario with limited onboard computing power.
概要
- MPCのQPを疎・部分圧縮・完全圧縮の形で、解法と計算機を変えて比較した。
- 著者らの条件では、MPCはHPIPM speed_abs、WBCはEiquadprogの処理時間が最短だった。
- 導入時は求解時間とCPU電力に加え、解の精度、時間のばらつき、歩行安定性を対象機で検証する必要がある。
補足：編集した模式図で仕組みを確認する
VISUAL EXPLAINER
図でつかむ、Benchmarking Different QP Formulations and Solvers for Dynamic Quadrupedal Walkingの仕組み
- 01速度・姿勢の目標
- 02接地予定の生成
- 03MPCで足力を計算
- 04WBCで関節指令
原論文の説明をもとにした模式図です。処理の細部は省略しています。
研究の背景
四足歩行の制御器は、接地する足を見通して地面を押す力を決め、その力や胴体の目標から関節指令を計算する。これらの計算には、力や動きの条件を守りながら目標との差を小さくする二次計画問題（QP）が使われる。
QPの変数の並べ方と解法によって計算負荷は変わる。搭載計算機と電池に制約がある機体では、制御周期内に解ける速さに加え、消費電力も選定材料になる。
手法
制御器は、目標の歩行速度と胴体姿勢から各時点の接地予定を作る。モデル予測制御（MPC）は、将来の複数時点を見通して足の接触力をQPで求める。たとえば旋回指令では、目標と推定した現在状態、接地予定を使い、力の上限と摩擦の条件を守る足力を出す。
全身制御（WBC）は、MPCの足力と足・胴体の目標を受け、機体全体の動きを考慮して関節の加速度と力を計算し、関節指令につなぐ。比較ではMPCの予測中の状態変数を残す疎な形から、一部または全部を消去する「圧縮」後の形まで変え、解法と計算機ごとの所要時間を測った。
新規性
著者らは、四足歩行のモデル予測制御（MPC）で使う二次計画問題（QP）について、疎な形から部分圧縮、完全圧縮までを、解法と計算機の組み合わせで比較した。歩行を安定させる全身制御（WBC）の解法も別に測定している。
さらに、求解頻度をCPU消費電力で割ったSFPWを導入した。解く速さと電力効率を、それぞれ異なる観点から確認できる指標である。
従来手法との違い
MPCでは、予測する各時点の状態を変数として残す疎なQPと、状態を一部または全部消去する圧縮後のQPを比べる。圧縮で変数は減る一方、行列には値の入った要素が増える。
著者らの歩行課題では、疎な形を扱う解法が、完全圧縮した形を扱う解法より速かった。ただし、この関係は予測長や状態と入力の大きさに依存する。著者らは、より小さい問題や入力の少ないロボットでは別の選択が有利になり得ると述べている。
実験結果
著者らはDrake上のUnitree Go2シミュレーションで、約40秒のトロット歩行と約20秒の立位姿勢変更を評価した。MPCの予測長は10と20。計算機はJetson Orin NX、LattePanda Alpha、デスクトップPCで、MPCの時間比較には圧縮時間も含む。
著者らによると、比較した予測長・計算機・圧縮水準ではHPIPM speed_absのMPC求解時間が最短だった。予測長10の疎なQPでのSFPWは、Jetson、LattePanda、デスクトップの順に159.40、66.65、50.80 Hz/W。WBCはQPの準備を含む1周期の時間を比較し、Eiquadprogが最速で、全解法の平均は0.5ミリ秒未満だった。
応用の可能性
編集上の応用案 · 論文が実証した用途とは区別しています。
編集上の応用案：計算資源に制約がある点検用四足ロボットで、歩行制御のQPの形と解法を選ぶ。目標速度・胴体姿勢、接地予定、推定した現在状態を入力し、足の接触力と関節指令を出す既存の制御器で、求解時間とCPU電力を記録する。
この比較自体に学習用データや教師ラベルは要らない。必要なのは対象機の状態推定に使うセンサー情報と接地予定である。センサーの種類は確認できた本文の範囲では特定できず、機体の力の上限や摩擦条件に合わせた設定が必要になる。
応用先の候補からNauhに相談できます。
導入時の検証
導入時の検証案 · 対象データでの再評価が必要です。
導入時の検証案：対象機の既存制御器に同じ目標速度・姿勢、接地予定、推定状態を与え、疎なQPと完全圧縮QPを基準として解法を入れ替える。歩行と立位で、MPCの圧縮を含む求解時間、WBCのQP準備を含む処理時間、そのばらつき、CPU電力を別々に記録する。
学習用データと教師ラベルは不要。状態推定に使う対象機のセンサー情報と接地予定を用意し、力の上限、摩擦条件、制御周期を機体に合わせて設定する。速さとSFPWだけでなく、解の制約違反と歩行中の転倒の有無も確認する。
限界と課題
著者らは、比較で最速だったHPIPMのspeed_abs設定について、用途によっては解の精度が足りない場合があると述べる。また、解法の設定は比較のため主に標準値を使っており、個別に調整した場合の順位までは示していない。
編集上の検証事項は、対象機で解が制約を満たすか、歩行が安定するか、処理時間のばらつきが制御周期に収まるかである。SFPWは測定したCPU電力に基づくため、実際の運用で必要な電力の評価範囲も確認したい。シミュレーション結果を別の機体や地形へそのまま適用できるとは限らない。
出典
元のタイトル・要旨を確認する（英語）
Benchmarking Different QP Formulations and Solvers for Dynamic Quadrupedal Walking
Quadratic Programs (QPs) are widely used in the control of walking robots, especially in Model Predictive Control (MPC) and Whole-Body Control (WBC). In both cases, the controller design requires the formulation of a QP and the selection of a suitable QP solver, both requiring considerable time and expertise. While computational performance benchmarks exist for QP solvers, studies comparing optimal combinations of computational hardware (HW), QP formulation, and solver performance are lacking. In this work, we compare dense and sparse QP formulations, and multiple solving methods on different HW architectures, focusing on their computational efficiency in dynamic walking of four legged robots using MPC. We introduce the Solve Frequency per Watt (SFPW) as a performance measure to enable a cross hardware comparison of the efficiency of QP solvers. We also benchmark different QP solvers for WBC that we use for trajectory stabilization in quadrupedal walking. As a result, this paper provides recommendations for the selection of QP formulations and solvers for different HW architectures in walking robots and indicates which problems should be devoted the greater technical effort in this domain in future.
論文本体の取得範囲に基づく解説。AIが作成した未校閲の記事です。性能の数値は著者の評価条件に依存します。応用例と検証計画は編集上の提案です。解説更新：2026-10-01