Wesloo
すべてのトピックトピック

ロボット工学

逆運動学 ロボットの関節角度を逆算する計算手法

要点

逆運動学とは、手先の目標位置と姿勢が与えられたときに、それを実現する関節変数を求める計算である。順運動学のように一意に決まらず、解が複数あったり存在しなかったりする点が難しい。機構の形に合わせた幾何・代数の閉形式解と、ヤコビアンを使う汎用の反復法に大別される。

ポイント

  • 逆運動学は手先の位置と姿勢から関節角度を逆算する問題で、順運動学の逆向きにあたる
  • 同じ手先姿勢に複数の関節角の組が対応し、ワークスペース外では解が存在しない
  • 幾何解法と代数解法は閉形式で解けるが、導出は機構ごとの作業になる
  • ヤコビアンを用いた反復法は汎用だが、初期値と特異点の影響を受ける
  • 球状手首を持つ腕は位置と姿勢に分けて解ける

逆運動学(IK)は、ロボットの手先が到達すべき位置と姿勢を先に決め、その姿勢を作り出す各関節の角度を逆算する計算手法である。手先の目標は作業内容から決まることが多く、制御側が必要とするのは関節角度のほうだから、この向きの計算が実機では欠かせない。リンクの長さや関節軸の向きといった幾何パラメータは既知として扱う。

逆運動学 ロボット制御で何を求めるのか

n個の関節を持つ鎖状のマニピュレータを考える。関節変数を q1, q2, …, qn とし、基部から手先までの同次変換行列を T とすると、逆運動学は T を入力として q1 から qn を出力する問題になる。順運動学は関節変数から手先姿勢を一意に計算できるが、その逆写像は一意とは限らない。ここが計算を難しくしている根本で、同じ手先姿勢に対して複数の関節の組み合わせが対応する。

解が複数ある理由と、解が存在しない場合

平面2リンクの腕を想像すると分かりやすい。手先をある点に置くとき、肘を上に向ける配置と下に向ける配置の2通りが同じ点を指せる。リンクが増えれば組み合わせはさらに増える。逆に、リンク長の合計より遠い点や、関節の可動範囲の外にある姿勢には解が存在しない。到達できる点の集合をワークスペースと呼び、目標がその外にあれば計算は失敗する。閉形式の解が必ず存在するのは特別な形状の機構だけで、任意のマニピュレータに対して保証されるものではない。

幾何解法:三角形を余弦定理で解く

幾何解法では、機体の形から三角関数の式を組み立てる。平面2リンクなら、肩から手先までの距離を余弦定理で求め、肘の内角を出し、そこから各関節角を計算する。平面機構では手先の向きが回転関節の角度の総和に等しいので、向きの条件は角度の足し算として扱える。式の意味が図で追えるため、導出した解が正しいかを確認しやすい。ただし導出は機構ごとの手作業になり、リンク構成が変われば式を作り直す必要がある。

代数解法:変換行列を連立方程式に落とす

代数解法は、順運動学から書き下せる同次変換行列と目標の変換行列を成分ごとに突き合わせ、そこから立つ連立方程式を解く。三角関数の恒等式で式を整理して関節変数を取り出す流れで、幾何学的な観察を経由しない点が幾何解法との違いである。複数解を漏れなく並べる定石がないため、解の取りこぼしを防ぐには別途の検討が要る。

運動学的分離で6自由度を位置と姿勢に分ける

産業用の6自由度アームの多くは、最後の3軸が1点で交わる球状手首を持つ。この構造では、手首中心の位置を決めれば最初の3関節だけで位置が解け、残り3関節は手先の向きだけを担当する。位置の逆問題と姿勢の逆問題に分割するこの手法を運動学的分離と呼ぶ。姿勢側はオイラー角のパラメータ化を使って解く。6自由度の連立方程式を一度に扱うより、3自由度ずつに分けたほうがはるかに見通しがよい。

数値解法:ヤコビアンを反転して反復する

自由度が高く閉形式の解が立てられない場合、目標姿勢との誤差を少しずつ減らす反復計算を使う。関節変数の微小変化と手先の微小変位を結ぶ行列がヤコビアンで、その逆行列を誤差に掛けて関節角を更新する。関節数が作業空間の次元を上回る場合は逆行列が作れないため、擬似逆行列や減衰付き最小二乗法を用いる。手先位置ではなくカメラの光軸を対象に向けるといった制約条件を満たす解を求める拡張もあり、汎用の計算ライブラリでは拘束付きの逆運動学として実装されている。初期値によって収束先が変わること、特異点の近くで関節速度が発散することが弱点になる。

冗長マニピュレータと特異点

3次元空間では6自由度あればワークスペース内の任意の姿勢に届く。それを超える7自由度以上を冗長マニピュレータと呼び、同じ手先姿勢を実現する関節角の組が無数に存在する。余った自由度は、関節可動域に余裕を残す、障害物を避けるといった副次的な目的に割り当てられる。解の集合はヤコビアンの零空間として表され、そこへの射影で手先姿勢を崩さずに腕の形を変えられる。特異点はヤコビアンの階数が落ちる配置で、手先がある方向に動けなくなる。

どこで使われているか

計算機アニメーションでは、キャラクターの手先を狙った位置へ動かせば、手首・肘・肩の角度は計算側が埋めてくれる。CADの組立モデルでも、リンク間の拘束を保ったまま部品を動かすために同じ計算を使う。産業用ロボットのティーチング、遠隔操作、歩行ロボットの足先位置決めも同系統の問題である。力覚提示を伴う遠隔操作では、操作者の入力に対する応答の遅れが作業精度に直結するため、VR 触覚フィードバックの仕組みと力覚伝達と合わせて設計する必要がある。計算を回す周期そのものが知覚できる遅延になる点は、VRモーショントゥフォトンレイテンシーの目標値の議論と共通する。カメラで自分の位置を推定しながら腕を動かす構成では、AR SLAMによる自己位置推定の仕組みが示す推定誤差が、そのまま目標姿勢の誤差になる。

手法の比較

手法向く場面注意点
幾何解法リンク構成が単純で図から式を立てられる機構ごとに導出し直す
代数解法変換行列の式整理で解ける中規模の機構複数解の列挙が体系的でない
数値反復法高自由度の汎用プログラム、拘束付きの条件初期値依存と特異点での発散

実装では、まず機構が閉形式で解けるかを判定し、解けない場合に反復法へ回す構成が一般的である。閉形式の解は計算が軽く、周期の短い制御に向く。

よくある質問

逆運動学の解が求まらないのはどんなときですか?

目標姿勢がワークスペースの外にある、関節の可動範囲を超えている、といった条件では解が存在しない。特異点の近くでは解はあっても関節速度が現実的でなくなる。

なぜ6自由度のロボットが多いのですか?

3次元の位置3つと姿勢3つを合わせて6つの条件になり、関節6つで過不足なく対応できるため。最後の3軸が1点で交わる球状手首なら、位置と姿勢を分けて解ける。

7自由度のロボットはどう解くのですか?

解が無数にあるため、一意に決めずに評価関数で1つを選ぶ。関節可動域の余裕や障害物との距離を指標にして、ヤコビアンの零空間の中で姿勢を調整する。

順運動学だけではなぜ足りないのですか?

作業で指定したいのは手先の位置と向きであり、関節角度はその結果として決まるものだから。手先から関節を逆算する向きの計算がないと、目標に合わせた制御が組み立てられない。

関連ページ

  • ロボット pid制御 仕組み モーションコントロールの基礎

    PIDコントローラは、目標とセンサーが測った現在の状態との差をもとに、モーターなどへ送る補正量を計算するフィードバック制御器です。比例・積分・微分の出力を組み合わせ、位置や速度を目標に近づけます。

  • ROS 仕組み わかりやすく|アーキテクチャと基本概念

    ROSはロボット用ソフトを組み立てるためのオープンソースのミドルウェア群で、カーネルを持つOSではない。役割ごとに分かれたノードがトピックを通じてメッセージを交換し、全体として1台のロボットのように動く。2018年以降はDDSを土台にしたROS 2が主流になりつつある。

  • 不気味の谷 ロボットの原因とデザインによる克服法

    不気味の谷は、対象の人間らしさが増すほど好感が上がるとは限らず、ほぼ人間に近づいた地点で気味悪さが急に強まる現象を指す。森政弘が提唱し、人型ロボットの設計では避けるべき領域として扱われてきた。ロボットの顔画像を使った実験でも好感度評価に谷が再現され、写実的な質感と人間の顔比率を揃える、幼い特徴を取り入れるといった対策で緩和できる。

  • 自律移動ロボット センサーの種類と役割

    自律移動ロボット センサーは、周囲の物体や距離を測る外部センサーと、自分の姿勢や移動量を測る内部センサーに分かれます。LiDARやカメラが地図作成と障害物検知を担い、エンコーダとIMUが車輪の滑りによる誤差を補正します。安全用の近接センサーを加えた構成が、倉庫搬送からサービスロボットまで共通の基本形です。

  • ロボット エンドエフェクターの種類と選定ポイント

    エンドエフェクターはアーム先端に付き、ロボットが物を掴む・加工する・測る動作を担う部分で、大きくグリッパー、加工ツール、センサーに分かれる。選定ではワークの材質と形状、重量と重心、サイクルタイム、周辺環境の順に条件を絞り、アームの可搬重量にはツール自身の重さが含まれる点に注意する。

  • 協働ロボットと産業用ロボットの違い|速度・安全・可搬重量

    協働ロボットと産業用ロボットの違いは、人と同じ空間で働く前提で作られているかどうか、そして速度・可搬重量・精度をどこまで求めるかにある。産業用は高速・高精度・大可搬で大量生産に向き、協働は小型軽量で安全機能を備え、多品種少量や段取り替えの多い工程に向く。購入価格だけでなく保守や消費電力まで含めると協働の投資回収は短く、用途に応じて使い分けるか併用するのが現実的だ。

このページの作成方法

執筆の前に、下記の情報源でテーマを調査しました。その後、自動の品質チェックを通過しています。

このページの誤りを報告する